| | |
|---|
| | | /* USER CODE BEGIN 0 */ |
|---|
| | | #define DIANLIANG_TIME 3600 |
|---|
| | | uint8_t Anchor_Vcc_Flag; |
|---|
| | | uint16_t Anchor_Vcc_time=DIANLIANG_TIME-2; |
|---|
| | | uint16_t Anchor_Vcc_time=DIANLIANG_TIME+1; |
|---|
| | | uint32_t dev_id; |
|---|
| | | uint16_t heartbeat_timer,poll_timer,sync_timer; |
|---|
| | | uint8_t aRxBuffer[1],group_id; |
|---|
| | |
|---|
| | | hardware_pici = STMFLASH_ReadHalfWord(FLASH_HARDWARE_VERSION_MAP+2); |
|---|
| | | hardware_type = STMFLASH_ReadHalfWord(FLASH_HARDWARE_VERSION_MAP+4); |
|---|
| | | //deca_sleep(1000); |
|---|
| | | g_com_map[VERSION] = (1<<8)|2; |
|---|
| | | g_com_map[VERSION] = (1<<8)|10; |
|---|
| | | // testprogram(); |
|---|
| | | // g_com_map[DEV_ID]=0x6777; |
|---|
| | | #ifdef DEBUG_MODE |
|---|
| | |
|---|
| | | g_com_map[GROUP_ID]=0; |
|---|
| | | |
|---|
| | | g_com_map[COM_INTERVAL] = 1000; |
|---|
| | | if(g_com_map[COM_INTERVAL]<1000) |
|---|
| | | {g_com_map[COM_INTERVAL] = 1000;} |
|---|
| | | active_flag = g_com_map[ACTIVE_INDEX]; |
|---|
| | | // g_com_map[POWER]=0; |
|---|
| | | if(g_com_map[UWBPOLLTIME_MS_IDX]<10) //如果uwbpoll 时间小于10，随机生成一个小于一千的数。 |
|---|
| | | {g_com_map[UWBPOLLTIME_MS_IDX] = GetRandomValue()%1000+10;} |
|---|
| | | |
|---|
| | | if(g_com_map[UWBPOLLTIME_MS_IDX]>1000) |
|---|
| | | { |
|---|
| | | g_com_map[UWBPOLLTIME_MS_IDX] = GetRandomValue()%1000+10; |
|---|
| | | } |
|---|
| | | |
|---|
| | | module_power = g_com_map[POWER]; |
|---|
| | | g_com_map[IMU_ENABLE] = 0; |
|---|
| | | imu_enable=g_com_map[IMU_ENABLE]; |
|---|
| | | motor_enable=g_com_map[MOTOR_ENABLE]; |
|---|
| | | |
|---|
| | | |
|---|
| | | group_id=g_com_map[GROUP_ID]; |
|---|
| | | 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; |
|---|
| | | slot_startcount=tyncpoll_time*1000/LPTIMER_LSB; |
|---|
| | | lastpoll_time=tyncpoll_time; |
|---|
| | | tag_frequency = 1000/g_com_map[COM_INTERVAL]; |
|---|
| | | total_slotnum = 1000/g_com_map[COM_INTERVAL]; |
|---|
| | | nomovesleeptime = g_com_map[NOMOVESLEEP_TIME]; |
|---|
| | | if(active_flag==0) |
|---|
| | | { |
|---|
| | | |
|---|
| | | } |
|---|
| | | |
|---|
| | | // g_com_map[COM_INTERVAL]=100; |
|---|
| | | if(g_com_map[COM_INTERVAL]==0) |
|---|
| | | { |
|---|
| | | g_com_map[COM_INTERVAL]=1000; |
|---|
| | | } |
|---|
| | | if(module_power>67) |
|---|
| | | {module_power=67;} |
|---|
| | | |
|---|
| | | current_slotnum=1; |
|---|
| | | current_time=GetLPTime(); |
|---|
| | | |
|---|
| | | if (HAL_LPTIM_TimeOut_Start_IT(&hlptim1, LPTIMER_1S_COUNT, slot_startcount) != HAL_OK) //system time is 1010ms 1 puls=30.518us |
|---|
| | | { |
|---|
| | | Error_Handler(); |
|---|
| | |
|---|
| | | static uint8_t i=0; |
|---|
| | | SystemClock_Config(); |
|---|
| | | i++; |
|---|
| | | Anchor_Vcc_time++; |
|---|
| | | if(Anchor_Vcc_time>DIANLIANG_TIME) |
|---|
| | | if(Anchor_Vcc_time++>DIANLIANG_TIME) |
|---|
| | | { |
|---|
| | | Anchor_Vcc_Flag=1; |
|---|
| | | Anchor_Vcc_time=0; |
|---|
