From 8f01fa592775a87ef46c12a440db32fcc89d004f Mon Sep 17 00:00:00 2001 From: zhyinch <zhyinch@gmail.com> Date: 星期一, 14 十二月 2020 17:30:39 +0800 Subject: [PATCH] V2.15 255时间片不生效 --- Src/main.c | 55 ++++++++++++++++++++++++++++++++++++++++++++++++++----- 1 files changed, 50 insertions(+), 5 deletions(-) diff --git a/Src/main.c b/Src/main.c index 6a5c18e..e394a64 100644 --- a/Src/main.c +++ b/Src/main.c @@ -211,16 +211,19 @@ u16 current_slotnum; extern int32_t offsettimeus; //#define FIXSLOT -#define FIXSLOTPOS 6 +#define FIXSLOTPOS 1 u16 slotpos_intoatl; uint16_t bigslot_num; uint8_t fix_slotpos =FIXSLOTPOS; int32_t lpcount,lptime,target_time; +extern u16 tagslotpos; void SetNextPollTime(u16 slotpos) { #ifdef FIXSLOT + fix_slotpos = g_com_map[ALARM_DISTANCE1]; slotpos = fix_slotpos; + tagslotpos = fix_slotpos; #endif if(current_slotnum>=tag_frequency) @@ -244,6 +247,7 @@ __HAL_LPTIM_COMPARE_SET(&hlptim1, lpcount); } } +u8 active_flag=0; void Program_Init(void) { float temp; uint16_t temp2; @@ -251,19 +255,26 @@ Usart1ParseDataCallback = UsartParseDataHandler; parameter_init(); //deca_sleep(1000); - g_com_map[VERSION] = 0x020a; + g_com_map[VERSION] = 0x020f; #ifdef DEBUG_MODE // g_com_map[DEV_ROLE]=1; -// g_com_map[DEV_ID]=0x123; + // g_com_map[DEV_ID]=0x11; // g_com_map[COM_INTERVAL]=100; // g_com_map[MAX_REPORT_ANC_NUM]=1; // g_com_map[NOMOVESLEEP_TIME]=10; - // g_com_map[IMU_ENABLE]=0; + g_com_map[IMU_ENABLE]=0; //g_com_map[COM_INTERVAL]=50; #endif //g_com_map[NOMOVESLEEP_TIME]=10; // g_com_map[IMU_ENABLE]=0; // g_com_map[COM_INTERVAL]=50; + active_flag = g_com_map[ACTIVE_INDEX]; + if(active_flag==0) + { g_com_map[COM_INTERVAL]=1000; + g_com_map[IMU_ENABLE]=1; + 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; @@ -397,7 +408,7 @@ // { // MODBUS_Poll(); // } - if(g_start_send_flag) + if(g_start_send_flag&&active_flag) { static uint16_t blink_count=0; SystemClock_Config(); g_start_send_flag = 0; @@ -828,6 +839,40 @@ current_slotnum++; SetNextPollTime(tagslotpos); nomove_count+=(float)g_com_map[COM_INTERVAL]/1000; + if(active_flag==0) + { + if(!GET_USERKEY) + { + LED_LG_ON; + key_keeptime+=(float)g_com_map[COM_INTERVAL]/1000; + if(key_keeptime>3) + { + u8 i=250,keystate=1; + while(i--) + { + if(i%10==0) + { + LED_LG_BLINK; + } + if(GET_USERKEY) + {keystate = 0;} + if(keystate==0&&!GET_USERKEY) + { + parameter_init(); + g_com_map[ACTIVE_INDEX] = 1; + save_com_map_to_flash(); + delay_ms(100); + SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader + } + delay_ms(10); + } + } + }else{ + LED_LG_OFF; + key_keeptime=0; + } + + } if(motor_ontime>0) { motor_ontime-=(float)1/tag_frequency; -- Gitblit v1.9.3