From 0533236e453d9368d6f66341cafa2a8f2fe81dc3 Mon Sep 17 00:00:00 2001 From: zhyinch <zhyinch@gmail.com> Date: 星期日, 14 三月 2021 13:18:19 +0800 Subject: [PATCH] V2.23 尝试修复红灯常亮BUG --- Src/main.c | 34 ++++++++++++++++++++-------------- 1 files changed, 20 insertions(+), 14 deletions(-) diff --git a/Src/main.c b/Src/main.c index a8965d3..921b709 100644 --- a/Src/main.c +++ b/Src/main.c @@ -286,8 +286,20 @@ __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; @@ -298,8 +310,8 @@ 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]=0x6; #ifdef DEBUG_MODE // g_com_map[DEV_ROLE]=1; g_com_map[DEV_ID]=0x4008; @@ -320,16 +332,7 @@ 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]; @@ -378,8 +381,11 @@ { 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; -- Gitblit v1.9.3