From 9635c1ec8bab034040f3ada3e5e368a6fb9e5e7a Mon Sep 17 00:00:00 2001
From: yincheng.zhong <634916154@qq.com>
Date: 星期日, 21 一月 2024 18:56:53 +0800
Subject: [PATCH] V1.42 随机时间片
---
Src/main.c | 44 +++++++++++---------------------------------
1 files changed, 11 insertions(+), 33 deletions(-)
diff --git a/Src/main.c b/Src/main.c
index 2d5be71..4e6ceaa 100644
--- a/Src/main.c
+++ b/Src/main.c
@@ -188,6 +188,7 @@
if(HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin))
{
nomove_count = 0;
+ bat_percent=Get_Battary();
if(state5v==0)
{
state5v=1;
@@ -207,36 +208,8 @@
LED_LG_OFF;
// }
}
- if(g_com_map[CNT_UPDATE]==1)
- {
- uint32_t result = 0;
- uint16_t tmp = 0xAAAA;
- __disable_irq();
- result = FLASH_Prepare(0x8004A38, 128);
- if(result)
- result = FLASH_Write(0x8004A38, (const uint8_t*)&tmp, 2);
- __enable_irq();
- printf("进入升级模式\r\n");
- g_com_map[CNT_UPDATE]=0;
- save_com_map_to_flash();
- delay_ms(100);
- // STMFLASH_Write_NoCheck(0x8004A38,0xAAAA);
- // Delay_ms(100);
- SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader
- }
- if(g_com_map[CNT_REBOOT]==1)
- {
- g_com_map[CNT_REBOOT]=0;
- g_com_map[MAP_SIGN_INDEX]=0;
- save_com_map_to_flash();
- delay_ms(100);
- SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader
- }
if(g_com_map[CNT_RESTART]==1)
{
- g_com_map[CNT_RESTART]=0;
- save_com_map_to_flash();
- delay_ms(100);
SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader
}
if(g_com_map[MAP_SIGN_INDEX]!=0x55AA||g_com_map[COM_INTERVAL]==0)
@@ -282,7 +255,7 @@
{
case 1:
- HAL_GPIO_WritePin(GPIOB, MOTOR_Pin, GPIO_PIN_SET);
+ HAL_GPIO_WritePin(GPIOB, MOTOR_Pin, GPIO_PIN_SET);
GPIO_InitStruct.Pin = MOTOR_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
GPIO_InitStruct.Pull = GPIO_NOPULL;
@@ -295,6 +268,7 @@
break;
}
}
+int16_t g_commap_antdelay;
u8 active_flag,nomovesleeptime;
void Program_Init(void)
{ float temp;
@@ -306,9 +280,9 @@
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)|28;
+ g_com_map[VERSION] = (1<<8)|42;
active_flag = g_com_map[ACTIVE_INDEX];
- module_power = g_com_map[POWER];
+ module_power = g_com_map[POWER];
imu_enable=g_com_map[IMU_ENABLE];
motor_enable=g_com_map[MOTOR_ENABLE];
@@ -342,7 +316,11 @@
{module_power=67;}
if(module_power<0)
{module_power=0;}
-
+ if(g_com_map[ANT_LENGTH]>10000)
+ {
+ g_com_map[ANT_LENGTH] = 0;
+ }
+ g_commap_antdelay = -g_com_map[DIST_OFFSET];
current_slotnum=1;
current_time=GetLPTime();
if (HAL_LPTIM_TimeOut_Start_IT(&hlptim1, LPTIMER_1S_COUNT, slot_startcount) != HAL_OK) //system time is 1010ms 1 puls=30.518us
@@ -423,7 +401,7 @@
/* USER CODE BEGIN 2 */
LED_LG_ON;
Program_Init();
- LIS3DH_Data_Init();
+ Accelerometer_Init();
Dw1000_Init();
Dw1000_App_Init();
HardWareTypeDiffConfig();
--
Gitblit v1.9.3