From d2de620b25574ea7a0c47ef7b00ef5b7c3751e12 Mon Sep 17 00:00:00 2001
From: zhyinch <zhyinch@gmail.com>
Date: 星期日, 31 十月 2021 17:00:00 +0800
Subject: [PATCH] V2.41 时间片解决,有蓝灯长亮BUG

---
 Src/main.c |   19 +++++++++++--------
 1 files changed, 11 insertions(+), 8 deletions(-)

diff --git a/Src/main.c b/Src/main.c
index b41edc2..a583eaa 100644
--- a/Src/main.c
+++ b/Src/main.c
@@ -31,7 +31,7 @@
 
 #define NSH1 0x0001
 #define GP   0x0002
-#define DEBUG_MODE
+//#define DEBUG_MODE
 /* USER CODE END Includes */
 
 /* Private typedef -----------------------------------------------------------*/
@@ -101,7 +101,7 @@
 }	
 void UsartInit(void)
 {
-	waitusart_timer = tag_frequency*USART_KEEPWAKE_TIME;
+//	waitusart_timer = tag_frequency*USART_KEEPWAKE_TIME;
 	 MX_DMA_Init();
 	MX_USART1_UART_Init();
  if(HAL_UART_Receive_DMA(&huart1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE))
@@ -139,6 +139,7 @@
 		}else{
 			motor_state = 0;
 		}
+		//motor_state=2;
 	switch(motor_state)
 		{case 0:
 			if(hardware_type==NSH1)
@@ -280,7 +281,7 @@
 	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] = 0x0225;
+	g_com_map[VERSION] = 0x0229;
     
 //	g_com_map[DEV_ID]=0x7;
 #ifdef DEBUG_MODE
@@ -295,7 +296,7 @@
 #endif
 //g_com_map[NOMOVESLEEP_TIME]=10;
 //	g_com_map[IMU_ENABLE]=0;
-	 g_com_map[COM_INTERVAL]=50;
+//	 g_com_map[COM_INTERVAL]=50;
 	active_flag = g_com_map[ACTIVE_INDEX];
 	if(active_flag==0)
 	{   
@@ -352,7 +353,7 @@
 void HardWareTypeDiffConfig(void)
 {
 GPIO_InitTypeDef GPIO_InitStruct = {0};
-//hardware_type=2;
+hardware_type=2;
 if(hardware_type == 0)
     hardware_type = 1;
 	switch(hardware_type)
@@ -415,13 +416,13 @@
 	LED_LG_ON;
 	Program_Init();
 	LIS3DH_Data_Init();	
-    BarInit();
+  BarInit();
 	Dw1000_Init();
 	Dw1000_App_Init();
 	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;;
+//	waitusart_timer=tag_frequency*USART_KEEPWAKE_TIME;;
 	DW_DISABLE;
 	 if(HAL_UART_Receive_DMA(&huart1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE))
 	{
@@ -446,7 +447,7 @@
 //		{
 //		MODBUS_Poll();
 //		}
-if(m_bEUARTTxEn==0&&waitusart_timer==0&&(motor_state==0||motor_state==3))
+if(m_bEUARTTxEn==0&&(motor_state==0||motor_state==3))
 			{	
 #ifndef DEBUG_MODE	
 				if(!HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin))
@@ -464,6 +465,7 @@
 //		HAL_GPIO_WritePin(LED0_GPIO, GPIO_PIN_9, GPIO_PIN_RESET);
 //		}
 //		LED_TR_BLINK;
+			__disable_irq();
 		if(bat_percent>15)
 		{	LED_TB_ON;
 			Tag_App();
@@ -473,6 +475,7 @@
 			Tag_App();
 			LED_TR_OFF;		
 		}
+			__enable_irq();
 		//LED0_BLINK;		
 		IdleTask();	
 		if(waitusart_timer>0)

--
Gitblit v1.9.3