From 5e02aaa74bd161d42cd3a48dc5d6f89491ea29ef Mon Sep 17 00:00:00 2001
From: chen <15335560115@163.com>
Date: 星期二, 31 十二月 2024 16:17:51 +0800
Subject: [PATCH] 新测距算法加入，稳定测距版本
---
keil/include/main/main.c | 223 +++++++++++++++++++++++++++++++++++--------------------
1 files changed, 141 insertions(+), 82 deletions(-)
diff --git a/keil/include/main/main.c b/keil/include/main/main.c
index 563373b..233a8b8 100644
--- a/keil/include/main/main.c
+++ b/keil/include/main/main.c
@@ -61,10 +61,13 @@
#include "HIDO_ATLite.h"
#include "HIDO_Timer.h"
#include "TCPClient.h"
+#include "PCA9555.h"
+#include "WS2812.h"
#define DEBUG_MODE
extern int simple_main(void);
extern int temp_main(void);
+void uart_change_check(uint16_t gpio_state);
#define TEST_UART_POLL_MODE 0
#define TEST_UART_INTERUPT_MODE 1
#define TEST_UART_DMA_MODE 2
@@ -98,6 +101,11 @@
uint8_t recev_error_num,send_messgae_count,send_flag,control_state,power_low_flag;
uint8_t flag_4g_usart_rx_state = 1; //4G 串口RX当前是 RX状态，不是GPIO状态
int input_5v_flag,air780e_flag1,air780e_flag2,air780e_flag3,air780e_flag4;
+extern uint8_t pca9555writedata_config[10];//暂存寄存器所有配置的数组
+extern uint8_t pca9555writedata_output[10];//暂存输出高低电平配置的数组
+extern uint8_t pca9555writedata_input[10];//暂存输入寄存器所有配置的数组
+extern uint8_t pca9555writedata_polarity[10];//暂存输入极性反转寄存器所有配置的数组
+uint8_t temp_pca9555writedata_input[10];//暂存上一次输入寄存器所有配置的数组
typedef enum
{ UN_BIND=0,
LINK_SUCCESS,
@@ -128,7 +136,7 @@
.flow = UART_FLOW_CONTROL_NONE,
.rx_level = UART_RXFIFO_CHAR_1,
.tx_level = UART_TXFIFO_EMPTY,
- .baud = BAUD_115200,
+ .baud = BAUD_9600,
#if (TEST_UART_MODE == TEST_UART_POLL_MODE)
.dma_en = false,
.int_rx = false,
@@ -185,15 +193,15 @@
}
if(fVoltage_mv<3300)
{
- power_low_flag=1;
- gps_air780_power_change(gps_power_state,0);//gps原样，关闭4G
- LOG_INFO(TRACE_MODULE_APP, "电池电压低于3.3V，4G，GPS停止工作\r\n");
+ //power_low_flag=1;
+ //gps_air780_power_change(gps_power_state,0);//gps原样，关闭4G
+ //LOG_INFO(TRACE_MODULE_APP, "电池电压低于3.3V，4G，GPS停止工作\r\n");
}else{
- power_low_flag=0;
- gps_air780_power_change(gps_power_state,1);//gps原样,开启4G
- LOG_INFO(TRACE_MODULE_APP, "电池电压正常,4G，GPS,正常工作\r\n");
+ //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);//在拉高
+ PCA9555_Set_One_Value_Output(ADC_MINIUS,1);//拉高
// LOG_INFO(TRACE_MODULE_APP, "The voltage is %%%d \r\n",bat_percent);
}
//void UartInit(void)
@@ -207,7 +215,7 @@
uint8_t TCP_reconnect_timer,flag_TCP_reconnectting = 1,flag_alam_state = 0,userkey_state;
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;
+uint32_t keystarttime,keystarttime2,keystarttime3;
extern uint32_t get_in_num,get_out_num;
void MotorPoll(void)
{
@@ -292,27 +300,49 @@
}
}
void UserKeyTask(void)
- {
- if(!GET_USERKEY)
+{
+if(!read_userkey_input_pca())
{
- if(HIDO_TimerGetTick() - keystarttime>3)
+ if(HIDO_TimerGetTick() - keystarttime3>2)
{
userkey_state = 1;
- keystarttime = HIDO_TimerGetTick();
- UDPClient_UploadGPS();
+ keystarttime3 = HIDO_TimerGetTick();
+ //UDPClient_UploadGPS();
}
- if(HIDO_TimerGetTick() - keystarttime2>10)
+// if(HIDO_TimerGetTick() - keystarttime2>10)
+// {
+//
+// g_com_map[CNT_RESTART] = 1;
+// }
+ }else
+ {
+ keystarttime3 = HIDO_TimerGetTick();
+ }
+}
+void PowerTask(void)
+{
+ if(read_powerkey_input_pca())
+ {
+ if(HIDO_TimerGetTick() - keystarttime>2)
{
- g_com_map[CNT_RESTART] = 1;
+ keystarttime = HIDO_TimerGetTick();
+ PCA9555_Set_One_Value_Output(PWR_ENABLE,0);//低电平关闭
+ PCA9555_Set_One_Value_Output(GPS_LED,0);//输出低电平关闭LED
}
+// if(HIDO_TimerGetTick() - keystarttime2>10)
+// {
+//
+// g_com_map[CNT_RESTART] = 1;
+// }
}else
{
keystarttime = HIDO_TimerGetTick();
keystarttime2 = HIDO_TimerGetTick();
}
- }
+}
void MinuteTask(void)
-{ gpio_pin_clr(ADC_GND_ENABLE);//拉低
+{
+ PCA9555_Set_One_Value_Output(ADC_MINIUS,0);//拉低
adc_get(&sample[0], NUM_SAMPLES, adc_callback);//adc采样
}
void SecondTask(void)
@@ -322,9 +352,7 @@
second_count = 0;
MinuteTask();
}
- TagListUpdate_person_num_car();
- in_table_log();
-
+ //UWBOneSecondTask();
// if(!power_low_flag)
// Gps_change();
// else{
@@ -366,40 +394,38 @@
uint8_t tt=1;
uint8_t flag_sleeptimer,flag_secondtask,secondtask_count,log_4g_enable_flag;
uint8_t uwb_enable_flag=0;
+
+void check_input_change(void)
+{
+ uint16_t gpio_state;
+ gpio_state=(uint16_t)pca9555writedata_input[0]<<8|pca9555writedata_input[1];
+ if(WAKE_UP_POSITION&gpio_state)
+ {
+ nomove_count=0;
+ }
+ //uart_change_check(gpio_state);
+}
static void sleep_timer_callback(void *dev, uint32_t time)
{
- IO_control_init();
- if(enbale_blink_flag)
- {
- green_charge_state=0;
- charge_red_on();
- }
-
- charge_state_change();//充电状态判断
if(secondtask_count++%2==0)
{
flag_secondtask = 1;
}else{
flag_secondtask = 0;
}
- if(enbale_blink_flag)
- {
- delay_us(5000);
- green_charge_state=0;
- charge_red_off();
- }
if(delaysleep_count>0)
delaysleep_count--;
//GPS工作逻辑
}
-static void voltage_input_handler(enum IO_PIN_T pin)
-{
-
-}
static void move_handler(enum IO_PIN_T pin)
{
nomove_count=0;
+}
+static void pca_handler(enum IO_PIN_T pin)
+{
+ PCA9555_readdata(PCA9555_DEVICE_ADDR,pca9555writedata_input);//读输入寄存器的值
+ check_input_change();
}
uint8_t flag_4G_recdata;
void _4gUsart_handler(enum IO_PIN_T pin)
@@ -455,35 +481,53 @@
}
-
+void uart_change_check(uint16_t gpio_state)
+{
+ if(INPUT_5V_POSITION&gpio_state)
+ {
+ if(state5v==0)
+ {
+ state5v=1;
+ state5V_prase_flag=state5v;
+ gps_prase_flag=0;//解除gps解析
+ uart1_change_from_gps_to_debug();//测试
+ PCA9555_Set_One_Value_Output(MCU_A,1);//输出高电平切换为5V输入
+ }
+ }else {
+ if(state5v==1)
+ {
+ g_com_map[MODBUS_MODE] = 0;
+ state5v=0;
+ state5V_prase_flag=state5v;
+ gps_prase_flag=1;//恢复gps解析
+ uart1_change_from_debug_to_gps();//测试
+ PCA9555_Set_One_Value_Output(MCU_A,0);//输出低电平切换为GPS
+ }
+ }
+}
void IdleTask(void)
{
-// if(gpio_pin_get_val(INPUT_5V_Pin))
-// {
-
-// if(state5v==0)
-// {
-// state5v=1;
-// state5V_prase_flag=state5v;
-// gps_prase_flag=0;//解除gps解析
-// uart1_change_from_gps_to_debug();//测试
-// // uart_receive(UART_ID1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart_receive_callback);//开启dma
-// //UartInit();
-// }
-
-// //UART_CheckSend();
-// } else {
-// if(state5v==1)
-// {
-// g_com_map[MODBUS_MODE] = 0;
-// state5v=0;
-// state5V_prase_flag=state5v;
-// gps_prase_flag=1;//恢复gps解析
-// uart1_change_from_debug_to_gps();//测试
-// // uart_receive(UART_ID1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart_receive_callback);//开启dma
-// //UartDeinit();
-// }
-// }
+if(read_5v_input_pca())
+ {
+ if(state5v==0)
+ {
+ state5v=1;
+ state5V_prase_flag=state5v;
+ gps_prase_flag=0;//解除gps解析
+ uart1_change_from_gps_to_debug();//测试
+ PCA9555_Set_One_Value_Output(MCU_A,1);//输出高电平切换为5V输入
+ }
+ }else {
+ if(state5v==1)
+ {
+ g_com_map[MODBUS_MODE] = 0;
+ state5v=0;
+ state5V_prase_flag=state5v;
+ gps_prase_flag=1;//恢复gps解析
+ uart1_change_from_debug_to_gps();//测试
+ PCA9555_Set_One_Value_Output(MCU_A,0);//输出低电平切换为GPS
+ }
+ }
UART_CheckReceive();
}
int bind_check(void)
@@ -531,11 +575,11 @@
board_clock_run();
boot_deinit();
board_pins_config();
- board_debug_console_open(TRACE_PORT_UART1);
+ board_debug_console_open_baud(TRACE_PORT_UART1,BAUD_115200);
// Reset reason
reset_cause_get();
reset_cause_clear();
-
+//注意串口一波特率改为9600了为了能和GPS通信上
// Load calibration parameters from NVM
uint32_t internal_flash = (REG_READ(0x40000018) >> 17) & 0x1;
uint32_t external_flash = (REG_READ(0x40010030) >> 28) & 0x3;
@@ -566,25 +610,32 @@
// TCPClient_Init();
gpio_open();
- board_output_init();//配置adcGND引脚
+ LED_output_init();//配置adcGND引脚
// battery_monitor_open();
// Voltage_input=battery_monitor_get();
// battery_monitor_close();
+
adc_open(&usr_adc_cfg);
IIC2_Init();
Accelerometer_Init();
- IO_control_init();
- io_pin_mux_set(SCL_PIN, IO_FUNC0);//测试测距波形
- gpio_pin_set_dir(SCL_PIN , GPIO_DIR_IN, 0);
- io_pull_set(SCL_PIN , IO_PULL_UP, IO_PULL_UP_LEVEL4);
+ PCA9555_init();
+ if(!read_5v_input_pca())
+ {
+ Set4LEDColor(BLUE,GREEN,WHITE,GREEN);
+ delay_ms(500);
+ Set4LEDColor(RED,WHITE,RED,WHITE);
+ delay_ms(500);
+ //Set4LEDColor(LEDOFF,LEDOFF,LEDOFF,LEDOFF);
+ }
+ //IO_control_init();
+// io_pin_mux_set(SCL_PIN, IO_FUNC0);//测试测距波形
+// gpio_pin_set_dir(SCL_PIN , GPIO_DIR_IN, 0);
+// io_pull_set(SCL_PIN , IO_PULL_UP, IO_PULL_UP_LEVEL4);
//gps_air780_power_change(0,1);//开启gps，4G
//加速度计初始化必须在IO_control_init之前因为复用SDA引脚
- gpio_pin_clr(ADC_GND_ENABLE);
-
Program_Init();
//uart_open(UART_ID1, &test_uart_cfg);
-
// uart1_change_from_gps_to_debug();
//Uart1GpsRecDebugSend();
uart_receive(UART_ID1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart_receive_callback);
@@ -593,16 +644,23 @@
power_init();
//AIR780E_Reset(); //4G模块重启，耗时1.5秒,这个是无法同步的关键
sleep_timer_open(true, SLEEP_TIMER_MODE_RELOAD, sleep_timer_callback);
- sleep_timer_start(__MS_TO_32K_CNT(g_com_map[COM_INTERVAL]));//测试
+ //sleep_timer_start(__MS_TO_32K_CNT(g_com_map[COM_INTERVAL]));//测试
sleep_timer_start(__MS_TO_32K_CNT(SLEEP_TIMER_NUM));//测试
// board_5V_input_init(voltage_input_handler);
+ PCA9555_Set_One_Value_Output(ADC_MINIUS,0);//拉低
adc_get(&sample[0], NUM_SAMPLES, adc_callback);//adc采样
board_acceleration_detection_init(move_handler);
-// LOG_INFO(TRACE_MODULE_APP, "测试进入app");
- board_4GUsart_detection_init(_4gUsart_handler);
+ pca_input_detection_init(pca_handler);//pca检测输入
+ Uwb_init();
+ OpenUWB();
+
+ //board_4GUsart_detection_init(_4gUsart_handler);
while (1)
- { test4=gpio_pin_get_val(SCL_PIN);
- UWBPoll();
+ {
+ uwb_app_poll();
+
+ //test4=gpio_pin_get_val(SCL_PIN);
+ //UWBPoll();
// if(!power_low_flag)//确认是否休眠下才开启功能
// {
// if(flag_TCP_reconnectting||IfTCPConnected())
@@ -635,8 +693,9 @@
SecondTask();
}
-// UserKeyTask();
+ PowerTask();
// IMUTask();
+ UserKeyTask();
IdleTask();
#ifndef DEBUG_MODE
//if(flag_sleeptimer)
--
Gitblit v1.9.3