| | |
| | | // { |
| | | // lpcount+=LPTIMER_1S_COUNT; |
| | | // } |
| | | lpcount = last_lpcount+32768/tag_frequency; |
| | | lpcount = last_lpcount+32768/tag_frequency-time*LPTIMER_LSB; |
| | | while(lpcount>LPTIMER_1S_COUNT) |
| | | { |
| | | lpcount-=LPTIMER_1S_COUNT; |
| | |
| | | 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)|54; |
| | | g_com_map[VERSION] = (1<<8)|55; |
| | | |
| | | #ifdef DEBUG_MODE |
| | | // g_com_map[GROUP_ID]=21; |
| | | g_com_map[GROUP_ID]=21; |
| | | // g_com_map[DEV_ID]=4; |
| | | // g_com_map[COM_INTERVAL]=100; |
| | | // g_com_map[MAX_REPORT_ANC_NUM]=1; |
| | | // g_com_map[NOMOVESLEEP_TIME]=10; |
| | | #endif |
| | | |
| | | g_com_map[COM_INTERVAL] = 1000; |
| | | active_flag = g_com_map[ACTIVE_INDEX]; |
| | | module_power = g_com_map[POWER]; |
| | | g_com_map[IMU_ENABLE] = 0; |
| | |
| | | } |
| | | extern uint8_t tx_near_msg[80],stationary_flag; |
| | | float key_keeptime; |
| | | extern float freqlost_count; |
| | | extern float freqlost_count,range_lost_time; |
| | | void HAL_LPTIM_CompareMatchCallback(LPTIM_HandleTypeDef *hlptim) |
| | | { |
| | | static uint8_t i=0; |
| | |
| | | g_start_send_flag=1; |
| | | current_slotnum++; |
| | | freqlost_count+=1/(float)tag_frequency; |
| | | range_lost_time +=1/(float)tag_frequency; |
| | | |
| | | if(freqlost_count>FREQ_LOST_TIME) |
| | | { |
| | | tag_frequency = NOTAG_FREQ; |
| | | } |
| | | SetNextPollTime(tyncpoll_time); |
| | | if(range_lost_time<1||freqlost_count>FREQ_LOST_TIME) |
| | | { |
| | | SetNextPollTime(0); |
| | | }else{ |
| | | SetNextPollTime(5); |
| | | } |
| | | nomove_count+=1/(float)tag_frequency; |
| | | if(motor_keeptime>0) |
| | | { |