| | |
|---|
| | | 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] = 0x010a; |
|---|
| | | g_com_map[VERSION] = 0x0111; |
|---|
| | | 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) |
|---|
