tz/AP05
3
0
Fork 0
mirror of http://180.163.74.83:13000/zhangzhenghao/AP05.git synced 2025-12-12 15:04:29 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity
master
AP05/uart_can/uart_can.c
hyx 103d478ba7 tx first version v1.1.7
2025-04-06 14:41:47 +08:00

853 lines
32 KiB
C
Raw Permalink Blame History

#include "uart_can.h"
#include "uart_utils.h"
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <unistd.h>
#define PRINT_TIME_TAG
#define DBG_TAG "uart_can"
#define DBG_LVL DBG_INFO
#include "debug_print.h"
uint16_t CRC16_XMODEM(uint8_t *puchMsg, uint32_t usDataLen)
{
uint16_t wCRCin = 0x0000;
uint16_t wCPoly = 0x1021;
uint8_t wChar = 0;
while (usDataLen--) {
wChar = *(puchMsg++);
wCRCin ^= (wChar << 8);
for (int i = 0; i < 8; i++) {
if (wCRCin & 0x8000) {
wCRCin = (wCRCin << 1) ^ wCPoly;
} else {
wCRCin = wCRCin << 1;
}
}
}
return (wCRCin);
}
int uart_data_send_head_lighton(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=14;
}else if(tag_num==2){
data_len=18;
}else if(tag_num==3){
data_len=22;
}else if(tag_num==4){
data_len=26;
}else if(tag_num==5){
data_len=30;
}
jt_head_package_t jt_head_package ={
.pre=0x2323,//# 0x23 $ 0x24
.wakeupTime=wakeup_time,//5s,<120s
.func='A',
.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("uart NULL pointer\n");
ret = -1;
goto error;
}
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__);
ret = -2;
goto error;
}
error:
return ret;
return 0;
}
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),
};
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))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
error:
return ret;
return 0;
}
int uart_data_send_head_lightonrule(uart_utils_t *uart,uint8_t wakeup_time){
int ret = 0;
if (uart == NULL){
LOG_I("uart NULL pointer\n");
ret = -1;
goto error;
}
jt_head_package_t jt_head_package ={
.pre=0x2323,//# 0x23 $ 0x24
.wakeupTime=wakeup_time,//5s,<120s
.func='C',
.len1=0x0000,
.len2=20,
.reserve=ntohs(0x0003),
.lableNum=ntohs(0x0001),
};
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(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__);
ret = -2;
goto error;
}
error:
return ret;
return 0;
}
int uart_data_send_head_search(uart_utils_t *uart,uint8_t wakeup_time){
int ret = 0;
if (uart == NULL){
LOG_I("uart NULL pointer\n");
ret = -1;
goto error;
}
jt_head_package_t jt_head_package ={
.pre=0x2323,//# 0x23 $ 0x24
.wakeupTime=wakeup_time,//5s,<120s
.func='D',
.len1=0x0000,
.len2=13,
.reserve=ntohs(0x0003),
.lableNum=ntohs(0x0001),
};
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(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__);
ret = -2;
goto error;
}
error:
return ret;
return 0;
}
int uart_data_send_search(uart_utils_t *uart,uint8_t lable_1,uint8_t lable_2,uint8_t lable_3,uint8_t lable_4,uint8_t lable_5,
uint8_t lable_6,uint8_t lable_7,uint8_t lable_8){
int ret = 0;
if (uart == NULL){
LOG_I("uart NULL pointer\n");
ret = -1;
goto error;
}
uint8_t test1[11] = {0x00,0x00,10,lable_1,lable_2,lable_3,lable_4,lable_5,lable_6,lable_7,lable_8};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<11;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_search_package_t jt_search_package ={
.len1=0x0000,
.len2=10,
.lable3_1=lable_1,
.lable3_2=lable_2,
.lable3_3=lable_3,
.lable3_4=lable_4,
.lable3_5=lable_5,
.lable3_6=lable_6,
.lable3_7=lable_7,
.lable3_8=lable_8,
.crc=ntohs(crc_c),
};
#if 1
if(sizeof(jt_search_package) == write(uart->uart_fd, &jt_search_package, sizeof(jt_search_package))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
#endif
error:
return ret;
return 0;
}
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 led_ctrl, uint16_t flash_i, uint16_t light_d){
int ret = 0;
if (uart == NULL){
LOG_I("uart NULL pointer\n");
ret = -1;
goto error;
}
uint8_t lable_2_1=(lable_2>>8)&0xFF;
uint8_t lable_2_2=(lable_2)&0xFF;
uint8_t lable_3_1=(lable_3>>24)&0xFF;
uint8_t lable_3_2=(lable_3>>16)&0xFF;
uint8_t lable_3_3=(lable_3>>8)&0xFF;
uint8_t lable_3_4=(lable_3)&0xFF;
uint8_t flash_i_1=(flash_i>>8)&0xFF;
uint8_t flash_i_2=(flash_i)&0xFF;
uint8_t light_d_1=(light_d>>8)&0xFF;
uint8_t light_d_2=(light_d)&0xFF;
uint8_t test1[18] = {0x00,0x00,17,lable_1,lable_2_1,lable_2_2,lable_3_1,lable_3_2,lable_3_3,lable_3_4,
lable_1_rule,lable_2_rule,lable_3_rule,led_ctrl,flash_i_1,flash_i_2,light_d_1,light_d_2};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<18;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_light_rule_package_t jt_light_rule_package ={
.len1=0x0000,
.len2=17,
.lable1=lable_1,
.lable2=ntohs(lable_2),
.lable3=ntohl(lable_3),
.lable1_rule=lable_1_rule,
.lable2_rule=lable_2_rule,
.lable3_rule=lable_3_rule,
.ledctrl=led_ctrl,
.flash_i=ntohs(flash_i),
.light_d=ntohs(light_d),
.crc=ntohs(crc_c),
};
if(sizeof(jt_light_rule_package) == write(uart->uart_fd, &jt_light_rule_package, sizeof(jt_light_rule_package))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
error:
return ret;
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 ret = 0;
if (uart == NULL){
LOG_I("uart NULL pointer\n");
ret = -1;
goto error;
}
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;
}
}
error:
return ret;
return 0;
}
int uart_data_send_lighton(uart_utils_t *uart,uint8_t ledctl,uint16_t flash_i,uint16_t light_d,
uint32_t tag_1,uint32_t tag_2,uint32_t tag_3,uint32_t tag_4,uint32_t tag_5,uint32_t tag_num){
int ret = 0;
if (uart == NULL){
LOG_I("uart NULL pointer\n");
ret = -1;
goto error;
}
uint8_t flash_i_h=(flash_i>>8)&0xFF;
uint8_t flash_i_l=(flash_i)&0xFF;
uint8_t light_d_h=(light_d>>8)&0xFF;
uint8_t light_d_l=(light_d)&0xFF;
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_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_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_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_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;
#if 0
LOG_I("ledctl = %02x\r\n",ledctl);
LOG_I("flash_i_h = %02x\r\n",flash_i_h);
LOG_I("flash_i_l = %02x\r\n",flash_i_l);
LOG_I("light_d_h = %02x\r\n",light_d_h);
LOG_I("light_d_l = %02x\r\n",light_d_l);
LOG_I("tag_1_1 = %02x\r\n",tag_1_1);
LOG_I("tag_1_2 = %02x\r\n",tag_1_2);
LOG_I("tag_1_3 = %02x\r\n",tag_1_3);
LOG_I("tag_1_4 = %02x\r\n",tag_1_4);
LOG_I("tag_2_1 = %02x\r\n",tag_2_1);
LOG_I("tag_2_2 = %02x\r\n",tag_2_2);
LOG_I("tag_2_3 = %02x\r\n",tag_2_3);
LOG_I("tag_2_4 = %02x\r\n",tag_2_4);
LOG_I("tag_3_1 = %02x\r\n",tag_3_1);
LOG_I("tag_3_2 = %02x\r\n",tag_3_2);
LOG_I("tag_3_3 = %02x\r\n",tag_3_3);
LOG_I("tag_3_4 = %02x\r\n",tag_3_4);
LOG_I("tag_4_1 = %02x\r\n",tag_4_1);
LOG_I("tag_4_2 = %02x\r\n",tag_4_2);
LOG_I("tag_4_3 = %02x\r\n",tag_4_3);
LOG_I("tag_4_4 = %02x\r\n",tag_4_4);
LOG_I("tag_5_1 = %02x\r\n",tag_5_1);
LOG_I("tag_5_2 = %02x\r\n",tag_5_2);
LOG_I("tag_5_3 = %02x\r\n",tag_5_3);
LOG_I("tag_5_4 = %02x\r\n",tag_5_4);
#endif
if(tag_num==1){
uint8_t test1[12] = {0x00,0x00,11,ledctl,flash_i_h,flash_i_l,light_d_h,light_d_l,
tag_1_1,tag_1_2,tag_1_3,tag_1_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<12;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_light_led1_package_t jt_light_led1_package ={
.len1=0x0000,
.len2=11,
.ledCtr=ledctl,
.flashInterval=ntohs(flash_i),
.lightDuration=ntohs(light_d),
.tag1=ntohl(tag_1),
.crc=ntohs(crc_c),
};
if(sizeof(jt_light_led1_package) == write(uart->uart_fd, &jt_light_led1_package, sizeof(jt_light_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[16] = {0x00,0x00,15,ledctl,flash_i_h,flash_i_l,light_d_h,light_d_l,
tag_1_1,tag_1_2,tag_1_3,tag_1_4,tag_2_1,tag_2_2,tag_2_3,tag_2_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<16;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_light_led2_package_t jt_light_led2_package ={
.len1=0x0000,
.len2=15,
.ledCtr=ledctl,
.flashInterval=ntohs(flash_i),
.lightDuration=ntohs(light_d),
.tag1=ntohl(tag_1),
.tag2=ntohl(tag_2),
.crc=ntohs(crc_c),
};
LOG_I("%04x,%02x,%02x,%04x,%04x,%08x,%08x,%04x\r\n",jt_light_led2_package.len1,jt_light_led2_package.len2,
jt_light_led2_package.ledCtr,jt_light_led2_package.flashInterval,jt_light_led2_package.lightDuration,
jt_light_led2_package.tag1,jt_light_led2_package.tag2,jt_light_led2_package.crc);
if(sizeof(jt_light_led2_package) == write(uart->uart_fd, &jt_light_led2_package, sizeof(jt_light_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[20] = {0x00,0x00,19,ledctl,flash_i_h,flash_i_l,light_d_h,light_d_l,
tag_1_1,tag_1_2,tag_1_3,tag_1_4,tag_2_1,tag_2_2,tag_2_3,tag_2_4,tag_3_1,tag_3_2,tag_3_3,tag_3_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<20;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_light_led3_package_t jt_light_led3_package ={
.len1=0x0000,
.len2=19,
.ledCtr=ledctl,
.flashInterval=ntohs(flash_i),
.lightDuration=ntohs(light_d),
.tag1=ntohl(tag_1),
.tag2=ntohl(tag_2),
.tag3=ntohl(tag_3),
.crc=ntohs(crc_c),
};
if(sizeof(jt_light_led3_package) == write(uart->uart_fd, &jt_light_led3_package, sizeof(jt_light_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[24] = {0x00,0x00,23,ledctl,flash_i_h,flash_i_l,light_d_h,light_d_l,
tag_1_1,tag_1_2,tag_1_3,tag_1_4,tag_2_1,tag_2_2,tag_2_3,tag_2_4,tag_3_1,tag_3_2,tag_3_3,tag_3_4,
tag_4_1,tag_4_2,tag_4_3,tag_4_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<24;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_light_led4_package_t jt_light_led4_package ={
.len1=0x0000,
.len2=23,
.ledCtr=ledctl,
.flashInterval=ntohs(flash_i),
.lightDuration=ntohs(light_d),
.tag1=ntohl(tag_1),
.tag2=ntohl(tag_2),
.tag3=ntohl(tag_3),
.tag4=ntohl(tag_4),
.crc=ntohs(crc_c),
};
if(sizeof(jt_light_led4_package) == write(uart->uart_fd, &jt_light_led4_package, sizeof(jt_light_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[28] = {0x00,0x00,27,ledctl,flash_i_h,flash_i_l,light_d_h,light_d_l,
tag_1_1,tag_1_2,tag_1_3,tag_1_4,tag_2_1,tag_2_2,tag_2_3,tag_2_4,tag_3_1,tag_3_2,tag_3_3,tag_3_4,
tag_4_1,tag_4_2,tag_4_3,tag_4_4,tag_5_1,tag_5_2,tag_5_3,tag_5_4};
uint16_t crc_c=CRC16_XMODEM(test1,sizeof(test1));
for(int i=0;i<28;i++){
printf("%02x ",test1[i]);
}
LOG_I("\r\n");
LOG_I("%s XModem_CRC16 = %04x\r\n",__func__,crc_c);
jt_light_led5_package_t jt_light_led5_package ={
.len1=0x0000,
.len2=27,
.ledCtr=ledctl,
.flashInterval=ntohs(flash_i),
.lightDuration=ntohs(light_d),
.tag1=ntohl(tag_1),
.tag2=ntohl(tag_2),
.tag3=ntohl(tag_3),
.tag4=ntohl(tag_4),
.tag5=ntohl(tag_5),
.crc=ntohs(crc_c),
};
if(sizeof(jt_light_led5_package) == write(uart->uart_fd, &jt_light_led5_package, sizeof(jt_light_led5_package))){
ret = 0;
//LOG_I("%s success\n",__func__);
}else{
//LOG_I("%s fail\n", __func__);
ret = -2;
goto error;
}
}
error:
return ret;
return 0;
}
int uart_data_receive_ack(uart_utils_t *uart,uint16_t *parm_ack){
int ret = 0;
jt_receive_package_t jt_receive_package;
ret = uart_read_until_time(uart->uart_fd,(char *)&jt_receive_package,sizeof(jt_receive_package_t), 1000, 50);
if(ret == sizeof(jt_receive_package_t)){
LOG_I("%s success:%04x,%04x,%04x,%04x\n", __func__,jt_receive_package.pre1,jt_receive_package.pre2,
jt_receive_package.pre3,jt_receive_package.ack);
if((jt_receive_package.pre1 == 0x2424)
&&(jt_receive_package.pre2 == 0x2424)
&&(jt_receive_package.pre3 == 0x2424)){
*parm_ack=jt_receive_package.ack;
}else{
LOG_I("%s failed\n", __func__);
ret = -2;
}
}else{
LOG_I("%s, failed, time out\n", __func__);
ret = -1;
}
return ret;
}
int uart_data_receive_data_back(uart_utils_t *uart,uint16_t *parmAck,uint32_t *tagCode,uint8_t *tagSignal,
uint8_t *totalLen,uint8_t *tagFeature,uint8_t *count,uint16_t *batteryV,uint16_t *version,uint8_t *ledCtrl,
uint8_t *lable1,uint16_t *lable2,uint32_t *lable3){
int ret = 0;
jt_data_back_package_t jt_data_back_package;
ret = uart_read_until_time(uart->uart_fd,(char *)&jt_data_back_package,sizeof(jt_data_back_package_t), 1000, 50);
if(ret == sizeof(jt_data_back_package_t)){
//LOG_I("%s success\n", __func__);
if((jt_data_back_package.pre1 == 0x2424)
&&(jt_data_back_package.pre2 == 0x2424)
&&(jt_data_back_package.pre3 == 0x2424)){
uint8_t pre4_1=(jt_data_back_package.pre4>>8)&0xFF;
uint8_t pre4_2=(jt_data_back_package.pre4)&0xFF;
uint8_t tagCode_1=(ntohl(jt_data_back_package.tag)>>24)&0xFF;
uint8_t tagCode_2=(ntohl(jt_data_back_package.tag)>>16)&0xFF;
uint8_t tagCode_3=(ntohl(jt_data_back_package.tag)>>8)&0xFF;
uint8_t tagCode_4=(ntohl(jt_data_back_package.tag))&0xFF;
uint8_t battery_1=(ntohs(jt_data_back_package.battery)>>8)&0xFF;
uint8_t battery_2=(ntohs(jt_data_back_package.battery))&0xFF;
uint8_t version_1=(ntohs(jt_data_back_package.version)>>8)&0xFF;
uint8_t version_2=(ntohs(jt_data_back_package.version))&0xFF;
uint8_t lable2_1=(ntohs(jt_data_back_package.lable2)>>8)&0xFF;
uint8_t lable2_2=(ntohs(jt_data_back_package.lable2))&0xFF;
uint8_t lable3_1=(ntohl(jt_data_back_package.lable3)>>24)&0xFF;
uint8_t lable3_2=(ntohl(jt_data_back_package.lable3)>>16)&0xFF;
uint8_t lable3_3=(ntohl(jt_data_back_package.lable3)>>8)&0xFF;
uint8_t lable3_4=(ntohl(jt_data_back_package.lable3))&0xFF;
uint8_t test1[15] = {jt_data_back_package.len,jt_data_back_package.featureCode,
jt_data_back_package.count,battery_1,battery_2,version_1,version_2,jt_data_back_package.ledCtrl,
jt_data_back_package.lable1,lable2_1,lable2_2,lable3_1,lable3_2,lable3_3,lable3_4};
uint16_t crc_c=CRC16_XMODEM(test1,15);
//for(int i=0;i<15;i++){
// printf("%02x ",test1[i]);
//}
//LOG_I("%s:XModem_CRC16 = %04x\r\n",__func__,crc_c);
//LOG_I("CRC = %04x\r\n",ntohs(jt_data_back_package.crc));
*parmAck=ntohs(jt_data_back_package.pre4);
*tagCode=ntohl(jt_data_back_package.tag);
*tagSignal=jt_data_back_package.signal;
*totalLen=jt_data_back_package.len;
*tagFeature=jt_data_back_package.featureCode;
*count=jt_data_back_package.count;
*batteryV=ntohs(jt_data_back_package.battery);
*version=ntohs(jt_data_back_package.version);
*ledCtrl=jt_data_back_package.ledCtrl;
*lable1=jt_data_back_package.lable1;
*lable2=ntohs(jt_data_back_package.lable2);
*lable3=ntohl(jt_data_back_package.lable3);
}else{
// LOG_I("%s failed\n", __func__);
ret = -2;
}
}else{
//LOG_I("%s, failed, time out\n", __func__);
ret = -1;
}
return ret;
}
Reference in New Issue View Git Blame Copy Permalink