| | |
|---|
| | | checksum = Checksum_u16(&hbsend[2],12); |
|---|
| | | memcpy(&hbsend[14],&checksum,2); |
|---|
| | | } |
|---|
| | | uint16_t vel_factor,pos_factor; |
|---|
| | | u16 tyncpoll_time; |
|---|
| | | u16 slottime,max_slotpos; |
|---|
| | | extern u8 module_power; |
|---|
| | |
|---|
| | | { |
|---|
| | | g_com_map[COM_INTERVAL]=100; |
|---|
| | | } |
|---|
| | | g_com_map[VERSION] = 0x0121; |
|---|
| | | g_com_map[VERSION] = 0x0123; |
|---|
| | | dev_id = g_com_map[DEV_ID]; |
|---|
| | | slottime=ceil((double)g_com_map[MAX_REPORT_ANC_NUM]*SLOT_SCALE)+3; |
|---|
| | | max_slotpos=g_com_map[COM_INTERVAL]/slottime; |
|---|
| | | tyncpoll_time=(g_com_map[DEV_ID]%max_slotpos)*slottime; |
|---|
| | | module_power = g_com_map[POWER]; |
|---|
| | | total_slotnum = 1000/g_com_map[COM_INTERVAL]; |
|---|
| | | vel_factor=g_com_map[FILTER_COEFFICIENT]; |
|---|
| | | pos_factor=g_com_map[FILTER_COEFFICIENT]; |
|---|
| | | if(module_power>67) |
|---|
| | | { |
|---|
| | | module_power=67; |
|---|
