| | |
| | | if(g_com_map[MOTOR_ENABLE]) |
| | | { |
| | | |
| | | if(motor_keeptime>0) |
| | | { |
| | | motor_state = 2; |
| | | }else{ |
| | | motor_state = 0; |
| | | } |
| | | // if(motor_keeptime>0) |
| | | // { |
| | | // motor_state = 2; |
| | | // }else{ |
| | | // motor_state = 0; |
| | | // } |
| | | //motor_state=2; |
| | | switch(motor_state) |
| | | {case 0: |
| | |
| | | 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)|52; |
| | | g_com_map[VERSION] = (2<<8)|61; |
| | | |
| | | // g_com_map[DEV_ID]=0x7; |
| | | #ifdef DEBUG_MODE |
| | |
| | | imu_enable=g_com_map[IMU_ENABLE]; |
| | | motor_enable=g_com_map[MOTOR_ENABLE]; |
| | | uwb_active_flag = g_com_map[UWB_ACTIVE_FLAG_IDX]; |
| | | uwb_active_flag = 1; |
| | | 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; |
| | |
| | | { |
| | | g_com_map[MOTORBEEPER_INDEX] = 1; |
| | | } |
| | | hardware_type = g_com_map[MOTORBEEPER_INDEX]; |
| | | hardware_type = NSH1;//g_com_map[MOTORBEEPER_INDEX]; |
| | | switch(hardware_type) |
| | | { |
| | | case 1: |
| | |
| | | |
| | | void DoubleClickProcess(void) |
| | | { char temp[50]; |
| | | uint8_t len; |
| | | if(uwb_active_flag) |
| | | { |
| | | uwb_active_flag = 0; |
| | | HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3); |
| | | HAL_Delay(3000); |
| | | HAL_TIM_PWM_Stop(&htim2, TIM_CHANNEL_3); |
| | | }else{ |
| | | uwb_active_flag = 1; |
| | | HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3); |
| | | HAL_Delay(1000); |
| | | HAL_TIM_PWM_Stop(&htim2, TIM_CHANNEL_3); |
| | | } |
| | | g_com_map[UWB_ACTIVE_FLAG_IDX]= uwb_active_flag; |
| | | save_com_map_to_flash(); |
| | | // uint8_t len; |
| | | //if(uwb_active_flag) |
| | | //{ |
| | | // uwb_active_flag = 0; |
| | | // HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3); |
| | | // HAL_Delay(3000); |
| | | // HAL_TIM_PWM_Stop(&htim2, TIM_CHANNEL_3); |
| | | //}else{ |
| | | // uwb_active_flag = 1; |
| | | // HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3); |
| | | // HAL_Delay(1000); |
| | | // HAL_TIM_PWM_Stop(&htim2, TIM_CHANNEL_3); |
| | | //} |
| | | // g_com_map[UWB_ACTIVE_FLAG_IDX]= uwb_active_flag; |
| | | //save_com_map_to_flash(); |
| | | } |
| | | void HAL_UART_ErrorCallback(UART_HandleTypeDef *huart) |
| | | { |