| | |
| | | uint16_t vel_factor,pos_factor; |
| | | |
| | | extern u8 module_power; |
| | | u16 slottime,max_slotnum,current_slotpos; |
| | | void Program_Init(void) |
| | | {uint16_t i; |
| | | float temp; |
| | |
| | | { |
| | | module_power=67; |
| | | } |
| | | g_com_map[VERSION] = 0x0117; |
| | | g_com_map[VERSION] = 0x011e; |
| | | 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; |
| | | temp2=g_com_map[MAX_REPORT_ANC_NUM]*4/3; |
| | | if(temp2<temp) |
| | | { |
| | | temp2++; |
| | | } |
| | | tyncpoll_time=g_com_map[DEV_ID]*(temp2); |
| | | slottime=temp2; |
| | | max_slotnum=g_com_map[COM_INTERVAL]/temp2; |
| | | current_slotpos=g_com_map[DEV_ID]; |
| | | tyncpoll_time=(current_slotpos%max_slotnum)*slottime; |
| | | if(g_com_map[DEV_ROLE]) |
| | | { |
| | | printf("鏍囩ID: %d .\r\n",dev_id); |