| | |
|---|
| | | checksum = Checksum_u16(&hbsend[2],12); |
|---|
| | | memcpy(&hbsend[14],&checksum,2); |
|---|
| | | } |
|---|
| | | |
|---|
| | | uint16_t vel_factor,pos_factor; |
|---|
| | | u16 tyncpoll_time,dist_threshold,group_id; |
|---|
| | | u16 slottime,max_slotpos; |
|---|
| | | extern u8 module_power; |
|---|
| | | extern u16 total_slotnum; |
|---|
| | | void ComMapCheck(void) |
|---|
| | | { |
|---|
| | | |
|---|
| | | if(g_com_map[WAR_JDQ_TIME]>1000||g_com_map[WAR_JDQ_TIME]<0) |
|---|
| | | { |
|---|
| | | g_com_map[WAR_JDQ_TIME] = 1; |
|---|
| | | } |
|---|
| | | if(dist_threshold<300) |
|---|
| | | {dist_threshold = 300;} |
|---|
| | | if(dist_threshold>15000) |
|---|
| | | {dist_threshold = 15000;} |
|---|
| | | } |
|---|
| | | void Program_Init(void) |
|---|
| | | { float temp; |
|---|
| | | u16 temp2; |
|---|
| | |
|---|
| | | g_com_map[COM_INTERVAL]=100; |
|---|
| | | } |
|---|
| | | |
|---|
| | | g_com_map[VERSION] = 0x0132; |
|---|
| | | dist_threshold = (g_com_map[SPEEDFILTER_THRES]*10)/(1000/g_com_map[COM_INTERVAL]); |
|---|
| | | if(dist_threshold<300) |
|---|
| | | {dist_threshold = 300;} |
|---|
| | | if(dist_threshold>15000) |
|---|
| | | {dist_threshold = 15000;} |
|---|
| | | g_com_map[VERSION] = 0x0133; |
|---|
| | | dist_threshold = (g_com_map[SPEEDFILTER_THRES]*10)/(1000/g_com_map[COM_INTERVAL]); |
|---|
| | | ComMapCheck(); |
|---|
| | | g_com_map[SW_TYPE] = SW_FANGZHUANG; |
|---|
| | | dev_id = g_com_map[DEV_ID]; |
|---|
| | | group_id=g_com_map[GROUP_ID]; |
|---|
