Prechádzať zdrojové kódy

Merge branch 'Mikhail/feature_AddCmdSlopeOffset' into Anatoliy/feature_arm_att_pot_qSpi

Anatoliy Chigirinskiy 1 rok pred
rodič
commit
6a6878f247
2 zmenil súbory, kde vykonal 22 pridanie a 0 odobranie
  1. 20 0
      command.c
  2. 2 0
      command.h

+ 20 - 0
command.c

@@ -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) 

+ 2 - 0
command.h

@@ -40,6 +40,8 @@ void handlePowCmd(const char* recvBuff);
 void handleArmCmd(const char* recvBuff);
 void handleAttCmd(const char* recvBuff);
 void handleIdnCmd(const char* recvBuff);
+void handleOffsetCmd(const char* recvBuff);
+void handleSlopeCmd(const char* recvBuff);
 void processCommand(const char* recvBuff);
 void convertToUInt16(const char *str, void *output);
 void convertToUint64(const char *str, void *output);