From 1a2264ab2e625c29f8f9454fd6238ae8598124bb Mon Sep 17 00:00:00 2001
From: chen <15335560115@163.com>
Date: 星期三, 09 四月 2025 12:01:21 +0800
Subject: [PATCH] GPS手环V1.13，修改蓝灯闪灯逻辑
---
keil/include/main/main.c | 134 +++++++++++++++++---------------------------
1 files changed, 51 insertions(+), 83 deletions(-)
diff --git a/keil/include/main/main.c b/keil/include/main/main.c
index 32e2034..079875b 100644
--- a/keil/include/main/main.c
+++ b/keil/include/main/main.c
@@ -191,6 +191,7 @@
}else{
power_low_flag=0;
gps_air780_power_change(gps_power_state,1);//gps原样,开启4G
+ LOG_INFO(TRACE_MODULE_APP, "电池电压正常,4G，GPS,正常工作\r\n");
}
gpio_pin_set(ADC_GND_ENABLE);//在拉高
// LOG_INFO(TRACE_MODULE_APP, "The voltage is %%%d \r\n",bat_percent);
@@ -207,85 +208,25 @@
uint8_t gps_enable_flag,motor_open_air_flag,moter_open_uwb_flag,flag_fenli_alarm = 0,fenli_alarm_count,delaysleep_count,enbale_blink_flag;
int need_open_gps_count;
uint32_t keystarttime,keystarttime2;
+extern int16_t beepontime;
+extern uint8_t beep_start_flag;
void MotorPoll(void)
{
- if(UWB_work_state==UN_BIND) {
- gps_uwb_flag=0;//关闭GPS
- moter_open_uwb_flag=0;//关闭震动
- need_open_gps_count=0;//清0计数gps
- } else { //绑定状态下
- if(anchordata_num==1) {
- if(distance<g_com_map[ALARM_DISTANCE1]) { //小于预警距离
- fenli_alarm_count = 0;
- if(flag_fenli_alarm)
- {
- flag_fenli_alarm = 0;
- fenli_alarm_count = 0;
- _4GAlarmUpload(2);
- }
- }
- }
- if(distance>g_com_map[ALARM_DISTANCE1]||anchordata_num==0)
- {
- if(fenli_alarm_count++>20)
- {
- if(!flag_fenli_alarm)
- {
- flag_fenli_alarm = 1;
- _4GAlarmUpload(1);
- }
- }
- }
- if(distance<g_com_map[ALARM_DISTANCE1]) { //小于预警距离
- if(flag_alam_state)
- {
- flag_alam_state = 0;
-
- }
-
- need_open_gps_count=0;
- moter_open_uwb_flag=0;//关闭震动
- gps_uwb_flag=0;//关闭GPS
- } else if(g_com_map[ALARM_DISTANCE1]<=distance&&distance<=g_com_map[ALARM_DISTANCE2]) { //大于预警距离小于报警距离
- need_open_gps_count++;
- moter_open_uwb_flag=1;//开启震动
- if(need_open_gps_count>=20) {
- if(!flag_alam_state)
- {
- flag_alam_state = 1;
- }
- gps_uwb_flag=1;//开启gps测距流程
- need_open_gps_count=0;
- }
- } else if(distance>=g_com_map[ALARM_DISTANCE2]) { //大于报警距离
- need_open_gps_count++;
- moter_open_uwb_flag=1;//开启震动
- if(need_open_gps_count>=20) {
- if(!flag_alam_state)
- {
- flag_alam_state = 1;
- }
- gps_uwb_flag=1;//开启gps测距流程
- need_open_gps_count=0;
- }
-
- }
- if(anchordata_num==0) {
- if(!flag_alam_state)
- {
- flag_alam_state = 1;
- }
- distance = 0x1ffff;
- gps_uwb_flag=1;//开启gps测距流程
- moter_open_uwb_flag=1;//开启震动
- need_open_gps_count=0;
- }
- }
+ if(beep_start_flag)
+ {
+ if(beepontime-->0)
+ {
+ motor_power_state=0;
+ }else{
+ beep_start_flag=0;
+ motor_power_state=1;
+ }
}
+}
void IMUTask(void)
{
if(nomove_count>g_com_map[NOMOVESLEEP_TIME]&&g_com_map[IMU_ENABLE]==1)
- {
+ {power_wakeup_enable((enum POWER_WAKEUP_SOURCE_T)ACCLERATE_DETECT_Pin, POWER_WAKEUP_LEVEL_HIGH);
mcu_deep_sleep();
}
}
@@ -313,6 +254,7 @@
{ gpio_pin_clr(ADC_GND_ENABLE);//拉低
adc_get(&sample[0], NUM_SAMPLES, adc_callback);//adc采样
}
+uint8_t link_error_time;
void SecondTask(void)
{static uint8_t second_count;
if(second_count++>60)
@@ -321,8 +263,9 @@
MinuteTask();
}
if(!power_low_flag)
- Gps_change();
- else{
+ {Gps_change();
+ MotorPoll();
+ }else{
gps_power_state=0;//关闭GPS
update_led_power_state();
//初始化GPS计数数据
@@ -330,10 +273,13 @@
gps_wait_count2=0;
gps_wait_count=0;
}
+
//UWB状态检测
-
+if(!power_low_flag)//低供电下不需要检测重连
+ {
if(IfTCPConnected())
{
+ link_error_time=0;
TCP_reconnect_timer =0;
flag_TCP_reconnectting = 0;
} else {
@@ -341,7 +287,8 @@
{
flag_TCP_reconnectting = 1;
} else {
- flag_TCP_reconnectting = 0;
+ //flag_TCP_reconnectting = 0;
+ sys_reset(4);//重连不上就复位
}
if(TCP_reconnect_timer++>600)
{
@@ -349,6 +296,7 @@
}
}
+ }
HIDO_TimerTick();
if(nomove_count<=g_com_map[NOMOVESLEEP_TIME])//防止溢出
nomove_count++;
@@ -403,6 +351,7 @@
extern uint16_t ip0,ip1,ip2,ip3,port;
extern uint8_t gps_4g_flag;
extern uint8_t gps_need_data_flag,gps_open_flag;
+uint8_t bat_bercent_hex;
void Program_Init(void)
{
Usart1ParseDataCallback = UsartParseDataHandler;//需改为默认为gps处理，UsartParseDataHandler为升级处理当调试时候改为
@@ -440,9 +389,9 @@
ip2 = (g_com_map[TCP_IP_2]>>12&0xf)*1000+(g_com_map[TCP_IP_2]>>8&0xf)*100+(g_com_map[TCP_IP_2]>>4&0xf)*10+(g_com_map[TCP_IP_2]&0xf);
ip3 = (g_com_map[TCP_IP_3]>>12&0xf)*1000+(g_com_map[TCP_IP_3]>>8&0xf)*100+(g_com_map[TCP_IP_3]>>4&0xf)*10+(g_com_map[TCP_IP_3]&0xf);
port = g_com_map[TCP_PORT];
- g_com_map[VERSION] = (1<<8)|10;
+ g_com_map[VERSION] = (1<<8)|13;
LOG_INFO(TRACE_MODULE_APP,"设备ID: %x .\r\n",dev_id);
- LOG_INFO(TRACE_MODULE_APP,"固件版本:UWB-4G车载手环 V%d.%d. \r\n",g_com_map[VERSION]>>8,g_com_map[VERSION]&0xff);
+ LOG_INFO(TRACE_MODULE_APP,"固件版本:4G-GPS定位手环 V%d.%d. \r\n",g_com_map[VERSION]>>8,g_com_map[VERSION]&0xff);
LOG_INFO(TRACE_MODULE_APP,"服务器地址: %d.%d.%d.%d:%d.\r\n",ip0,ip1,ip2,ip3,port);
}
@@ -517,7 +466,19 @@
int tt2;
int test1,test3;
uint32_t test4;
+uint32_t time_count;
+static void app_wdt_callback(void *dev, uint32_t status)
+{
+ ASSERT(status, "WDT TIMEOUT，程序复位");
+ //LOG_INFO(TRACE_MODULE_APP, "程序卡死，看门狗复位");
+}
+ struct WDT_CFG_T app_wdt_cfg = {
+ .timeout = 32768 * 30,
+ .rst_en = true,
+ .int_en = true,
+ .callback = app_wdt_callback,
+ };
int main(void)
{
board_clock_run();
@@ -547,6 +508,7 @@
// Disable watchdog timer
wdt_close(WDT_ID0);
+ wdt_open(WDT_ID0,&app_wdt_cfg);//30s检测喂狗
LOG_INFO(TRACE_MODULE_APP, "UWB simple example\r\n");
// open system timer
@@ -592,13 +554,19 @@
board_acceleration_detection_init(move_handler);
// LOG_INFO(TRACE_MODULE_APP, "测试进入app");
board_4GUsart_detection_init(_4gUsart_handler);
- while (1)
- { test4=gpio_pin_get_val(SCL_PIN);
+ while (1)
+ {
+ test4=gpio_pin_get_val(SCL_PIN);
+ wdt_ping(WDT_ID0);//喂狗
if(!power_low_flag)//确认是否休眠下才开启功能
{
if(flag_TCP_reconnectting||IfTCPConnected())
{
+// if(flag_TCP_reconnectting)
+// {
+// link_error_time++;
+// }//后加的
// LOG_INFO(TRACE_MODULE_APP, "处理4G任务\r\n");
// if(flag_4guart_needinit)
@@ -625,7 +593,7 @@
{
flag_secondtask = 0;
SecondTask();
-
+ // time_count++;
}
UserKeyTask();
IMUTask();
@@ -652,7 +620,7 @@
// }//yuan
if(delaysleep_count==0)
- if(!gps_power_state&&!gpio_pin_get_val(INPUT_5V_Pin)&&((IfTCPConnected()&&AIR780E_IsIPIdle()&&Socket_IsSendQueueEmpty(0))||((!flag_TCP_reconnectting)&&!IfTCPConnected())))
+ if(!gps_power_state&&!gpio_pin_get_val(INPUT_5V_Pin)&&((IfTCPConnected()&&AIR780E_IsIPIdle()&&Socket_IsSendQueueEmpty(0))||((!flag_TCP_reconnectting)&&!IfTCPConnected())||power_low_flag))
{
// test1=gpio_pin_get_val(_4G_USART_RX_Pin);
uint32_t lock;
--
Gitblit v1.9.3