TMSG44-CoolPi/command.c

#include "command.h"

#include <stdint.h>
#include <stdlib.h>
#include <inttypes.h>
#include <stdio.h>
#include <strings.h>
#include <string.h>
#include <sys/socket.h>

//Массив структур Command, который связывает строки команд с соответствующими функциями.
Command commands[] = {
	{"TMSG44:FREQ ", 	handleFreqCmd},
	{"TMSG44:LD?", 		handleLdCmd},
	{"TMSG44:POW ", 	handlePowCmd},
	{"TMSG44:ARM ", 	handleArmCmd},
	{"TMSG44:ATT ", 	handleAttCmd},
	{"*IDN?", 			handleIdnCmd},
	{NULL, NULL} // Завершающий элемент для обозначения конца массива
};

//handleXXXXCmd - обработчики команд
void handleFreqCmd(const char* recvBuff)
{
	printf("\nTMSG44:FREQ\n");
	uint64_t freq[1] = {0};

	splitLexeme(recvBuff, freq, sizeof(freq[0]), convertToUint64);

	printf("%" PRId64 "\n", freq[0]);
}

void handleLdCmd(const char* recvBuff)
{
	int n = 0;
	char messageLd[2] = "0";

	printf("\nTMSG44:LD?\n");

	if (1)
	{
		strcpy(messageLd, "1");
	}
	else if (0)
	{
		strcpy(messageLd, "0");
	}

	send(sockfd, messageLd, sizeof(messageLd), 0);
	
	printf("\nSend msg LD!\n");
}

void handlePowCmd(const char* recvBuff)
{
	printf("\nTMSG44:POW\n");
	double pow[1] = {0};

	splitLexeme(recvBuff, pow, sizeof(pow[0]), convertToDouble);
	printf("%f\n", pow[0]);
}

void handleArmCmd(const char* recvBuff)
{
	printf("\nTMSG44:ARM\n");
	uint16_t armCode[1] = {0};

	splitLexeme(recvBuff, armCode, sizeof(armCode[0]), convertToUInt16);
	printf("\n%u\n", armCode[0]);
}

void handleAttCmd(const char* recvBuff)
{
	printf("\nTMSG44:ATT\n");
	uint16_t attCode[1] = {0};

	splitLexeme(recvBuff, attCode, sizeof(attCode[0]), convertToUInt16);
	printf("\n%u\n", attCode[0]);
}

void handleIdnCmd(const char* recvBuff)
{
	printf("\n*IDN?\n");
}

//Проходим по массиву команд и ищем команду, которая совпадает с началом строки recvBuff. 
//Если команда найдена, вызывается соответствующая функция-обработчик
void processCommand(const char* recvBuff) 
{
	for (int i = 0; commands[i].command != NULL; i++) 
	{
		if (!strncasecmp(recvBuff, commands[i].command, strlen(commands[i].command))) 
		{
			commands[i].handler(recvBuff);
			return;
		}
	}
	printf("\nUnknown command: %s\n", recvBuff);
}

// Преобразование строки в uint16_t
void convertToUInt16(const char *str, void *output) 
{
	*(uint16_t *)output = (uint16_t)strtoul(str, NULL, 10);
}

// Преобразование строки в unsigned long long int
void convertToUint64(const char *str, void *output) 
{
	*(uint64_t *)output = (uint64_t)strtoull(str, NULL, 10);
}

// Преобразование строки в double
void convertToDouble(const char *str, void *output) 
{
	*(double *)output = strtod(str, NULL);
}

// Универсальная функция для разделения строки на лексемы
void splitLexeme(const char *ptrSCPI, void *numOutAndValue, size_t elementSize, ConvertFunc convertFunc) 
{
	uint8_t counter = 0;

	// Разделители лексем
	char charSeparator[3] = {' ', '\n', '\\'};
	char *ptrLexeme = NULL;

	// Инициализируем функцию
	ptrLexeme = strtok((char *)ptrSCPI, charSeparator);

	// Ищем лексемы разделенные разделителем
	ptrLexeme = strtok(NULL, charSeparator);

	// Ищем лексемы строки
	while (ptrLexeme) {
		// Проверяем, является ли первый символ лексемы числом
		if(('0' <= ptrLexeme[0]) && (ptrLexeme[0] <= '9')) {
			// Преобразуем строку с числом в число
			convertFunc(ptrLexeme, (uint8_t *)numOutAndValue + counter * elementSize);
			counter++;
		}
		// Ищем лексемы разделенные разделителем
		ptrLexeme = strtok(NULL, charSeparator);
	}
}