| | |
| | | { |
| | | if(!memcmp(m_frame_data, "DIS", 3)) |
| | | { |
| | | 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_DISTANCE] =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[ALARM_DISTANCE] = g_com_map[ALARM_DISTANCE]*10 + m_frame_data[i]- '0'; |
| | | } |
| | | else |
| | | { |
| | | printf("Error: Wrong DISTANCE.\r\n"); |
| | | break; |
| | | } |
| | | } |
| | | printf("When distance < %d cm, alarm is on.\n", g_com_map[ALARM_DISTANCE]); |
| | | save_com_map_to_flash(); |
| | | } |