231 lines
6.7 KiB
C
231 lines
6.7 KiB
C
/*
|
|
* cmd_parser.c
|
|
*
|
|
* Created on: 16 01 2024
|
|
* Author: pvvx
|
|
*/
|
|
|
|
/*********************************************************************
|
|
INCLUDES
|
|
*/
|
|
#include "bcomdef.h"
|
|
#include "config.h"
|
|
#include "OSAL.h"
|
|
#include "linkdb.h"
|
|
#include "att.h"
|
|
#include "gatt.h"
|
|
#include "gatt_uuid.h"
|
|
#include "gattservapp.h"
|
|
#include "gapbondmgr.h"
|
|
#include "flash.h"
|
|
#include "flash_eep.h"
|
|
#include "thb2_main.h"
|
|
#include "sbp_profile.h"
|
|
#include "sensor.h"
|
|
#include "cmd_parser.h"
|
|
#include "devinfoservice.h"
|
|
#include "ble_ota.h"
|
|
#include "thb2_peripheral.h"
|
|
#include "lcd_th05.h"
|
|
#include "logger.h"
|
|
/*********************************************************************/
|
|
extern gapPeriConnectParams_t periConnParameters;
|
|
|
|
#define SEND_DATA_SIZE 16
|
|
|
|
const dev_id_t dev_id = {
|
|
.pid = CMD_ID_DEVID,
|
|
.revision = 1,
|
|
.hw_version = DEVICE,
|
|
.sw_version = APP_VERSION,
|
|
.dev_spec_data = 0,
|
|
.services = DEV_SERVICES
|
|
};
|
|
|
|
int cmd_parser(uint8_t * obuf, uint8_t * ibuf, uint32_t len) {
|
|
int olen = 0;
|
|
if (len) {
|
|
uint8_t cmd = ibuf[0];
|
|
uint32_t tmp = ibuf[1] | (ibuf[2]<<8) | (ibuf[3]<<16) | (ibuf[4]<<24);
|
|
obuf[0] = cmd;
|
|
obuf[1] = 0; // no err
|
|
if (cmd == CMD_ID_DEVID) { // Get DEV_ID
|
|
memcpy(obuf, &dev_id, sizeof(dev_id));
|
|
olen = sizeof(dev_id);
|
|
} else if (cmd == CMD_ID_CFG) { // Get/Set device config
|
|
if (--len > sizeof(cfg))
|
|
len = sizeof(cfg);
|
|
if (len) {
|
|
memcpy(&cfg, &ibuf[1], len);
|
|
test_config();
|
|
flash_write_cfg(&cfg, EEP_ID_CFG, sizeof(cfg));
|
|
}
|
|
memcpy(&obuf[1], &cfg, sizeof(cfg));
|
|
olen = sizeof(cfg) + 1;
|
|
} else if (cmd == CMD_ID_CFG_DEF) { // Set default device config
|
|
memcpy(&cfg, &def_cfg, sizeof(cfg));
|
|
test_config();
|
|
flash_write_cfg(&cfg, EEP_ID_CFG, sizeof(cfg));
|
|
memcpy(&obuf[1], &cfg, sizeof(cfg));
|
|
olen = sizeof(cfg) + 1;
|
|
#if (DEV_SERVICES & SERVICE_THS)
|
|
} else if (cmd == CMD_ID_CFS) { // Get/Set sensor config
|
|
if (--len > sizeof(thsensor_cfg.coef))
|
|
len = sizeof(thsensor_cfg.coef);
|
|
if (len) {
|
|
memcpy(&thsensor_cfg.coef, &ibuf[1], len);
|
|
flash_write_cfg(&thsensor_cfg.coef, EEP_ID_CFS, sizeof(thsensor_cfg.coef));
|
|
}
|
|
memcpy(&obuf[1], &thsensor_cfg, thsensor_cfg_send_size);
|
|
olen = thsensor_cfg_send_size + 1;
|
|
} else if (cmd == CMD_ID_CFS_DEF) { // Get/Set default sensor config
|
|
memset(&thsensor_cfg, 0, thsensor_cfg_send_size);
|
|
init_sensor();
|
|
memcpy(&obuf[1], &thsensor_cfg, thsensor_cfg_send_size);
|
|
olen = thsensor_cfg_send_size + 1;
|
|
} else if (cmd == CMD_ID_SEN_ID) {
|
|
memcpy(&obuf[1], (uint8_t *)&thsensor_cfg.mid, 5);
|
|
olen = 1 + 5;
|
|
#endif
|
|
#if (DEV_SERVICES & SERVICE_HISTORY)
|
|
} else if (cmd == CMD_ID_LOGGER && len > 2) { // Read memory measures
|
|
rd_memo.cnt = ibuf[1] | (ibuf[2] << 8);
|
|
if (rd_memo.cnt) {
|
|
rd_memo.saved = memo;
|
|
if (len > 4)
|
|
rd_memo.cur = ibuf[3] | (ibuf[4] << 8);
|
|
else
|
|
rd_memo.cur = 0;
|
|
}
|
|
wrk_notify();
|
|
// osal_set_event(simpleBLEPeripheral_TaskID, WRK_NOTIFY_EVT);
|
|
} else if (cmd == CMD_ID_CLRLOG && len > 2) { // Clear memory measures
|
|
if (ibuf[1] == 0x12 && ibuf[2] == 0x34) {
|
|
clear_memo();
|
|
olen = 2;
|
|
}
|
|
#endif
|
|
} else if (cmd == CMD_ID_SERIAL) {
|
|
memcpy(&obuf[1], devInfoSerialNumber, sizeof(devInfoSerialNumber)-1);
|
|
olen = 1 + sizeof(devInfoSerialNumber)-1;
|
|
} else if (cmd == CMD_ID_FLASH_ID) {
|
|
memcpy(&obuf[1], (uint8_t *)&phy_flash.IdentificationID, 8);
|
|
olen = 1 + 8;
|
|
} else if (cmd == CMD_ID_MTU) {
|
|
if (ibuf[1] <= MTU_SIZE)
|
|
ATT_UpdateMtuSize(gapRole_ConnectionHandle, ibuf[1]);
|
|
else
|
|
obuf[1] = 0xff;
|
|
olen = 2;
|
|
} else if (cmd == CMD_ID_REBOOT) {
|
|
if(len >= 2) {
|
|
wrk.reboot = ibuf[1];
|
|
obuf[1] = ibuf[1];
|
|
} else
|
|
obuf[1] = wrk.reboot;
|
|
olen = 2;
|
|
} else if (cmd == CMD_ID_MEASURE) {
|
|
memcpy(&obuf[1], &measured_data, send_len_measured_data);
|
|
olen = 1 + send_len_measured_data;
|
|
#if (DEV_SERVICES & SERVICE_SCREEN)
|
|
} else if (cmd == CMD_ID_LCD_DUMP) { // Get/set lcd buf
|
|
if (--len > sizeof(display_buff))
|
|
len = sizeof(display_buff);
|
|
if (len) {
|
|
memcpy(display_buff, &ibuf[1], len);
|
|
update_lcd();
|
|
}
|
|
memcpy(&obuf[1], display_buff, sizeof(display_buff));
|
|
olen = 1 + sizeof(display_buff);
|
|
#endif
|
|
} else if (cmd == CMD_ID_UTC_TIME) { // Get/set utc time
|
|
if (len > 4) {
|
|
clkt.utc_time_sec = tmp;
|
|
#if (DEV_SERVICES & SERVICE_TIME_ADJUST)
|
|
@TODO
|
|
#endif
|
|
clkt.utc_time_tik = clock_time_rtc();
|
|
//clkt.utc_time_add = 0;
|
|
}
|
|
tmp = get_utc_time_sec();
|
|
memcpy(&obuf[1], &tmp, 4);
|
|
#if (DEV_SERVICES & SERVICE_TIME_ADJUST)
|
|
memcpy(&obuf[4 + 1], &clkt.utc_set_time_sec, sizeof(clkt.utc_set_time_sec));
|
|
olen = 4 + sizeof(clkt.utc_set_time_sec) + 1;
|
|
#else
|
|
olen = 4 + 1;
|
|
#endif // SERVICE_TIME_ADJUST
|
|
#if (DEV_SERVICES & SERVICE_TIME_ADJUST)
|
|
} else if (cmd == CMD_ID_TADJUST) { // Get/set adjust time clock delta (in 1/16 us for 1 sec)
|
|
if (len > 4) {
|
|
clkt.delta_time = tmp;
|
|
flash_write_cfg(&clkt.delta_time, EEP_ID_TIM, sizeof(&clkt.delta_time));
|
|
}
|
|
memcpy(&send_buf[1], &clkt.delta_time, sizeof(clkt.delta_time));
|
|
olen = sizeof(clkt.delta_time) + 1;
|
|
#endif
|
|
} else if (cmd == CMD_ID_DEV_MAC) {
|
|
if (len > MAC_LEN) {
|
|
if(memcmp(ownPublicAddr, &ibuf[1], MAC_LEN)) {
|
|
memcpy(ownPublicAddr, &ibuf[1], MAC_LEN);
|
|
flash_write_cfg(ownPublicAddr, EEP_ID_MAC, MAC_LEN);
|
|
wrk.reboot |= 1;
|
|
}
|
|
}
|
|
memcpy(&obuf[1], ownPublicAddr, MAC_LEN);
|
|
olen = MAC_LEN + 1;
|
|
} else if (cmd == CMD_ID_DNAME) {
|
|
if (len > 1 && len < B_MAX_ADV_LEN - 2) {
|
|
len--;
|
|
memcpy(&gapRole_ScanRspData[2], &ibuf[1], len);
|
|
flash_write_cfg(&gapRole_ScanRspData[2], EEP_ID_DVN, len);
|
|
set_dev_name();
|
|
}
|
|
olen = gapRole_ScanRspData[0];
|
|
memcpy(&obuf[1], &gapRole_ScanRspData[2], olen - 1);
|
|
|
|
//---------- Debug commands (unsupported in different versions!):
|
|
|
|
} else if (cmd == CMD_ID_EEP_RW && len > 2) {
|
|
obuf[1] = ibuf[1];
|
|
obuf[2] = ibuf[2];
|
|
uint16_t id = (uint16_t)tmp;
|
|
if(len > 3) {
|
|
flash_write_cfg(&ibuf[3], id, len - 3);
|
|
}
|
|
int16_t i = flash_read_cfg(&obuf[3], id, SEND_DATA_SIZE);
|
|
if(i < 0) {
|
|
obuf[1] = (uint8_t)(i & 0xff); // Error
|
|
olen = 2;
|
|
} else
|
|
olen = i + 3;
|
|
} else if (cmd == CMD_ID_MEM_RW && len > 4) { // Read/Write memory
|
|
uint8_t *p = (uint8_t *)tmp;
|
|
if(len > 5) {
|
|
len -= 5;
|
|
memcpy(p, &ibuf[5], len);
|
|
} else
|
|
len = SEND_DATA_SIZE;
|
|
memcpy(obuf, ibuf, 5);
|
|
memcpy(&obuf[5], p, len);
|
|
olen = len + 1 + 4;
|
|
} else if (cmd == CMD_ID_REG_RW && len > 4) { // Read/Write 32 bits register (aligned)
|
|
volatile uint32_t *p = (volatile uint32_t *)tmp;
|
|
if(len > 8) {
|
|
tmp = ibuf[5] | (ibuf[6]<<8) | (ibuf[7]<<16) | (ibuf[8]<<24);
|
|
*p = tmp;
|
|
} else {
|
|
obuf[1] = 0xfe; // Error size
|
|
olen = 2;
|
|
}
|
|
tmp = *p;
|
|
memcpy(obuf, ibuf, 5);
|
|
memcpy(&obuf[5], &tmp, 4);
|
|
olen = 1 + 4 + 4;
|
|
} else {
|
|
obuf[1] = 0xff; // Error cmd
|
|
olen = 2;
|
|
}
|
|
}
|
|
return olen;
|
|
}
|