144 lines
4.5 KiB
C
144 lines
4.5 KiB
C
//
|
|
// Created by cfif on 04.10.2022.
|
|
//
|
|
|
|
#include <stddef.h>
|
|
#include <SystemDelayInterface.h>
|
|
#include <ComInt.h>
|
|
#include <CmsisRtosThreadUtils.h>
|
|
#include "SerialPort.h"
|
|
#include "ComIntCmd/Vars.h"
|
|
#include "ComIntCmd/Tests.h"
|
|
#include "ComIntCmd/VersionsInfo.h"
|
|
#include "ComIntCmd/AccelCalibration.h"
|
|
|
|
|
|
|
|
static void ComInt_LoadMetadata(tComInt *env) {
|
|
env->versions.firmware = StringStaticInit("1.1.0");
|
|
|
|
env->versions.board = (tStringStatic) {
|
|
.data = (char *) (HARDWARE_REVISION),
|
|
.length = sizeof(HARDWARE_REVISION) - 1
|
|
};
|
|
};
|
|
|
|
static void ComIntInitRoot(tComInt *env, tSerialPortIO *io) {
|
|
env->io = io;
|
|
XfcProtTable_InitStatic(&env->table, env->memAlloc.table);
|
|
tXfcArray rxArr;
|
|
tXfcArray txArr;
|
|
XfcArrayInitStatic(&rxArr, env->memAlloc.rxArr);
|
|
XfcArrayInitStatic(&txArr, env->memAlloc.txArr);
|
|
XfcProtRespondent_Init(&env->service, NULL, &env->table, rxArr, txArr, XFC_STD_MAGIC_NUMBERS);
|
|
ComInt_LoadMetadata(env);
|
|
}
|
|
|
|
static void ComIntInitPing(tComInt *env, tString16 *deviceId, tStringLink *currentModeName) {
|
|
env->ping.device = String16GetLink(deviceId);
|
|
env->ping.board = StringStaticGetLink(&env->versions.board);
|
|
env->ping.mode = currentModeName;
|
|
}
|
|
|
|
static void ComIntInitVersions(tComInt *env, tString16 *deviceId) {
|
|
|
|
VersionsInfoTable_InitStatic(&env->versionsTable, env->memAlloc.versions);
|
|
|
|
VersionsInfoTable_AddStatic(
|
|
&env->versionsTable, "DEVICE_ID", String16GetLink(deviceId)
|
|
);
|
|
VersionsInfoTable_AddStatic(
|
|
&env->versionsTable, "FIRMWARE", StringStaticGetLink(&env->versions.firmware)
|
|
);
|
|
VersionsInfoTable_AddStatic(
|
|
&env->versionsTable, "BOARD", StringStaticGetLink(&env->versions.board)
|
|
);
|
|
}
|
|
|
|
|
|
static void ComIntInitSerialBridges(
|
|
tComInt *env,
|
|
tSerialPortIO *gsmIo,
|
|
tSerialPortIO *gnssIo,
|
|
tSerialPortIO *cliIo
|
|
) {
|
|
|
|
SerialBridges_InitStatic(&env->serialBridges, env->memAlloc.serialBridge);
|
|
if (gnssIo)SerialBridges_AddStatic(&env->serialBridges, "GNSS", gnssIo);
|
|
if (gsmIo)SerialBridges_AddStatic(&env->serialBridges, "AT_GSM", gsmIo);
|
|
if (cliIo)SerialBridges_AddStatic(&env->serialBridges, "CLI", cliIo);
|
|
}
|
|
|
|
|
|
void ComInt_Init(
|
|
tComInt *env,
|
|
tSerialPortIO *io,
|
|
tString16 *deviceId,
|
|
tVariablesTable *varsTab,
|
|
tDeviceTestsTable *tests,
|
|
tSerialPortIO *gsmIo,
|
|
tSerialPortIO *cliIo,
|
|
tSerialPortIO *gnssIo,
|
|
tStringLink *currentModeName,
|
|
tCarFlipDetection *carFlipDetection
|
|
) {
|
|
ComIntInitRoot(env, io);
|
|
ComIntInitPing(env, deviceId, currentModeName);
|
|
ComIntInitVersions(env, deviceId);
|
|
ComIntInitSerialBridges(env, gsmIo, gnssIo, cliIo);
|
|
XfcProtMethodsInit_AccelCalibration(&env->accelCalibData, carFlipDetection, varsTab);
|
|
|
|
//Добавляем обработчики комманд
|
|
XfcProtMethodsAdd_Mandatory(&env->table, &env->ping, &env->table);
|
|
XfcProtMethodsAdd_VersionsInfo(&env->table, &env->versionsTable);
|
|
XfcProtMethodsAdd_AccelCalibration(&env->table,&env->accelCalibData);
|
|
|
|
if (varsTab) {
|
|
XfcProtMethodsAdd_Vars(&env->table, varsTab);
|
|
}
|
|
|
|
XfcProtMethodsAdd_Tests(&env->table, tests);
|
|
XfcProtMethodsAdd_SerialBridge(&env->table, &env->serialBridges);
|
|
|
|
//Инициализируем поток
|
|
InitThreadAtrStatic(&env->thread.attr, "ComInt", env->thread.controlBlock, env->thread.stack, osPriorityNormal);
|
|
env->thread.id = 0;
|
|
}
|
|
|
|
static _Noreturn void ComInt_Thread(tComInt *env) {
|
|
|
|
for (;;) {
|
|
uint8_t byte;
|
|
|
|
if (SerialPortReceive(env->io, &byte, 1, SystemWaitForever)) {
|
|
|
|
XfcProtRespondent_AddBytes(&env->service, &byte, 1);
|
|
|
|
while (XfcArrayGetDataSize(env->service.requestDecoder.buffer)) {
|
|
|
|
if (XfcProtRespondent_Step(&env->service)) {
|
|
|
|
SerialPortTransmit(
|
|
env->io,
|
|
env->service.responseEncoder.buffer->data,
|
|
XfcArrayGetDataSize(env->service.responseEncoder.buffer),
|
|
1000
|
|
);
|
|
|
|
XfcProtRespondent_SkipCurrentRequest(&env->service);
|
|
} else {
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void ComInt_StartThread(tComInt *env) {
|
|
if (!env->thread.id) {
|
|
env->thread.id = osThreadNew((osThreadFunc_t) (ComInt_Thread), (void *) (env), &env->thread.attr);
|
|
} else {
|
|
osThreadResume(env->thread.id);
|
|
}
|
|
}
|