| | |
| | | __HAL_LPTIM_COMPARE_SET(&hlptim1, lpcount); |
| | | } |
| | | } |
| | | void ErrorConfig_Handler(void) |
| | | { |
| | | if(g_com_map[COM_INTERVAL]==0||g_com_map[COM_INTERVAL]>1000) |
| | | { |
| | | g_com_map[COM_INTERVAL]=100; |
| | | } |
| | | if(g_com_map[IMU_THRES]>10) |
| | | {g_com_map[IMU_THRES]=2;} |
| | | if(g_com_map[POWER]>MAX_RFPOWER) |
| | | {g_com_map[POWER]=MAX_RFPOWER;} |
| | | if(g_com_map[POWER]<0) |
| | | {g_com_map[POWER]=0;} |
| | | } |
| | | u8 active_flag=0; |
| | | |
| | | void Program_Init(void) |
| | | { float temp; |
| | | uint16_t temp2; |
| | |
| | | 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] = 0x0215; |
| | | // g_com_map[DEV_ID]=0x11; |
| | | g_com_map[VERSION] = 0x0217; |
| | | // g_com_map[DEV_ID]=0x7; |
| | | #ifdef DEBUG_MODE |
| | | // g_com_map[DEV_ROLE]=1; |
| | | g_com_map[DEV_ID]=0x4008; |
| | |
| | | g_com_map[NOMOVESLEEP_TIME]=10; |
| | | g_com_map[MOTOR_ENABLE]=0; |
| | | } |
| | | if(g_com_map[COM_INTERVAL]==0) |
| | | { |
| | | g_com_map[COM_INTERVAL]=100; |
| | | } |
| | | if(g_com_map[IMU_THRES]>10) |
| | | {g_com_map[IMU_THRES]=2;} |
| | | 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]; |
| | |
| | | { |
| | | GPIO_InitTypeDef GPIO_InitStruct = {0}; |
| | | //hardware_type=2; |
| | | if(hardware_type == 0) |
| | | hardware_type = 1; |
| | | switch(hardware_type) |
| | | {case 1: |
| | | { |
| | | case 1: |
| | | |
| | | HAL_GPIO_WritePin(GPIOB, MOTOR_Pin, GPIO_PIN_SET); |
| | | GPIO_InitStruct.Pin = MOTOR_Pin; |