From aeceb47ebd7883a54a9f7d842f26b6c061bf18d1 Mon Sep 17 00:00:00 2001
From: zhyinch <zhyinch@gmail.com>
Date: 星期三, 12 十月 2022 14:49:50 +0800
Subject: [PATCH] 修改加速计驱动
---
Src/main.c | 27 +++++++++++++++------------
1 files changed, 15 insertions(+), 12 deletions(-)
diff --git a/Src/main.c b/Src/main.c
index ac20bcc..38b5067 100644
--- a/Src/main.c
+++ b/Src/main.c
@@ -281,12 +281,12 @@
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] = 0x0229;
+ g_com_map[VERSION] = 0x022c;
// g_com_map[DEV_ID]=0x7;
#ifdef DEBUG_MODE
// g_com_map[DEV_ROLE]=1;
-// g_com_map[DEV_ID]=0x4009;
+ g_com_map[DEV_ID]=0x4009;
// g_com_map[ACTIVE_INDEX]=1;
g_com_map[COM_INTERVAL]=50;
// g_com_map[MAX_REPORT_ANC_NUM]=1;
@@ -296,7 +296,7 @@
#endif
//g_com_map[NOMOVESLEEP_TIME]=10;
// g_com_map[IMU_ENABLE]=0;
-// g_com_map[COM_INTERVAL]=1000;
+// g_com_map[COM_INTERVAL]=50;
active_flag = g_com_map[ACTIVE_INDEX];
if(active_flag==0)
{
@@ -313,7 +313,7 @@
group_id=g_com_map[GROUP_ID];
dev_id = g_com_map[DEV_ID];
//slottime=ceil((double)g_com_map[MAX_REPORT_ANC_NUM]*SLOT_SCALE)+3;
- slottime = 5;
+ slottime = 5;
max_slotpos=g_com_map[COM_INTERVAL]/slottime;
tyncpoll_time=(g_com_map[DEV_ID]%max_slotpos)*slottime;
slot_startcount=tyncpoll_time*1000/LPTIMER_LSB;
@@ -352,14 +352,15 @@
void HardWareTypeDiffConfig(void)
{
-GPIO_InitTypeDef GPIO_InitStruct = {0};
-hardware_type=2;
-if(hardware_type == 0)
- hardware_type = 1;
+ GPIO_InitTypeDef GPIO_InitStruct = {0};
+ //if(g_com_map[MOTORBEEPER_INDEX]!=1&&g_com_map[MOTORBEEPER_INDEX]!=2)
+ {
+ g_com_map[MOTORBEEPER_INDEX] = 1;
+ }
+ hardware_type = g_com_map[MOTORBEEPER_INDEX];
switch(hardware_type)
{
- case 1:
-
+ case 1:
HAL_GPIO_WritePin(GPIOB, MOTOR_Pin, GPIO_PIN_SET);
GPIO_InitStruct.Pin = MOTOR_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
@@ -415,8 +416,8 @@
/* USER CODE BEGIN 2 */
LED_LG_ON;
Program_Init();
- LIS3DH_Data_Init();
- BarInit();
+ Accelerometer_Init();
+ BarInit();
Dw1000_Init();
Dw1000_App_Init();
HardWareTypeDiffConfig();
@@ -465,6 +466,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();
@@ -474,6 +476,7 @@
Tag_App();
LED_TR_OFF;
}
+ __enable_irq();
//LED0_BLINK;
IdleTask();
if(waitusart_timer>0)
--
Gitblit v1.9.3