From cb037453c59b56bea6dba09c4211d5180571b41f Mon Sep 17 00:00:00 2001
From: WXK <287788329@qq.com>
Date: 星期三, 31 一月 2024 11:09:42 +0800
Subject: [PATCH] V2.1增加可以下发修改uwb频率，同上位机测距频率。
---
APL/APL.c | 152 ++++++++++++++++++++++++++++++++++++--------------
1 files changed, 109 insertions(+), 43 deletions(-)
diff --git a/APL/APL.c b/APL/APL.c
index 24e8c09..25e7e01 100644
--- a/APL/APL.c
+++ b/APL/APL.c
@@ -99,10 +99,10 @@
/*******************************************************************************
* Local Function *
*******************************************************************************/
+extern void delay_ms(uint32_t nTimer) ;
void PowerDownDetect(void)
{
- static HIDO_UINT32 l_u32QXpowerTick = 0;
-static uint32_t powercount=0;
+
if(HAL_GPIO_ReadPin(GPIOB,GPIO_PIN_9))
{
@@ -188,6 +188,8 @@
* Modified Date: : 2018年7月23日
*******************************************************************************/
extern uint32_t nomove_time;
+extern void MX_Init(void);
+extern void SystemClock_Config(void);
void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin)
{
if(GPIO_Pin == GPIO_PIN_5)
@@ -195,39 +197,43 @@
// l_bIsVibration = HIDO_TRUE;
nomove_time=0;
}
- if(GPIO_Pin == GPIO_PIN_9)
- {
- HAL_ResumeTick();
+// if(GPIO_Pin == GPIO_PIN_9)//按钮关机
+// {
+// HAL_ResumeTick();
- SystemClock_Config();
- MX_Init();
- Uart_ReInit(UART_ID_DBG);
- Uart_ReInit(UART_ID_LORA);
- Uart_ReInit(UART_ID_GPS);
-
+// SystemClock_Config();
+// MX_Init();
+// Uart_ReInit(UART_ID_DBG);
+// Uart_ReInit(UART_ID_LORA);
+// Uart_ReInit(UART_ID_GPS);
+//
-
- PowerDownDetect();
- }
+//
+// PowerDownDetect();
+// }
}
+extern uint8_t lora_rxbuf[256];
+extern uint8_t lora_rxbufnum;
+extern void Set4LEDColor_Off(void);
uint8_t lora_sendfinalbag_num;
-void lora_sendfinalbag_Poll()
+void Lora_Sendfinalbag_Poll()
{
+// Lora_SendData((HIDO_UINT8 *)GPS_final_data,GPS_final_changdu);
if(lp_time-lora_sendfinalbag_time>10&&lora_sendfinalbag_flag)
{
lora_sendfinal_rx_bag_flag=1;
- Lora_SendData((HIDO_UINT8 *)GPS_final_data,GPS_final_changdu);
+ Lora_SendData((HIDO_UINT8 *)GPS_final_data,GPS_final_changdu); //发送数据
+ memset(&lora_rxbuf,0,sizeof(lora_rxbuf));//发一次清一次rx的缓存
+ lora_rxbufnum=0;
lora_sendfinalbag_time=lp_time;
lora_sendfinalbag_num=lora_sendfinalbag_num+1;
loraled=BLUE;
- powerled=LEDOFF;
- gpsled=LEDOFF;
- uwbled=LEDOFF;
Set4LEDColor(powerled,loraled,gpsled,uwbled);
HAL_Delay(100);
- Set4LEDColor_Off();
- if(lora_sendfinalbag_num>10)
+ loraled=LEDOFF;
+ Set4LEDColor(powerled,loraled,gpsled,uwbled);
+ if(lora_sendfinalbag_num>4)
{
lora_sendfinal_rx_bag_flag=0;
lora_sendfinalbag_flag=0;
@@ -266,6 +272,7 @@
* Author : 杜键
* Modified Date: : 2018年5月8日
*******************************************************************************/
+extern HIDO_UINT32 Battery_GetPercentage(void);
HIDO_INT32 APL_Init(void)
{
//Power_GPS_LoraOn();
@@ -285,7 +292,31 @@
return HIDO_OK;
}
-
+static uint8_t Input_5V_flag=0;
+void Input_5V_Poll (void)
+{
+ if(IsTypecCActive() == HIDO_TRUE&&Input_5V_flag==0)
+ { Input_5V_flag=1;
+ if(bat_percent>=90)
+ {
+ powerled=GREEN;
+ Set4LEDColor(powerled,loraled,gpsled,uwbled);
+// HIDO_Debug("1111");
+ }
+ else
+ {
+ powerled=RED;
+ Set4LEDColor(powerled,loraled,gpsled,uwbled);
+// HIDO_Debug("2222");
+ }
+ }
+ if(IsTypecCActive() == HIDO_FALSE)
+ {
+ Input_5V_flag=0;
+// Set4LEDColor_Off();
+// HIDO_Debug("3333");
+ }
+}
/*******************************************************************************
* Function Name :
* Description :
@@ -300,6 +331,21 @@
uint32_t GPSDateTime =0;
uint8_t uwbqiehuangps_flag;
extern uint8_t nomove_flag;
+HIDO_INT32 NOWAKEUP_Poll(void)
+{
+ while(1)
+ {
+ HIDO_TimerPoll();
+ Lora_Poll();//lora接收函数
+ IdleTask();
+ if((Lora_IsIdle() == HIDO_TRUE)/*为了防止lora初始化的时候进入休眠*/
+ &&(IsTypecCActive() == HIDO_FALSE) /*5v输入检测时不休眠*/)
+ {
+ Power_Sleep();
+ }
+ }
+}
+extern uint8_t fengming_time,fengming_flag;
HIDO_INT32 APL_Poll(void)
{
// ST_RTCDateTime stNow;
@@ -311,11 +357,15 @@
Lora_Poll();//lora接收函数
if(nomove_flag==0)
{
- lora_sendfinalbag_Poll();//lora在gps成功获得位置坐标或者超过1分钟没有获得时发送gps最后一包数据的函数，之后1分钟(10s)发一次，除非lora收到消除标志位或者发送超过10次
+ Lora_Sendfinalbag_Poll();//lora在gps成功获得位置坐标或者超过1分钟没有获得时发送gps最后一包数据的函数，之后1分钟(10s)发一次，除非lora收到消除标志位或者发送超过10次
}
+if(Lora_IsIdle() == HIDO_TRUE)
+Input_5V_Poll();
#if 1
- if((Lora_IsIdle() == HIDO_TRUE) && (GPS_IsIdle() == HIDO_TRUE)&&(lora_sendfinal_rx_bag_flag==0)
- && (IsTypecCActive() == HIDO_FALSE) /*&& (IsVibration() == HIDO_FALSE)*/)
+ if(((Lora_IsIdle() == HIDO_TRUE)/*为了防止lora初始化的时候进入休眠*/
+ && (GPS_IsIdle() == HIDO_TRUE)/*防止gps工作时进入休眠*/
+ &&(lora_sendfinal_rx_bag_flag==0)//防止lora在2s等待接收的时候进入休眠
+ && (IsTypecCActive() == HIDO_FALSE)/*5v输入检测时不休眠*/&&(fangchai_flag==0)&&fengming_flag==0) ||nomove_flag==1/*静止1小时立刻休眠。*/)
{
////// if(Lora_IsIdle() == HIDO_TRUE)
Power_Sleep();
@@ -324,16 +374,16 @@
else
{
}
-if(nomove_flag==0)
+if(nomove_flag==0&&(Lora_IsIdle() == HIDO_TRUE))
{
-if(GPS_ON_flag)
-{
+ if(GPS_ON_flag)
+ {
/* 检查GPS定时 */
switch(l_eGPSState)
{
case GPS_OFF:
{
- if(lp_time-GPSDateTime > g_com_map[GPS_ONTIME] || IsVibration() == HIDO_TRUE||uwbqiehuangps_flag==1)
+ if(lp_time-GPSDateTime > g_com_map[GPS_ONTIME] /*|| IsVibration() == HIDO_TRUE*/||uwbqiehuangps_flag==1)
{
uwbqiehuangps_flag=0;
l_bIsVibration = HIDO_FALSE;
@@ -341,6 +391,12 @@
Power_GPS_LoraOn();
l_eGPSState = GPS_ON;
GPSDateTime=lp_time;
+ if(IsTypecCActive() == HIDO_FALSE)//如果有5v输入的话不关灯。
+ {
+ powerled=LEDOFF;
+ Set4LEDColor(powerled,loraled,gpsled,uwbled); //关一下电源灯，防止gps突然工作不进入休眠，电源灯常量
+ }
+
}
break;
@@ -351,7 +407,6 @@
{
lora_sendfinalbag_flag=1;
lora_sendfinal_rx_bag_flag=1;
-// lora_sendfinal_rx_time=lp_time;
HIDO_Debug("GPS OFF\r\n");
Power_GPS_LoraOff();
l_eGPSState = GPS_OFF;
@@ -364,7 +419,6 @@
{
lora_sendfinalbag_flag=1;
lora_sendfinal_rx_bag_flag=1;
-// lora_sendfinal_rx_time=lp_time;
HIDO_Debug("GPS SUCCESS\r\n");
Power_GPS_LoraOff();
l_eGPSState = GPS_OFF;
@@ -376,32 +430,44 @@
break;
}
}
-}
-
-else
-{
+ }
+ else
+ {
Power_GPS_LoraOff();
l_eGPSState = GPS_OFF;
- uwbqiehuangps_flag=1;
-}
-}
- if(nomove_flag==1)
- {
- Power_GPS_LoraOff();
- l_eGPSState = GPS_OFF;
-// uwbqiehuangps_flag=1;
+// uwbqiehuangps_flag=1;//如果放开，就是uwb切到gps会立刻工作一次，不放开就是就算uwb切换到gps也要判断是否过了一小时
}
+ if(fengming_flag==1)
+ {Beep_On();}
+}
+else
+{
+ Power_GPS_LoraOff();
+ l_eGPSState = GPS_OFF;
+ uwbqiehuangps_flag=1;
+}
+#ifndef UWB_OFF_FANGCHAI_ON
+ #else
/* 拆卸告警 */
if(IsDisassemblyAlarm())
{
+ if(lp_time%2==1)
Beep_On();
+ else
+ Beep_Off();
+
fangchai_flag=1;
}
else
{
+ if(fengming_flag==0)
+ {
Beep_Off();
fangchai_flag=0;
+ }
}
+ #endif
+
#endif
return HIDO_OK;
}
--
Gitblit v1.9.3