| | |
| | | #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, "DIS1", 4)) |
| | |
| | | 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"); |
| | | } |
| | | } |
| | | |