| | |
| | | // LED_TR_OFF; |
| | | current_time=GetLPTime(); |
| | | //motor_state=2; |
| | | if(g_com_map[MOTOR_ONTIME]>0) |
| | | { |
| | | g_com_map[MOTOR_ONTIME]--; |
| | | motor_state = 1; |
| | | } |
| | | if(g_com_map[MOTOR_ENABLE]) |
| | | { |
| | | switch(motor_state) |
| | | {case 0: |
| | | MOTOR_OFF; |
| | |
| | | MOTOR_OFF; |
| | | break; |
| | | } |
| | | } |
| | | if(HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin)) |
| | | { |
| | | nomove_count = 0; |
| | |
| | | u16 current_slotnum; |
| | | extern int32_t offsettimeus; |
| | | #define FIXSLOT |
| | | #define FIXSLOTPOS 3 |
| | | #define FIXSLOTPOS 5 |
| | | u16 slotpos_intoatl; |
| | | uint16_t bigslot_num; |
| | | uint8_t fix_slotpos =FIXSLOTPOS; |
| | |
| | | Usart1ParseDataCallback = UsartParseDataHandler; |
| | | parameter_init(); |
| | | //deca_sleep(1000); |
| | | g_com_map[VERSION] = 0x0205; |
| | | g_com_map[VERSION] = 0x0207; |
| | | #ifdef DEBUG_MODE |
| | | // g_com_map[DEV_ROLE]=1; |
| | | // g_com_map[DEV_ID]=0x123; |
| | |
| | | // g_com_map[MAX_REPORT_ANC_NUM]=1; |
| | | // g_com_map[NOMOVESLEEP_TIME]=10; |
| | | g_com_map[IMU_ENABLE]=0; |
| | | g_com_map[COM_INTERVAL]=100; |
| | | g_com_map[COM_INTERVAL]=50; |
| | | #endif |
| | | //g_com_map[NOMOVESLEEP_TIME]=10; |
| | | // g_com_map[COM_INTERVAL]=100; |
| | |
| | | { |
| | | g_com_map[COM_INTERVAL]=100; |
| | | } |
| | | if(module_power>MAX_RFPOWER) |
| | | {module_power=MAX_RFPOWER;} |
| | | if(module_power<0) |
| | | {module_power=0;} |
| | | if(g_com_map[POWER]>MAX_RFPOWER) |
| | | {g_com_map[POWER]=MAX_RFPOWER;} |
| | | if(g_com_map[POWER]<0) |
| | | {g_com_map[POWER]=0;} |
| | | module_power = g_com_map[POWER]; |
| | | imu_enable=g_com_map[IMU_ENABLE]; |
| | | motor_enable=g_com_map[MOTOR_ENABLE]; |
| | |
| | | } |
| | | if(m_bEUARTTxEn==0&&waitusart_timer==0) |
| | | { |
| | | #ifndef DEBUG_MODE |
| | | #ifndef DEBUG_MODE |
| | | if(!HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin)) |
| | | HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); |
| | | #endif |
| | | } |
| | |
| | | extern u16 tagslotpos; |
| | | extern uint8_t tx_near_msg[80],stationary_flag,gotosleep_flag; |
| | | float key_keeptime; |
| | | extern float motor_ontime; |
| | | void HAL_LPTIM_CompareMatchCallback(LPTIM_HandleTypeDef *hlptim) |
| | | { |
| | | static uint8_t i=0; |
| | |
| | | current_slotnum++; |
| | | SetNextPollTime(tagslotpos); |
| | | nomove_count+=(float)g_com_map[COM_INTERVAL]/1000; |
| | | if(motor_ontime>0) |
| | | { |
| | | motor_ontime-=(float)1/tag_frequency; |
| | | motor_state = 2; |
| | | }else{ |
| | | motor_state = 0; |
| | | } |
| | | if(!GET_USERKEY) |
| | | { |
| | | key_keeptime+=(float)g_com_map[COM_INTERVAL]/1000; |