| | |
| | | } |
| | | else if(!memcmp(m_frame_data, "ID", 2)) |
| | | { |
| | | g_com_map[DEV_ID] = 0; |
| | | 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) |
| | | if(m_frame_data[i]<='9' && m_frame_data[i]>='0') |
| | | { |
| | | g_com_map[DEV_ID] = g_com_map[DEV_ID]*10 + 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 |
| | | { |
| | |
| | | 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 = %d. \r\n", g_com_map[DEV_ID]); |
| | | printf("set dev id = %x. \r\n", dev_id); |
| | | save_com_map_to_flash(); |
| | | }else if(!memcmp(m_frame_data, "INT", 3)) |
| | | { |