| | |
| | | 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] = (2<<8)|53; |
| | | g_com_map[VERSION] = (2<<8)|60; |
| | | |
| | | // g_com_map[DEV_ID]=0x7; |
| | | #ifdef DEBUG_MODE |
| | |
| | | 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]; |
| | | tag_frequency = 1; |
| | | bigslot_num = TOTAL_SLOTNUM/tag_frequency; |
| | | current_slotnum=1; |
| | | current_time=GetLPTime(); |
| | |
| | | void HardWareTypeDiffConfig(void) |
| | | { |
| | | GPIO_InitTypeDef GPIO_InitStruct = {0}; |
| | | //if(g_com_map[MOTORBEEPER_INDEX]!=1&&g_com_map[MOTORBEEPER_INDEX]!=2) |
| | | if(g_com_map[MOTORBEEPER_INDEX]!=1&&g_com_map[MOTORBEEPER_INDEX]!=2) |
| | | { |
| | | g_com_map[MOTORBEEPER_INDEX] = 2; |
| | | } |
| | |
| | | /* USER CODE BEGIN 2 */ |
| | | LED_LG_ON; |
| | | Program_Init(); |
| | | LIS3DH_Data_Init(); |
| | | BarInit(); |
| | | Accelerometer_Init(); |
| | | BarInit(); |
| | | Dw1000_Init(); |
| | | Dw1000_App_Init(); |
| | | HardWareTypeDiffConfig(); |
| | |
| | | { |
| | | Error_Handler(); |
| | | } |
| | | LIS3DH_Check(); |
| | | |
| | | |
| | | // HAL_Delay(2000); |
| | | // mcu_sleep(); |
| | |
| | | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
| | | HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); |
| | | |
| | | LIS3DH_Check(); |
| | | |
| | | |
| | | HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); |
| | | HAL_PWR_DisableWakeUpPin(PWR_WAKEUP_PIN1); |
| | |
| | | HAL_PWR_EnterSTANDBYMode(); |
| | | } |
| | | extern u16 tagslotpos; |
| | | extern uint8_t tx_near_msg[80],stationary_flag,gotosleep_flag; |
| | | extern uint8_t tx_near_msg[80],stationary_flag,gotosleep_flag,current_sync_sec,tagpoll_sync_sec; |
| | | float key_keeptime; |
| | | extern float motor_ontime; |
| | | extern uint16_t rec_tagperiod; |
| | | void HAL_LPTIM_CompareMatchCallback(LPTIM_HandleTypeDef *hlptim) |
| | | { |
| | | static uint8_t i=0; |
| | | SystemClock_Config(); |
| | | g_start_send_flag=1; |
| | | |
| | | // current_slotnum++; |
| | | // SetNextPollTime(tagslotpos); |
| | | |
| | | if(current_sync_sec==tagpoll_sync_sec) |
| | | { |
| | | g_start_send_flag=1; |
| | | } |
| | | current_sync_sec++; |
| | | if(current_sync_sec>=(rec_tagperiod)/10||current_sync_sec>10) |
| | | { |
| | | current_sync_sec=0; |
| | | } |
| | | nomove_count+=1/(float)tag_frequency; |
| | | if(motor_keeptime>0) |
| | | { |