增加分组信息合包

This commit is contained in:
zzh 2025-07-04 09:13:31 +08:00
parent 876f563492
commit efd64e3648
3 changed files with 152 additions and 365 deletions

143
main.c
View File

@ -121,9 +121,19 @@ static time_t first_3015_time = 0;
static bool is_3015_collecting = false;
static pthread_mutex_t lightsn_buffer_mutex = PTHREAD_MUTEX_INITIALIZER;
// 3022合包缓存定义放在文件顶部或main函数外部
#define LABEL_BATCH_SIZE 20
static uint32_t tags_buf[LABEL_BATCH_SIZE] = {0};
static uint8_t lable1_buf[LABEL_BATCH_SIZE] = {0};
static uint16_t lable2_buf[LABEL_BATCH_SIZE] = {0};
static uint32_t lable3_buf[LABEL_BATCH_SIZE] = {0};
static int label_buf_count = 0;
static time_t label_buf_first_time = 0;
// 函数声明
void *thread_timeout_check(void *arg);
void *thread_3015_lighton_merge(void *arg);
void *thread_label_batch_send(void *arg);
int getLedOtaVersion(char *filename);
int getApOtaVersion(char *filename,char *modename);
@ -1529,29 +1539,17 @@ void *thread_uart_recv_ack(void *arg){
isLightOnByRule=false;
}
if(isLabelUp){
#if 1
uint32_t tag=strtol(mqtt_parm.msg_sn,NULL,16);
uint16_t label2=strtol(mqtt_parm.msg_label2,NULL,16)&0xFFFF;
uint32_t label3=strtol(mqtt_parm.msg_label3,NULL,16);
uart_data_send_lable(&uartSend,tag,atoi(mqtt_parm.msg_label1),label2,label3,
0,0,0,0,
0,0,0,0,
0,0,0,0,
0,0,0,0,
1);
#else
uint32_t tag=strtol("00A04C0F",NULL,16);
uint16_t label2=strtol("FF01",NULL,16)&0xFFFF;
uint32_t label3=strtol("663855c0",NULL,16);
uart_data_send_lable(&uartSend,tag,atoi("03"),label2,label3,
0,0,0,0,
0,0,0,0,
0,0,0,0,
0,0,0,0,
1);
#if 0
time_t now = time(NULL);
if(label_buf_count > 0 && (label_buf_count >= LABEL_BATCH_SIZE || (now - label_buf_first_time) >= 180)) {
uart_data_send_head_lableup(&uartSend, 5, label_buf_count);
usleep(10000);
uart_data_send_lable(&uartSend, tags_buf, lable1_buf, lable2_buf, lable3_buf, label_buf_count);
label_buf_count = 0;
label_buf_first_time = 0;
isLabelUp = false;
}
#endif
isLabelUp=false;
}
}else if(parm_ack==0x4646){
last_2323_time = 0; // 重置时间
@ -1984,51 +1982,34 @@ void *thread_mqtt_recv(void *arg){
mqtt_service_reply(stationsn, mqtt_parm.msg_messageId, "ok", 1, productid);
}else if(strcmp(mqtt_parm.msg_type,"3022")==0){
LOG_I("3022 updata lable\n");
get_string_from_json_string_by_key_unescape(msg_data, "label1", mqtt_parm.msg_label1, sizeof(mqtt_parm.msg_label1));
LOG_I("label1:%s\n",mqtt_parm.msg_label1);
get_string_from_json_string_by_key_unescape(msg_data, "label2", mqtt_parm.msg_label2, sizeof(mqtt_parm.msg_label2));
LOG_I("label2:%s\n",mqtt_parm.msg_label2);
get_string_from_json_string_by_key_unescape(msg_data, "label3", mqtt_parm.msg_label3, sizeof(mqtt_parm.msg_label3));
LOG_I("label3:%s\n",mqtt_parm.msg_label3);
get_string_from_json_string_by_key_unescape(msg_data, "sn", mqtt_parm.msg_sn, sizeof(mqtt_parm.msg_sn));
LOG_I("sn:%s\n",mqtt_parm.msg_sn);
if(strcmp(mqtt_parm.msg_sn,"")!=0){
mqtt_service_reply(stationsn,mqtt_parm.msg_messageId,"ok",1,productid);
isSendComEnd=false;
isLightOn=false;
isLightOnByRule=false;
isLabelUp=true;
//isSearchLabel=false;
// 分组信息缓存与批量处理
typedef struct {
char label1[64];
char label2[64];
char label3[64];
char sn[64];
} GroupInfo;
#define GROUP_MAX 20
static GroupInfo group_buffer[GROUP_MAX];
static int group_count = 0;
static time_t last_write_time = 0;
// 保存一次分组信息
strncpy(group_buffer[group_count].label1, mqtt_parm.msg_label1, sizeof(group_buffer[group_count].label1));
strncpy(group_buffer[group_count].label2, mqtt_parm.msg_label2, sizeof(group_buffer[group_count].label2));
strncpy(group_buffer[group_count].label3, mqtt_parm.msg_label3, sizeof(group_buffer[group_count].label3));
strncpy(group_buffer[group_count].sn, mqtt_parm.msg_sn, sizeof(group_buffer[group_count].sn));
group_count++;
if (group_count == 1) {
last_write_time = time(NULL);
}
time_t now = time(NULL);
if (group_count >= GROUP_MAX || (now - last_write_time) >= 180) {
for (int i = 0; i < group_count; i++) {
uart_data_send_head_lableup(&uartSend, 5, 1);
}
group_count = 0;
last_write_time = now;
char sn_str[32] = {0};
char label1_str[8] = {0};
char label2_str[8] = {0};
char label3_str[16] = {0};
get_string_from_json_string_by_key_unescape(msg_data, "sn", sn_str, sizeof(sn_str));
get_string_from_json_string_by_key_unescape(msg_data, "label1", label1_str, sizeof(label1_str));
get_string_from_json_string_by_key_unescape(msg_data, "label2", label2_str, sizeof(label2_str));
get_string_from_json_string_by_key_unescape(msg_data, "label3", label3_str, sizeof(label3_str));
LOG_I("sn:%s\n", sn_str);
LOG_I("label1:%s\n", label1_str);
LOG_I("label2:%s\n", label2_str);
LOG_I("label3:%s\n", label3_str);
if(strcmp(sn_str,"")!=0){
if(label_buf_count == 0) {
label_buf_first_time = time(NULL);
}
tags_buf[label_buf_count] = strtoul(sn_str, NULL, 16);
lable1_buf[label_buf_count] = (uint8_t)atoi(label1_str);
lable2_buf[label_buf_count] = (uint16_t)strtoul(label2_str, NULL, 16);
lable3_buf[label_buf_count] = strtoul(label3_str, NULL, 16);
label_buf_count++;
mqtt_service_reply(stationsn, mqtt_parm.msg_messageId, "ok", 1, productid);
isSendComEnd = true;
isLightOn = false;
isLightOnByRule = false;
isLabelUp = true;
}else{
mqtt_service_reply(stationsn,mqtt_parm.msg_messageId,"sn is empty",0,productid);
mqtt_service_reply(stationsn, mqtt_parm.msg_messageId, "sn is empty", 0, productid);
}
}else if(strcmp(mqtt_parm.msg_type,"3023")==0){
LOG_I("3023 light on by rule\n");
@ -2449,7 +2430,7 @@ int main(int argc, char *argv[])
pthread_detach(timeout_thread);
}
// 创建3015合并点亮线程
// 新增:3015合并点亮线程
pthread_t pt_3015_merge;
ret = pthread_create(&pt_3015_merge, NULL, thread_3015_lighton_merge, NULL);
if (ret != 0) {
@ -2459,6 +2440,16 @@ int main(int argc, char *argv[])
LOG_I("pthread_create 3015_merge success\n");
}
// 新增3022合包批量下发线程
pthread_t pt_label_batch_send;
ret = pthread_create(&pt_label_batch_send, NULL, thread_label_batch_send, NULL);
if (ret != 0) {
LOG_I("pthread_create label_batch_send fail\n");
} else {
pthread_detach(pt_label_batch_send);
LOG_I("pthread_create label_batch_send success\n");
}
ret = pthread_create(&pt_ota,NULL,thread_ota,NULL);
if(ret!=0){
LOG_I("pthread_create ota fail\n");
@ -2690,6 +2681,7 @@ void *thread_3015_lighton_merge(void *arg) {
// 不要立即清空buffer等待isLightOn处理完成
is_3015_collecting = false;
first_3015_time = 0;
isLightOn = false;
}
}
pthread_mutex_unlock(&lightsn_buffer_mutex);
@ -2698,3 +2690,22 @@ void *thread_3015_lighton_merge(void *arg) {
return NULL;
}
// 3022合包批量下发线程
void *thread_label_batch_send(void *arg) {
while (1) {
if (isLightOnByRule == false && isLightOn == false) {
time_t now = time(NULL);
if (label_buf_count > 0 && (label_buf_count >= 10 || (now - label_buf_first_time) >= 180)) {
uart_data_send_head_lableup(&uartSend, 5, label_buf_count);
usleep(10000);
uart_data_send_lable(&uartSend, tags_buf, lable1_buf, lable2_buf, lable3_buf, label_buf_count);
label_buf_count = 0;
label_buf_first_time = 0;
isLabelUp = false;
}
}
usleep(1000 * 1000); // 每秒检查一次
}
return NULL;
}

View File

@ -220,49 +220,33 @@ error:
return 0;
}
int uart_data_send_head_lableup(uart_utils_t *uart,uint8_t wakeup_time,uint16_t tag_num){
int uart_data_send_head_lableup(uart_utils_t *uart, uint8_t wakeup_time, uint16_t tag_num) {
int ret = 0;
uint8_t data_len=0;
if(tag_num==1){
data_len=16;
}else if(tag_num==2){
data_len=27;
}else if(tag_num==3){
data_len=38;
}else if(tag_num==4){
data_len=49;
}else if(tag_num==5){
data_len=60;
}
jt_head_package_t jt_head_package ={
.pre=0x2323,//# 0x23 $ 0x24
.wakeupTime=wakeup_time,//5s,<120s
.func='B',
.len1=0x0000,
.len2=data_len,
.reserve=ntohs(0x0003),
.lableNum=ntohs(tag_num),
uint8_t data_len = 16 + (tag_num > 0 ? (tag_num - 1) * 11 : 0); // 兼容原协议
jt_head_package_t jt_head_package = {
.pre = 0x2323,
.wakeupTime = wakeup_time,
.func = 'B',
.len1 = 0x0000,
.len2 = data_len,
.reserve = ntohs(0x0003),
.lableNum = ntohs(tag_num),
};
LOG_I("%s:HEAD:%04x,%02x,%02x,%04x,%02x,%04x,%04x\r\n",__func__,jt_head_package.pre,jt_head_package.wakeupTime,jt_head_package.func,
jt_head_package.len1,jt_head_package.len2,jt_head_package.reserve,jt_head_package.lableNum);
if (uart == NULL){
LOG_I("%s:HEAD:%04x,%02x,%02x,%04x,%02x,%04x,%04x\r\n", __func__, jt_head_package.pre, jt_head_package.wakeupTime, jt_head_package.func,
jt_head_package.len1, jt_head_package.len2, jt_head_package.reserve, jt_head_package.lableNum);
if (uart == NULL) {
LOG_I("uart NULL pointer\n");
ret = -1;
goto error;
}
if(sizeof(jt_head_package) == write(uart->uart_fd, &jt_head_package, sizeof(jt_head_package))){
if (sizeof(jt_head_package) == write(uart->uart_fd, &jt_head_package, sizeof(jt_head_package))) {
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
} else {
ret = -2;
goto error;
}
error:
return ret;
return 0;
}
int uart_data_send_head_lightonrule(uart_utils_t *uart,uint8_t wakeup_time){
@ -430,267 +414,48 @@ error:
return 0;
}
int uart_data_send_lable(uart_utils_t *uart,uint32_t tag_1,uint8_t tag_1_lable1,uint16_t tag_1_lable2,uint32_t tag_1_lable3,
uint32_t tag_2,uint8_t tag_2_lable1,uint16_t tag_2_lable2,uint32_t tag_2_lable3,
uint32_t tag_3,uint8_t tag_3_lable1,uint16_t tag_3_lable2,uint32_t tag_3_lable3,
uint32_t tag_4,uint8_t tag_4_lable1,uint16_t tag_4_lable2,uint32_t tag_4_lable3,
uint32_t tag_5,uint8_t tag_5_lable1,uint16_t tag_5_lable2,uint32_t tag_5_lable3,
uint32_t tag_num){
int uart_data_send_lable(uart_utils_t *uart, uint32_t tags[], uint8_t lable1[], uint16_t lable2[], uint32_t lable3[], uint32_t tag_num) {
int ret = 0;
if (uart == NULL){
if (uart == NULL) {
LOG_I("uart NULL pointer\n");
ret = -1;
goto error;
return -1;
}
uint8_t tag_1_1=(tag_1>>24)&0xFF;
uint8_t tag_1_2=(tag_1>>16)&0xFF;
uint8_t tag_1_3=(tag_1>>8)&0xFF;
uint8_t tag_1_4=(tag_1)&0xFF;
uint8_t tag_1_lable2_1=(tag_1_lable2>>8)&0xFF;
uint8_t tag_1_lable2_2=(tag_1_lable2)&0xFF;
uint8_t tag_1_lable3_1=(tag_1_lable3>>24)&0xFF;
uint8_t tag_1_lable3_2=(tag_1_lable3>>16)&0xFF;
uint8_t tag_1_lable3_3=(tag_1_lable3>>8)&0xFF;
uint8_t tag_1_lable3_4=(tag_1_lable3)&0xFF;
uint8_t tag_2_1=(tag_2>>24)&0xFF;
uint8_t tag_2_2=(tag_2>>16)&0xFF;
uint8_t tag_2_3=(tag_2>>8)&0xFF;
uint8_t tag_2_4=(tag_2)&0xFF;
uint8_t tag_2_lable2_1=(tag_2_lable2>>8)&0xFF;
uint8_t tag_2_lable2_2=(tag_2_lable2)&0xFF;
uint8_t tag_2_lable3_1=(tag_2_lable3>>24)&0xFF;
uint8_t tag_2_lable3_2=(tag_2_lable3>>16)&0xFF;
uint8_t tag_2_lable3_3=(tag_2_lable3>>8)&0xFF;
uint8_t tag_2_lable3_4=(tag_2_lable3)&0xFF;
uint8_t tag_3_1=(tag_3>>24)&0xFF;
uint8_t tag_3_2=(tag_3>>16)&0xFF;
uint8_t tag_3_3=(tag_3>>8)&0xFF;
uint8_t tag_3_4=(tag_3)&0xFF;
uint8_t tag_3_lable2_1=(tag_3_lable2>>8)&0xFF;
uint8_t tag_3_lable2_2=(tag_3_lable2)&0xFF;
uint8_t tag_3_lable3_1=(tag_3_lable3>>24)&0xFF;
uint8_t tag_3_lable3_2=(tag_3_lable3>>16)&0xFF;
uint8_t tag_3_lable3_3=(tag_3_lable3>>8)&0xFF;
uint8_t tag_3_lable3_4=(tag_3_lable3)&0xFF;
uint8_t tag_4_1=(tag_4>>24)&0xFF;
uint8_t tag_4_2=(tag_4>>16)&0xFF;
uint8_t tag_4_3=(tag_4>>8)&0xFF;
uint8_t tag_4_4=(tag_4)&0xFF;
uint8_t tag_4_lable2_1=(tag_4_lable2>>8)&0xFF;
uint8_t tag_4_lable2_2=(tag_4_lable2)&0xFF;
uint8_t tag_4_lable3_1=(tag_4_lable3>>24)&0xFF;
uint8_t tag_4_lable3_2=(tag_4_lable3>>16)&0xFF;
uint8_t tag_4_lable3_3=(tag_4_lable3>>8)&0xFF;
uint8_t tag_4_lable3_4=(tag_4_lable3)&0xFF;
uint8_t tag_5_1=(tag_5>>24)&0xFF;
uint8_t tag_5_2=(tag_5>>16)&0xFF;
uint8_t tag_5_3=(tag_5>>8)&0xFF;
uint8_t tag_5_4=(tag_5)&0xFF;
uint8_t tag_5_lable2_1=(tag_5_lable2>>8)&0xFF;
uint8_t tag_5_lable2_2=(tag_5_lable2)&0xFF;
uint8_t tag_5_lable3_1=(tag_5_lable3>>24)&0xFF;
uint8_t tag_5_lable3_2=(tag_5_lable3>>16)&0xFF;
uint8_t tag_5_lable3_3=(tag_5_lable3>>8)&0xFF;
uint8_t tag_5_lable3_4=(tag_5_lable3)&0xFF;
if(tag_num==1){
uint8_t test1[14] = {0x00,0x00,13,tag_1_1,tag_1_2,tag_1_3,tag_1_4,
tag_1_lable1,tag_1_lable2_1,tag_1_lable2_2,tag_1_lable3_1,tag_1_lable3_2,tag_1_lable3_3,tag_1_lable3_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<14;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_lable_led1_package_t jt_lable_led1_package ={
.len1=0x0000,
.len2=13,
.tag1=ntohl(tag_1),
.tag1_lable1=tag_1_lable1,
.tag1_lable2=ntohs(tag_1_lable2),
.tag1_lable3=ntohl(tag_1_lable3),
.crc=ntohs(crc_c),
};
if(sizeof(jt_lable_led1_package) == write(uart->uart_fd, &jt_lable_led1_package, sizeof(jt_lable_led1_package))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
}else if(tag_num==2){
uint8_t test1[25] = {0x00,0x00,24,tag_1_1,tag_1_2,tag_1_3,tag_1_4,
tag_1_lable1,tag_1_lable2_1,tag_1_lable2_2,tag_1_lable3_1,tag_1_lable3_2,tag_1_lable3_3,tag_1_lable3_4,
tag_2_1,tag_2_2,tag_2_3,tag_2_4,
tag_2_lable1,tag_2_lable2_1,tag_2_lable2_2,tag_2_lable3_1,tag_2_lable3_2,tag_2_lable3_3,tag_2_lable3_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<25;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_lable_led2_package_t jt_lable_led2_package ={
.len1=0x0000,
.len2=24,
.tag1=ntohl(tag_1),
.tag1_lable1=tag_1_lable1,
.tag1_lable2=ntohs(tag_1_lable2),
.tag1_lable3=ntohl(tag_1_lable3),
.tag2=ntohl(tag_2),
.tag2_lable1=tag_2_lable1,
.tag2_lable2=ntohs(tag_2_lable2),
.tag2_lable3=ntohl(tag_2_lable3),
.crc=ntohs(crc_c),
};
if(sizeof(jt_lable_led2_package) == write(uart->uart_fd, &jt_lable_led2_package, sizeof(jt_lable_led2_package))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
}else if(tag_num==3){
uint8_t test1[36] = {0x00,0x00,35,tag_1_1,tag_1_2,tag_1_3,tag_1_4,
tag_1_lable1,tag_1_lable2_1,tag_1_lable2_2,tag_1_lable3_1,tag_1_lable3_2,tag_1_lable3_3,tag_1_lable3_4,
tag_2_1,tag_2_2,tag_2_3,tag_2_4,
tag_2_lable1,tag_2_lable2_1,tag_2_lable2_2,tag_2_lable3_1,tag_2_lable3_2,tag_2_lable3_3,tag_2_lable3_4,
tag_3_1,tag_3_2,tag_3_3,tag_3_4,
tag_3_lable1,tag_3_lable2_1,tag_3_lable2_2,tag_3_lable3_1,tag_3_lable3_2,tag_3_lable3_3,tag_3_lable3_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<36;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_lable_led3_package_t jt_lable_led3_package ={
.len1=0x0000,
.len2=35,
.tag1=ntohl(tag_1),
.tag1_lable1=tag_1_lable1,
.tag1_lable2=ntohs(tag_1_lable2),
.tag1_lable3=ntohl(tag_1_lable3),
.tag2=ntohl(tag_2),
.tag2_lable1=tag_2_lable1,
.tag2_lable2=ntohs(tag_2_lable2),
.tag2_lable3=ntohl(tag_2_lable3),
.tag3=ntohl(tag_3),
.tag3_lable1=tag_3_lable1,
.tag3_lable2=ntohs(tag_3_lable2),
.tag3_lable3=ntohl(tag_3_lable3),
.crc=ntohs(crc_c),
};
if(sizeof(jt_lable_led3_package) == write(uart->uart_fd, &jt_lable_led3_package, sizeof(jt_lable_led3_package))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
}else if(tag_num==4){
uint8_t test1[47] = {0x00,0x00,46,tag_1_1,tag_1_2,tag_1_3,tag_1_4,
tag_1_lable1,tag_1_lable2_1,tag_1_lable2_2,tag_1_lable3_1,tag_1_lable3_2,tag_1_lable3_3,tag_1_lable3_4,
tag_2_1,tag_2_2,tag_2_3,tag_2_4,
tag_2_lable1,tag_2_lable2_1,tag_2_lable2_2,tag_2_lable3_1,tag_2_lable3_2,tag_2_lable3_3,tag_2_lable3_4,
tag_3_1,tag_3_2,tag_3_3,tag_3_4,
tag_3_lable1,tag_3_lable2_1,tag_3_lable2_2,tag_3_lable3_1,tag_3_lable3_2,tag_3_lable3_3,tag_3_lable3_4,
tag_4_1,tag_4_2,tag_4_3,tag_4_4,
tag_4_lable1,tag_4_lable2_1,tag_4_lable2_2,tag_4_lable3_1,tag_4_lable3_2,tag_4_lable3_3,tag_4_lable3_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<47;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_lable_led4_package_t jt_lable_led4_package ={
.len1=0x0000,
.len2=46,
.tag1=ntohl(tag_1),
.tag1_lable1=tag_1_lable1,
.tag1_lable2=ntohs(tag_1_lable2),
.tag1_lable3=ntohl(tag_1_lable3),
.tag2=ntohl(tag_2),
.tag2_lable1=tag_2_lable1,
.tag2_lable2=ntohs(tag_2_lable2),
.tag2_lable3=ntohl(tag_2_lable3),
.tag3=ntohl(tag_3),
.tag3_lable1=tag_3_lable1,
.tag3_lable2=ntohs(tag_3_lable2),
.tag3_lable3=ntohl(tag_3_lable3),
.tag4=ntohl(tag_4),
.tag4_lable1=tag_4_lable1,
.tag4_lable2=ntohs(tag_4_lable2),
.tag4_lable3=ntohl(tag_4_lable3),
.crc=ntohs(crc_c),
};
if(sizeof(jt_lable_led4_package) == write(uart->uart_fd, &jt_lable_led4_package, sizeof(jt_lable_led4_package))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
}else if(tag_num==5){
uint8_t test1[58] = {0x00,0x00,57,tag_1_1,tag_1_2,tag_1_3,tag_1_4,
tag_1_lable1,tag_1_lable2_1,tag_1_lable2_2,tag_1_lable3_1,tag_1_lable3_2,tag_1_lable3_3,tag_1_lable3_4,
tag_2_1,tag_2_2,tag_2_3,tag_2_4,
tag_2_lable1,tag_2_lable2_1,tag_2_lable2_2,tag_2_lable3_1,tag_2_lable3_2,tag_2_lable3_3,tag_2_lable3_4,
tag_3_1,tag_3_2,tag_3_3,tag_3_4,
tag_3_lable1,tag_3_lable2_1,tag_3_lable2_2,tag_3_lable3_1,tag_3_lable3_2,tag_3_lable3_3,tag_3_lable3_4,
tag_4_1,tag_4_2,tag_4_3,tag_4_4,
tag_4_lable1,tag_4_lable2_1,tag_4_lable2_2,tag_4_lable3_1,tag_4_lable3_2,tag_4_lable3_3,tag_4_lable3_4,
tag_5_1,tag_5_2,tag_5_3,tag_5_4,
tag_5_lable1,tag_5_lable2_1,tag_5_lable2_2,tag_5_lable3_1,tag_5_lable3_2,tag_5_lable3_3,tag_5_lable3_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<58;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_lable_led5_package_t jt_lable_led5_package ={
.len1=0x0000,
.len2=57,
.tag1=ntohl(tag_1),
.tag1_lable1=tag_1_lable1,
.tag1_lable2=ntohs(tag_1_lable2),
.tag1_lable3=ntohl(tag_1_lable3),
.tag2=ntohl(tag_2),
.tag2_lable1=tag_2_lable1,
.tag2_lable2=ntohs(tag_2_lable2),
.tag2_lable3=ntohl(tag_2_lable3),
.tag3=ntohl(tag_3),
.tag3_lable1=tag_3_lable1,
.tag3_lable2=ntohs(tag_3_lable2),
.tag3_lable3=ntohl(tag_3_lable3),
.tag4=ntohl(tag_4),
.tag4_lable1=tag_4_lable1,
.tag4_lable2=ntohs(tag_4_lable2),
.tag4_lable3=ntohl(tag_4_lable3),
.tag5=ntohl(tag_5),
.tag5_lable1=tag_5_lable1,
.tag5_lable2=ntohs(tag_5_lable2),
.tag5_lable3=ntohl(tag_5_lable3),
.crc=ntohs(crc_c),
};
if(sizeof(jt_lable_led5_package) == write(uart->uart_fd, &jt_lable_led5_package, sizeof(jt_lable_led5_package))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
if (tag_num > MAX_LABEL_NUM) tag_num = MAX_LABEL_NUM;
uint8_t data_len = 16 + (tag_num > 0 ? (tag_num - 1) * 11 : 0); // 和头部一致
uint8_t *buf = (uint8_t *)malloc(data_len);
if (!buf) return -2;
memset(buf, 0, data_len);
buf[0] = 0x00; // len1
buf[1] = 0x00; // len2
buf[2] = data_len - 3; // 数据区长度不含len1/len2/len3
for (uint32_t i = 0; i < tag_num; ++i) {
int base = 3 + i * 11;
buf[base + 0] = (tags[i] >> 24) & 0xFF;
buf[base + 1] = (tags[i] >> 16) & 0xFF;
buf[base + 2] = (tags[i] >> 8) & 0xFF;
buf[base + 3] = tags[i] & 0xFF;
buf[base + 4] = lable1[i];
buf[base + 5] = (lable2[i] >> 8) & 0xFF;
buf[base + 6] = lable2[i] & 0xFF;
buf[base + 7] = (lable3[i] >> 24) & 0xFF;
buf[base + 8] = (lable3[i] >> 16) & 0xFF;
buf[base + 9] = (lable3[i] >> 8) & 0xFF;
buf[base + 10] = lable3[i] & 0xFF;
}
error:
uint16_t crc_c = CRC16_XMODEM(buf, data_len - 2);
buf[data_len - 2] = (crc_c >> 8) & 0xFF;
buf[data_len - 1] = crc_c & 0xFF;
// 打印即将发送的数据内容
printf("[uart_data_send_lable] send: ");
for (int i = 0; i < data_len; ++i) {
printf("%02X ", buf[i]);
}
printf("\n");
int write_ret = write(uart->uart_fd, buf, data_len);
LOG_I("[uart_data_send_lable] write_ret=%d, data_len=%d", write_ret, data_len);
if (write_ret == data_len) ret = 0; else ret = -3;
free(buf);
return ret;
return 0;
}
int uart_data_send_lighton(uart_utils_t *uart,uint8_t ledctl,uint16_t flash_i,uint16_t light_d,
@ -733,15 +498,15 @@ int uart_data_send_lighton(uart_utils_t *uart,uint8_t ledctl,uint16_t flash_i,ui
buf[7] = light_d_l;
// 填充tag数据
uint32_t tags[30] = {tag_1, tag_2, tag_3, tag_4, tag_5, tag_6, tag_7, tag_8, tag_9, tag_10,
uint32_t tags_array[30] = {tag_1, tag_2, tag_3, tag_4, tag_5, tag_6, tag_7, tag_8, tag_9, tag_10,
tag_11, tag_12, tag_13, tag_14, tag_15, tag_16, tag_17, tag_18, tag_19, tag_20,
tag_21, tag_22, tag_23, tag_24, tag_25, tag_26, tag_27, tag_28, tag_29, tag_30};
for (int i = 0; i < tag_num; ++i) {
buf[8 + i * 4] = (tags[i] >> 24) & 0xFF;
buf[9 + i * 4] = (tags[i] >> 16) & 0xFF;
buf[10 + i * 4] = (tags[i] >> 8) & 0xFF;
buf[11 + i * 4] = tags[i] & 0xFF;
buf[8 + i * 4] = (tags_array[i] >> 24) & 0xFF;
buf[9 + i * 4] = (tags_array[i] >> 16) & 0xFF;
buf[10 + i * 4] = (tags_array[i] >> 8) & 0xFF;
buf[11 + i * 4] = tags_array[i] & 0xFF;
}
// 计算CRC - 计算除了CRC本身之外的所有数据
@ -771,7 +536,7 @@ int uart_data_send_lighton(uart_utils_t *uart,uint8_t ledctl,uint16_t flash_i,ui
DEBUG_TX("lightsnNum = %d\n", tag_num);
for(int i=0;i<tag_num;i++) {
DEBUG_TX("tag%d = %08X\n", i+1, tags[i]);
DEBUG_TX("tag%d = %08X\n", i+1, tags_array[i]);
}
error:

View File

@ -308,12 +308,7 @@ int uart_data_send_lighton(uart_utils_t *uart,uint8_t ledctl,uint16_t flash_i,ui
uint32_t tag_21,uint32_t tag_22,uint32_t tag_23,uint32_t tag_24,uint32_t tag_25,
uint32_t tag_26,uint32_t tag_27,uint32_t tag_28,uint32_t tag_29,uint32_t tag_30,
uint32_t tag_num);
int uart_data_send_lable(uart_utils_t *uart,uint32_t tag_1,uint8_t tag_1_lable1,uint16_t tag_1_lable2,uint32_t tag_1_lable3,
uint32_t tag_2,uint8_t tag_2_lable1,uint16_t tag_2_lable2,uint32_t tag_2_lable3,
uint32_t tag_3,uint8_t tag_3_lable1,uint16_t tag_3_lable2,uint32_t tag_3_lable3,
uint32_t tag_4,uint8_t tag_4_lable1,uint16_t tag_4_lable2,uint32_t tag_4_lable3,
uint32_t tag_5,uint8_t tag_5_lable1,uint16_t tag_5_lable2,uint32_t tag_5_lable3,
uint32_t tag_num);
int uart_data_send_lable(uart_utils_t *uart, uint32_t tags[], uint8_t lable1[], uint16_t lable2[], uint32_t lable3[], uint32_t tag_num);
int uart_data_send_light_rule(uart_utils_t *uart,uint8_t lable_1,uint16_t lable_2,uint32_t lable_3,
uint8_t lable_1_rule, uint8_t lable_2_rule, uint8_t lable_3_rule,
uint8_t ledctrl, uint16_t flash_i, uint16_t light_d);
@ -332,4 +327,20 @@ int uart_data_receive_version(uart_utils_t *uart);
int uart_data_send_head_lightband(uart_utils_t *uart, uint8_t wakeup_time, uint16_t tag_num);
int uart_data_send_lightband(uart_utils_t *uart, uint8_t ledctl, uint16_t flash_i, uint16_t light_d, uint32_t tags[], uint8_t tag_leds[], uint16_t tag_num);
#define MAX_LABEL_NUM 30
typedef struct {
uint16_t len1;
uint8_t len2;
struct {
uint32_t tag;
uint8_t lable1;
uint16_t lable2;
uint32_t lable3;
} items[MAX_LABEL_NUM];
uint16_t crc;
} __attribute__((packed)) jt_lable_ledx_package_t;
int uart_data_send_head_lableup(uart_utils_t *uart, uint8_t wakeup_time, uint16_t tag_num);
int uart_data_send_lable(uart_utils_t *uart, uint32_t tags[], uint8_t lable1[], uint16_t lable2[], uint32_t lable3[], uint32_t tag_num);
#endif