| | |
| | | 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)|70; |
| | | g_com_map[VERSION] = (2<<8)|1; |
| | | |
| | | // g_com_map[DEV_ID]=0x7; |
| | | #ifdef DEBUG_MODE |
| | |
| | | Program_Init(); |
| | | Accelerometer_Init(); |
| | | // BarInit(); |
| | | Dw1000_Init(); |
| | | Dw1000_App_Init(); |
| | | HardWareTypeDiffConfig(); |
| | | dwt_configuresleep(DWT_PRESRV_SLEEP | DWT_CONFIG, DWT_WAKE_CS | DWT_WAKE_WK| DWT_SLP_EN); |
| | | dwt_entersleep(); |
| | | GPIO_InitTypeDef GPIO_InitStruct = {0}; |
| | | |
| | | HAL_GPIO_WritePin(DW1000_RSTn_GPIO, DW1000_RSTn, GPIO_PIN_RESET); |
| | | |
| | | GPIO_InitStruct.Pin = DW1000_RSTn; |
| | | GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; |
| | | GPIO_InitStruct.Pull = GPIO_NOPULL; |
| | | GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; |
| | | HAL_GPIO_Init(DW1000_RSTn_GPIO, &GPIO_InitStruct); |
| | | // Dw1000_Init(); |
| | | // Dw1000_App_Init(); |
| | | // HardWareTypeDiffConfig(); |
| | | // dwt_configuresleep(DWT_PRESRV_SLEEP | DWT_CONFIG, DWT_WAKE_CS | DWT_WAKE_WK| DWT_SLP_EN); |
| | | // dwt_entersleep(); |
| | | // waitusart_timer=tag_frequency*USART_KEEPWAKE_TIME;; |
| | | DW_DISABLE; |
| | | if(HAL_UART_Receive_DMA(&huart1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE)) |
| | |
| | | HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); |
| | | #endif |
| | | } |
| | | if(g_start_send_flag&&active_flag) |
| | | { static uint16_t blink_count=0; |
| | | g_start_send_flag = 0; |
| | | // GetPressAndTemp(); |
| | | // if(current_count>slot_startcount&¤t_count<slot_startcount+interval_count) |
| | | // { |
| | | // HAL_GPIO_WritePin(LED0_GPIO, GPIO_PIN_9, GPIO_PIN_SET); |
| | | // if(g_start_send_flag&&active_flag) |
| | | // { static uint16_t blink_count=0; |
| | | // g_start_send_flag = 0; |
| | | // // GetPressAndTemp(); |
| | | //// if(current_count>slot_startcount&¤t_count<slot_startcount+interval_count) |
| | | //// { |
| | | //// HAL_GPIO_WritePin(LED0_GPIO, GPIO_PIN_9, GPIO_PIN_SET); |
| | | //// }else{ |
| | | //// HAL_GPIO_WritePin(LED0_GPIO, GPIO_PIN_9, GPIO_PIN_RESET); |
| | | //// } |
| | | //// LED_TR_BLINK; |
| | | // __disable_irq(); |
| | | // if(bat_percent>15) |
| | | // { LED_TB_ON; |
| | | // Tag_App(); |
| | | // LED_TB_OFF; |
| | | // }else{ |
| | | // HAL_GPIO_WritePin(LED0_GPIO, GPIO_PIN_9, GPIO_PIN_RESET); |
| | | // LED_TR_ON; |
| | | // Tag_App(); |
| | | // LED_TR_OFF; |
| | | // } |
| | | // LED_TR_BLINK; |
| | | __disable_irq(); |
| | | if(bat_percent>15) |
| | | { LED_TB_ON; |
| | | Tag_App(); |
| | | LED_TB_OFF; |
| | | }else{ |
| | | LED_TR_ON; |
| | | Tag_App(); |
| | | LED_TR_OFF; |
| | | } |
| | | __enable_irq(); |
| | | //LED0_BLINK; |
| | | IdleTask(); |
| | | if(waitusart_timer>0) |
| | | { |
| | | waitusart_timer--; |
| | | } |
| | | |
| | | }else{ |
| | | // __enable_irq(); |
| | | // //LED0_BLINK; |
| | | // IdleTask(); |
| | | // if(waitusart_timer>0) |
| | | // { |
| | | // waitusart_timer--; |
| | | // } |
| | | // |
| | | // }else{ |
| | | IdleTask(); |
| | | } |
| | | // } |
| | | |
| | | // HAL_Delay(100); |
| | | // Get_Battary(); |
| | |
| | | extern uint8_t tx_near_msg[80],stationary_flag,gotosleep_flag; |
| | | float key_keeptime; |
| | | extern float motor_ontime,button_delay; |
| | | u32 kongzhi_f4_kaiji_time; |
| | | void HAL_LPTIM_CompareMatchCallback(LPTIM_HandleTypeDef *hlptim) |
| | | { |
| | | static uint8_t i=0; |
| | |
| | | g_start_send_flag=1; |
| | | // current_slotnum++; |
| | | // SetNextPollTime(tagslotpos); |
| | | if(button_delay<1) |
| | | button_delay+=1/(float)tag_frequency; |
| | | nomove_count+=1/(float)tag_frequency; |
| | | if(motor_keeptime>0) |
| | | { |
| | | motor_keeptime-=1/(float)tag_frequency; |
| | | } |
| | | if(motor_keeptime<0) |
| | | {motor_keeptime = 0;} |
| | | if(active_flag==0) |
| | | { |
| | | if(!GET_USERKEY) |
| | | { |
| | | LED_LG_ON; |
| | | key_keeptime+=1/(float)tag_frequency; |
| | | if(key_keeptime>3) |
| | | { |
| | | u8 i=250,keystate=1; |
| | | while(i--) |
| | | { |
| | | if(i%10==0) |
| | | { |
| | | LED_LG_BLINK; |
| | | } |
| | | if(GET_USERKEY) |
| | | {keystate = 0;} |
| | | if(keystate==0&&!GET_USERKEY) |
| | | { |
| | | parameter_init(); |
| | | g_com_map[ACTIVE_INDEX] = 1; |
| | | save_com_map_to_flash(); |
| | | delay_ms(100); |
| | | SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader |
| | | } |
| | | delay_ms(10); |
| | | } |
| | | } |
| | | }else{ |
| | | LED_LG_OFF; |
| | | key_keeptime=0; |
| | | } |
| | | |
| | | } |
| | | // if(button_delay<1) |
| | | kongzhi_f4_kaiji_time++; |
| | | if(kongzhi_f4_kaiji_time>10800) |
| | | { |
| | | kongzhi_f4_kaiji_time=0; |
| | | HAL_GPIO_WritePin(DW1000_RSTn_GPIO, DW1000_RSTn, GPIO_PIN_SET); |
| | | GPIO_InitTypeDef GPIO_InitStruct = {0}; |
| | | GPIO_InitStruct.Pin = DW1000_RSTn; |
| | | GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; |
| | | GPIO_InitStruct.Pull = GPIO_NOPULL; |
| | | GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; |
| | | HAL_GPIO_Init(DW1000_RSTn_GPIO, &GPIO_InitStruct); |
| | | |
| | | delay_ms(1000); |
| | | |
| | | GPIO_InitStruct.Pin = DW1000_RSTn; |
| | | GPIO_InitStruct.Mode = GPIO_MODE_INPUT;// 设置为输入模式 |
| | | GPIO_InitStruct.Pull = GPIO_PULLUP;//不使用上拉或下拉 |
| | | HAL_GPIO_Init(DW1000_RSTn_GPIO,&GPIO_InitStruct); //初始化GPIO |
| | | } |
| | | // button_delay+=1/(float)tag_frequency; |
| | | // nomove_count+=1/(float)tag_frequency; |
| | | // if(motor_keeptime>0) |
| | | // { |
| | | // motor_keeptime-=1/(float)tag_frequency; |
| | | // } |
| | | // if(motor_keeptime<0) |
| | | // {motor_keeptime = 0;} |
| | | // if(active_flag==0) |
| | | // { |
| | | //// if(!GET_USERKEY) |
| | | //// { |
| | | //// LED_LG_ON; |
| | | //// key_keeptime+=1/(float)tag_frequency; |
| | | //// if(key_keeptime>3) |
| | | //// { |
| | | //// u8 i=250,keystate=1; |
| | | //// while(i--) |
| | | //// { |
| | | //// if(i%10==0) |
| | | //// { |
| | | //// LED_LG_BLINK; |
| | | //// } |
| | | //// if(GET_USERKEY) |
| | | //// {keystate = 0;} |
| | | //// if(keystate==0&&!GET_USERKEY) |
| | | //// { |
| | | //// parameter_init(); |
| | | //// g_com_map[ACTIVE_INDEX] = 1; |
| | | //// save_com_map_to_flash(); |
| | | //// delay_ms(100); |
| | | //// SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader |
| | | //// } |
| | | //// delay_ms(10); |
| | | //// } |
| | | //// } |
| | | //// }else{ |
| | | //// LED_LG_OFF; |
| | | //// key_keeptime=0; |
| | | //// } |
| | | // |
| | | // } |
| | | |
| | | if(!GET_USERKEY) |
| | | { |
| | | key_keeptime+=1/(float)tag_frequency; |
| | | if(key_keeptime>=KEY_KEEPRESET_TIME) |
| | | { |
| | | SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; |
| | | } |
| | | }else{ |
| | | key_keeptime=0; |
| | | } |
| | | if(nomove_count>g_com_map[STATIONARY_TIME]) |
| | | { |
| | | stationary_flag = 1; |
| | | }else{ |
| | | stationary_flag = 0; |
| | | } |
| | | if(nomove_count>=g_com_map[NOMOVESLEEP_TIME]-1&&imu_enable) |
| | | { |
| | | gotosleep_flag=1; |
| | | }else{ |
| | | gotosleep_flag=0; |
| | | } |
| | | #ifndef DEBUG_MODE |
| | | if(nomove_count>g_com_map[NOMOVESLEEP_TIME]&&imu_enable) |
| | | { |
| | | mcu_sleep(); |
| | | } |
| | | #endif |
| | | // if(!GET_USERKEY) |
| | | // { |
| | | // key_keeptime+=1/(float)tag_frequency; |
| | | // if(key_keeptime>=KEY_KEEPRESET_TIME) |
| | | // { |
| | | // SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; |
| | | // } |
| | | // }else{ |
| | | // key_keeptime=0; |
| | | // } |
| | | // if(nomove_count>g_com_map[STATIONARY_TIME]) |
| | | // { |
| | | // stationary_flag = 1; |
| | | // }else{ |
| | | // stationary_flag = 0; |
| | | // } |
| | | //if(nomove_count>=g_com_map[NOMOVESLEEP_TIME]-1&&imu_enable) |
| | | // { |
| | | // gotosleep_flag=1; |
| | | // }else{ |
| | | // gotosleep_flag=0; |
| | | // } |
| | | //#ifndef DEBUG_MODE |
| | | // if(nomove_count>g_com_map[NOMOVESLEEP_TIME]&&imu_enable) |
| | | // { |
| | | // mcu_sleep(); |
| | | // } |
| | | //#endif |
| | | } |
| | | /* USER CODE END 4 */ |
| | | |