|
|
@@ -29,6 +29,8 @@ Command commands[] = {
|
|
|
{"TMSG44:ARM ", handleArmCmd},
|
|
|
{"TMSG44:ATT ", handleAttCmd},
|
|
|
{"*IDN?", handleIdnCmd},
|
|
|
+ {"TMSG44:OFFSET ", handleOffsetCmd},
|
|
|
+ {"TMSG44:SLOPE ", handleSlopeCmd},
|
|
|
{NULL, NULL} // Завершающий элемент для обозначения конца массива
|
|
|
};
|
|
|
|
|
|
@@ -165,6 +167,24 @@ void handleIdnCmd(const char* recvBuff)
|
|
|
send(conn_fd, messageIdn, sizeof(messageIdn), 0);
|
|
|
}
|
|
|
|
|
|
+void handleOffsetCmd(const char* recvBuff)
|
|
|
+{
|
|
|
+ printf("\nHandle command \"TMSG44:OFFSET\"\n");
|
|
|
+ uint16_t offsetCode[1] = {0};
|
|
|
+
|
|
|
+ splitLexeme(recvBuff, offsetCode, sizeof(offsetCode[0]), convertToUInt16);
|
|
|
+ printf("\n%u\n", offsetCode[0]);
|
|
|
+}
|
|
|
+
|
|
|
+void handleSlopeCmd(const char* recvBuff)
|
|
|
+{
|
|
|
+ printf("\nHandle command \"TMSG44:SLOPE\"\n");
|
|
|
+ uint16_t slopeCode[1] = {0};
|
|
|
+
|
|
|
+ splitLexeme(recvBuff, slopeCode, sizeof(slopeCode[0]), convertToUInt16);
|
|
|
+ printf("\n%u\n", slopeCode[0]);
|
|
|
+}
|
|
|
+
|
|
|
//Проходим по массиву команд и ищем команду, которая совпадает с началом строки recvBuff.
|
|
|
//Если команда найдена, вызывается соответствующая функция-обработчик
|
|
|
void processCommand(const char* recvBuff)
|