| | |
| | | #include "serial_at_cmd_app.h" |
| | | #include "global_param.h" |
| | | #include <string.h> |
| | | |
| | | #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) |
| | | { |
| | | if(!memcmp(m_frame_data, "SET", 3)) |
| | | if(!memcmp(m_frame_data, "DIS1", 4)) |
| | | { |
| | | g_com_map[ALARM_DISTANCE] = (m_frame_data[3]-'0')*1000 + (m_frame_data[4]-'0')*100 + (m_frame_data[5]-'0')*10 + (m_frame_data[6]-'0'); |
| | | 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'; |
| | | } |
| | | 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[3]-'0'; |
| | | 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)) |
| | | { |
| | | g_com_map[DEV_ID] = 0; |
| | | for(uint8_t i=3; i < m_frame_data_len; i++) |
| | | { |
| | | if(m_frame_data[i]<58 && m_frame_data[i]>47) |
| | | { |
| | | g_com_map[DEV_ID] = g_com_map[DEV_ID]*10 + m_frame_data[i]- '0'; |
| | | } |
| | | else |
| | | { |
| | | printf("Error: Wrong ID.\r\n"); |
| | | break; |
| | | } |
| | | } |
| | | Dw1000_App_Init(); |
| | | printf("set dev id = %d. \r\n", g_com_map[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"); |
| | | } |
| | | } |
| | | |