| | |
| | | {MOTOR_OFF; |
| | | }else if(hardware_type==GP) |
| | | { |
| | | HAL_TIM_PWM_Stop(&htim21, TIM_CHANNEL_3); |
| | | HAL_TIM_PWM_Stop(&htim21, TIM_CHANNEL_2); |
| | | } |
| | | break; |
| | | case 1: |
| | |
| | | {MOTOR_ON; |
| | | }else if(hardware_type==GP) |
| | | { |
| | | HAL_TIM_PWM_Start(&htim21, TIM_CHANNEL_3); |
| | | HAL_TIM_PWM_Start(&htim21, TIM_CHANNEL_2); |
| | | } |
| | | }else{ |
| | | if(hardware_type==NSH1) |
| | | {MOTOR_OFF; |
| | | }else if(hardware_type==GP) |
| | | { |
| | | HAL_TIM_PWM_Stop(&htim21, TIM_CHANNEL_3); |
| | | HAL_TIM_PWM_Stop(&htim21, TIM_CHANNEL_2); |
| | | } |
| | | } |
| | | break; |
| | |
| | | {MOTOR_ON; |
| | | }else if(hardware_type==GP) |
| | | { |
| | | HAL_TIM_PWM_Start(&htim21, TIM_CHANNEL_3); |
| | | HAL_TIM_PWM_Start(&htim21, TIM_CHANNEL_2); |
| | | } |
| | | break; |
| | | case 3: |
| | |
| | | {MOTOR_OFF; |
| | | }else if(hardware_type==GP) |
| | | { |
| | | HAL_TIM_PWM_Stop(&htim21, TIM_CHANNEL_3); |
| | | HAL_TIM_PWM_Stop(&htim21, TIM_CHANNEL_2); |
| | | } |
| | | break; |
| | | } |
| | |
| | | void HardWareTypeDiffConfig(void) |
| | | { |
| | | GPIO_InitTypeDef GPIO_InitStruct = {0}; |
| | | //hardware_type=2; |
| | | if(hardware_type == 0) |
| | | hardware_type = 1; |
| | | hardware_type=2; |
| | | //if(hardware_type == 0) |
| | | // hardware_type = 1; |
| | | switch(hardware_type) |
| | | { |
| | | case 1: |
| | |
| | | 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)|30; |
| | | g_com_map[VERSION] = (1<<8)|31; |
| | | active_flag = g_com_map[ACTIVE_INDEX]; |
| | | module_power = g_com_map[POWER]; |
| | | imu_enable=g_com_map[IMU_ENABLE]; |
| | |
| | | LIS3DH_Data_Init(); |
| | | Dw1000_Init(); |
| | | Dw1000_App_Init(); |
| | | //HardWareTypeDiffConfig(); |
| | | 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;; |