| | |
| | | memcpy(&hbsend[14],&checksum,2); |
| | | } |
| | | u16 tyncpoll_time; |
| | | TrackingDiffClass *pUWBDistanceTrackingDiff; |
| | | void Program_Init(void) |
| | | {uint16_t i; |
| | | float temp; |
| | |
| | | // g_com_map[DEV_ID]=1; |
| | | // g_com_map[COM_INTERVAL]=10; |
| | | OUT485_ENABLE; |
| | | |
| | | |
| | | #ifdef DEBUG_MODE |
| | | |
| | | g_com_map[COM_INTERVAL]=50; |
| | | g_com_map[MAX_REPORT_ANC_NUM]=3; |
| | | g_com_map[DEV_ID]=1; |
| | | g_com_map[ANC_POLL]=1; |
| | | g_com_map[ANC_POLL]=0; |
| | | g_com_map[ALARM_DISTANCE1]=100; |
| | | #endif |
| | | pUWBDistanceTrackingDiff = NewTrackingDiffClass(2, 4, 0.03); |
| | | dev_id = g_com_map[DEV_ID]; |
| | | g_com_map[VERSION] = 0x010b; |
| | | g_com_map[VERSION] = 0x010d; |
| | | temp=(float)g_com_map[MAX_REPORT_ANC_NUM]*4/3; |
| | | temp2=g_com_map[DEV_ID]*g_com_map[MAX_REPORT_ANC_NUM]*4/3; |
| | | if(temp2<temp) |