| | |
| | | #include <stdio.h> |
| | | #include "dw_app.h" |
| | | #include "RTC.h" |
| | | uint8_t m_frame_data[MAX_FRAME_LEN] = {0}; |
| | | uint8_t m_frame_data_len = 0; |
| | | uint8_t g_pairstart=0; |
| | | void ParseFrame(void) |
| | | |
| | | |
| | | #define CMD_READ 1 |
| | | #define CMD_WRITE 2 |
| | | #define CMD_REPLY 3 |
| | | #define EUART_RX_BUF_SIZE 100 |
| | | typedef enum{ UsartReceiveWaitHead0, |
| | | UsartReceiveWaitHead1, |
| | | UsartReceiveWaitMsgType, |
| | | UsartReceiveWaitLength, |
| | | UsartReceiveWaitCMD, |
| | | UsartReceiveWaitIndex, |
| | | UsartReceiveWaitDataLen, |
| | | UsartReceiveWaitData, |
| | | UsartReceiveWaitChecksum |
| | | }UsartRecvPackState; |
| | | uint8_t mUsartReceivePack[100] = {0}; |
| | | |
| | | void SendComMap(uint8_t data_length, uint8_t index) |
| | | { |
| | | if(!memcmp(m_frame_data, "DIS1", 4)) |
| | | static uint8_t send_frame[EUART_RX_BUF_SIZE]; |
| | | uint16_t checksum = 0; |
| | | send_frame[0] = 0x55; |
| | | send_frame[1] = 0xAA; |
| | | send_frame[2] = 0x03; |
| | | send_frame[3] = data_length+5; |
| | | send_frame[4] = CMD_REPLY; |
| | | send_frame[5] = index; |
| | | send_frame[6] = data_length; |
| | | memcpy(&send_frame[7], &g_com_map[index], data_length); |
| | | for(int i = 0; i<(data_length+5); i++) |
| | | { |
| | | g_com_map[ALARM_DISTANCE1] =0; |
| | | for(uint8_t i=5; i < m_frame_data_len; i++) |
| | | { |
| | | if(m_frame_data[i]<58 && m_frame_data[i]>47) |
| | | { |
| | | g_com_map[ALARM_DISTANCE1] = g_com_map[ALARM_DISTANCE1]*10 + m_frame_data[i]- '0'; |
| | | checksum += send_frame[2+i]; |
| | | } |
| | | else |
| | | { |
| | | printf("Error: Wrong DISTANCE.\r\n"); |
| | | break; |
| | | } |
| | | } |
| | | printf("When distance1 < %d cm, alarm1 is on.\n", g_com_map[ALARM_DISTANCE1]); |
| | | save_com_map_to_flash(); |
| | | } |
| | | else if(!memcmp(m_frame_data, "DIS2", 4)) |
| | | { |
| | | g_com_map[ALARM_DISTANCE2] =0; |
| | | for(uint8_t i=5; i < m_frame_data_len; i++) |
| | | { |
| | | if(m_frame_data[i]<58 && m_frame_data[i]>47) |
| | | { |
| | | g_com_map[ALARM_DISTANCE2] = g_com_map[ALARM_DISTANCE2]*10 + m_frame_data[i]- '0'; |
| | | } |
| | | else |
| | | { |
| | | printf("Error: Wrong DISTANCE.\r\n"); |
| | | break; |
| | | } |
| | | } |
| | | printf("When distance2 < %d cm, alarm2 is on.\n", g_com_map[ALARM_DISTANCE2]); |
| | | save_com_map_to_flash(); |
| | | } |
| | | else if(!memcmp(m_frame_data, "DIS3", 4)) |
| | | { |
| | | g_com_map[ALARM_DISTANCE3] =0; |
| | | for(uint8_t i=5; i < m_frame_data_len; i++) |
| | | { |
| | | if(m_frame_data[i]<58 && m_frame_data[i]>47) |
| | | { |
| | | g_com_map[ALARM_DISTANCE3] = g_com_map[ALARM_DISTANCE3]*10 + m_frame_data[i]- '0'; |
| | | } |
| | | else |
| | | { |
| | | printf("Error: Wrong DISTANCE.\r\n"); |
| | | break; |
| | | } |
| | | } |
| | | printf("When distance3 < %d cm, alarm3 is on.\n", g_com_map[ALARM_DISTANCE3]); |
| | | save_com_map_to_flash(); |
| | | } |
| | | else if(!memcmp(m_frame_data, "DEV", 3)) |
| | | { |
| | | g_com_map[ALARM_DEV] = m_frame_data[4]-'0'; |
| | | printf("Alarm device is %d. \n", g_com_map[ALARM_DEV]); |
| | | save_com_map_to_flash(); |
| | | } |
| | | else if(!memcmp(m_frame_data, "ID", 2)) |
| | | { |
| | | dev_id = 0; |
| | | for(uint8_t i=3; i < m_frame_data_len; i++) |
| | | { |
| | | if(m_frame_data[i]<='9' && m_frame_data[i]>='0') |
| | | { |
| | | dev_id = (dev_id<<4)|(m_frame_data[i]- '0'); |
| | | }else if(m_frame_data[i]<='f' && m_frame_data[i]>='a') |
| | | { |
| | | dev_id = (dev_id<<4)|(m_frame_data[i]- 'a'+10); |
| | | }else if(m_frame_data[i]<='F' && m_frame_data[i]>='A') |
| | | { |
| | | dev_id = (dev_id<<4)|(m_frame_data[i]- 'A'+10); |
| | | } |
| | | else |
| | | { |
| | | printf("Error: Wrong ID.\r\n"); |
| | | break; |
| | | } |
| | | } |
| | | g_com_map[DEV_ID_L] = dev_id; |
| | | g_com_map[DEV_ID_H] = dev_id>>16; |
| | | Dw1000_App_Init(); |
| | | printf("set dev id = %x. \r\n", dev_id); |
| | | save_com_map_to_flash(); |
| | | }else if(!memcmp(m_frame_data, "INT", 3)) |
| | | { |
| | | g_com_map[COM_INTERVAL] = 0; |
| | | for(uint8_t i=4; i < m_frame_data_len; i++) |
| | | { |
| | | if(m_frame_data[i]<58 && m_frame_data[i]>47) |
| | | { |
| | | g_com_map[COM_INTERVAL] = g_com_map[COM_INTERVAL]*10 + m_frame_data[i]- '0'; |
| | | } |
| | | else |
| | | { |
| | | printf("Error: Wrong COM_INTERVAL.\r\n"); |
| | | break; |
| | | } |
| | | } |
| | | printf("set dev interval = %d ms. \r\n", g_com_map[COM_INTERVAL]); |
| | | RTC_Configuration(g_com_map[COM_INTERVAL]*20); |
| | | save_com_map_to_flash(); |
| | | }else if(!memcmp(m_frame_data, "PAIRID", 6)) |
| | | { |
| | | g_com_map[PAIR_ID] = 0; |
| | | for(uint8_t i=7; i < m_frame_data_len; i++) |
| | | { |
| | | if(m_frame_data[i]<58 && m_frame_data[i]>47) |
| | | { |
| | | g_com_map[PAIR_ID] = g_com_map[PAIR_ID]*10 + m_frame_data[i]- '0'; |
| | | } |
| | | else |
| | | { |
| | | printf("Error: Wrong PAIR_ID.\r\n"); |
| | | break; |
| | | } |
| | | } |
| | | printf("set dev PAIR_ID = %d . \r\n", g_com_map[PAIR_ID]); |
| | | save_com_map_to_flash(); |
| | | }else if(!memcmp(m_frame_data, "STARTPAIR", 9)) |
| | | { |
| | | g_pairstart=1; |
| | | printf("Start Pair Mode. \r\n"); |
| | | }else{ |
| | | printf("Error: Wrong Command.\r\n"); |
| | | } |
| | | checksum = Checksum_u16(&send_frame[2],5+data_length); |
| | | memcpy(&send_frame[7+data_length],&checksum,2); |
| | | |
| | | UART_PushFrame(send_frame, data_length+9); |
| | | } |
| | | |
| | | void UsartParseDataHandler(uint8_t data) |
| | | { |
| | | static uint8_t s_usart_state = 0; |
| | | static uint8_t s_data_pos; |
| | | static UsartRecvPackState usart_receive_state = UsartReceiveWaitHead0; |
| | | uint16_t checksum = 0; |
| | | static uint8_t pack_datalen = 0,pack_length = 0,pack_index = 0,pack_msgtype = 0,pack_cmd = CMD_READ; |
| | | static uint8_t index = 0; |
| | | |
| | | switch(s_usart_state) |
| | | { |
| | | case 0: |
| | | if(data=='A') s_usart_state= 1; |
| | | break; |
| | | |
| | | case 1: |
| | | if(data=='T') s_usart_state = 2; |
| | | break; |
| | | |
| | | case 2: |
| | | if(data=='+') |
| | | { |
| | | s_usart_state = 3; |
| | | s_data_pos = 0; |
| | | m_frame_data_len = 0; |
| | | if(usart_receive_state == UsartReceiveWaitChecksum) { //è¥æ¶å°æ ¡éªåå
|
| | | checksum = 0; |
| | | for(int i = 0; i<pack_length-5; i++) { |
| | | checksum += mUsartReceivePack[i]; |
| | | } |
| | | break; |
| | | |
| | | case 3: |
| | | m_frame_data_len = s_data_pos; |
| | | m_frame_data[s_data_pos++] = data; |
| | | if(data == 0x0d) |
| | | checksum += pack_cmd; |
| | | checksum += pack_length; |
| | | checksum += pack_index; |
| | | checksum += pack_datalen; |
| | | checksum += pack_msgtype; |
| | | if((data + checksum)&0xff == 0xFF) //æ ¡éªéè¿ |
| | | { |
| | | s_usart_state = 4; |
| | | } |
| | | if(s_data_pos >= MAX_FRAME_LEN) //妿è¶
è¿æå¤§é¿åº¦ |
| | | switch(pack_cmd) |
| | | { |
| | | m_frame_data_len = MAX_FRAME_LEN; |
| | | ParseFrame(); |
| | | s_usart_state = 0; |
| | | } |
| | | case CMD_WRITE: |
| | | //ä»mUsartReceivePackä¸è¯»åpack_lengthé¿åº¦çåèï¼æ¾å°å
¨å±åéä¸ |
| | | memcpy((uint8_t*)&g_com_map + pack_index, mUsartReceivePack, pack_length); |
| | | //è¿åä¸ä¸ªerrorç¶æ |
| | | //SendComMap(pack_datalen,pack_index); |
| | | save_com_map_to_flash(); |
| | | delay_ms(100); |
| | | NVIC_SystemReset(); |
| | | break; |
| | | |
| | | case 4: |
| | | if(data == 0x0a) |
| | | { |
| | | ParseFrame(); |
| | | s_usart_state = 0; |
| | | } |
| | | case CMD_READ: |
| | | //readå
ä¸dataåèï¼å³mUsartReceivePack[0]è¡¨ç¤ºæ°æ®é¿åº¦ï¼ |
| | | //ä»g_com_dataç»æä½ä¸ç第indexä½ç½®è¯»åé¿åº¦ä¸ºmUsartReceivePack[0]çåèï¼åéåºæ¥ |
| | | SendComMap(pack_datalen,pack_index>>1); |
| | | break; |
| | | |
| | | default: break; |
| | | default: |
| | | break; |
| | | } |
| | | } |
| | | usart_receive_state = UsartReceiveWaitHead0; |
| | | pack_index = 0; |
| | | pack_length = 0; |
| | | index=0; |
| | | } else if((usart_receive_state == UsartReceiveWaitData) && (pack_index < pack_length)) { //è¥ææ¶å°çæ¯æ£å¸¸é讯å
|
| | | mUsartReceivePack[index] = data; |
| | | index++; |
| | | if(index == pack_length-5) { //妿æ¶å°çindexä¸é¿åº¦ç¸ç |
| | | usart_receive_state = UsartReceiveWaitChecksum; |
| | | } |
| | | } else if(usart_receive_state == UsartReceiveWaitDataLen) { //æ¶å°æä»¤ç±»ååè |
| | | pack_datalen = data; |
| | | usart_receive_state = UsartReceiveWaitData; |
| | | }else if(usart_receive_state == UsartReceiveWaitIndex) { //æ¶å°æä»¤ç±»ååè |
| | | pack_index = data; |
| | | usart_receive_state = UsartReceiveWaitDataLen; |
| | | } else if(usart_receive_state == UsartReceiveWaitCMD) { //æ¶å°æä»¤ç±»ååè |
| | | pack_cmd = data; |
| | | usart_receive_state = UsartReceiveWaitIndex; |
| | | } else if(usart_receive_state == UsartReceiveWaitLength) { //æ¶å°é¿åº¦åè |
| | | |
| | | pack_length = data; |
| | | pack_index = 0; |
| | | usart_receive_state = UsartReceiveWaitCMD; |
| | | |
| | | } else if((usart_receive_state == UsartReceiveWaitHead0) && (data == 0x55)) { //æ¶å°ç¬¬ä¸ä¸ªå
头 |
| | | usart_receive_state = UsartReceiveWaitHead1; |
| | | } else if((usart_receive_state == UsartReceiveWaitHead1) && (data == 0xAA)) { //æ¶å°ç¬¬äºä¸ªå
头 |
| | | usart_receive_state = UsartReceiveWaitMsgType; |
| | | }else if ((usart_receive_state == UsartReceiveWaitMsgType) && (data == 0x3)) { |
| | | usart_receive_state = UsartReceiveWaitLength; |
| | | pack_msgtype = data; |
| | | } |
| | | else { |
| | | usart_receive_state = UsartReceiveWaitHead0; |
| | | pack_index = 0; |
| | | pack_length = 0; |
| | | } |
| | | |
| | | } |