From 59a4e01d92da432e9736b24c085089cd31963833 Mon Sep 17 00:00:00 2001 From: zhangbo <zhangbo@qq.com> Date: 星期三, 21 五月 2025 15:19:22 +0800 Subject: [PATCH] 修改了串口读取的bug,现在是通过飞线控制的 PCA蓝牙IRQ拉低,修改灯的闪灯逻辑, --- keil/include/main/main.c | 929 +++++++++++++++++++++++++++------------------------------ 1 files changed, 447 insertions(+), 482 deletions(-) diff --git a/keil/include/main/main.c b/keil/include/main/main.c index e284128..f1b2324 100644 --- a/keil/include/main/main.c +++ b/keil/include/main/main.c @@ -62,13 +62,15 @@ #include "HIDO_Timer.h" #include "TCPClient.h" #include "mk_spi.h" -#include "pan_port.h" +//#include "pan_port.h" #include "mk_timer.h" //#include "pan_param.h" //#include "pan_rf.h" -#include "lora_3029.h" -#include "pan_rf.h" +#include "lora_1268.h" +//#include "pan_rf.h" #include "PCA9555.h" +#include "mk_phy.h" +#include "HIDO_Timer.h" #define DEBUG_MODE extern int simple_main(void); extern int temp_main(void); @@ -83,8 +85,25 @@ #define WARING_LIMIT_TIME 10 #define UPDATE_TIME 10 +/****************************************************************引脚宏定义**************************************************/ +#define ADC_PIN IO_PIN_0 +#define UART0_TX IO_PIN_5 +#define UART0_RX IO_PIN_6 +#define UART1_TX IO_PIN_1 +#define UART1_RX IO_PIN_14 + + +/****************************************************************引脚宏定义**************************************************/ +#define UWB_OPEN_COUNT 1 // UWB每次开启持续时间(秒) +#define UWB_MEASUREMENT_INTERVAL 3 // 正常状态测距周期 +#define UWB_MEASUREMENT_INTERVAL_SLEEP 60 // 休眠状态测距周期 +#define INACTIVE_TIMEOUT 30 // 无步数变化超时时间(秒) +bool uwb_is_on = false; // UWB当前状态标记 + void test_Delay_us(uint16_t time); +int LEDTask(uint8_t Uwb_led,uint8_t Bt_led,uint8_t Lora_led,uint8_t Power_led); void Lora_UploadHeartBeartPoll(void); +void upload_apppoll(); extern uint8_t mUsartReceivePack[100]; extern uint8_t mUsart2ReceivePack[150]; extern uint8_t state5V_prase_flag,gps_prase_flag; @@ -137,7 +156,7 @@ .flow = UART_FLOW_CONTROL_NONE, .rx_level = UART_RXFIFO_CHAR_1, .tx_level = UART_TXFIFO_EMPTY, - .baud = BAUD_115200, + .baud = BAUD_921600, #if (TEST_UART_MODE == TEST_UART_POLL_MODE) .dma_en = false, .int_rx = false, @@ -152,10 +171,11 @@ .int_tx = false, #endif }; -void uart_receive_callback(void *dev, uint32_t err_code) -{ - uart_receive(UART_ID1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart_receive_callback); -} +//void uart_receive_callback(void *dev, uint32_t err_code) +//{ +// uart_receive(UART_ID1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart_receive_callback); +//} + static void adc_callback(void *data, uint32_t number) { uint32_t *result = (uint32_t *)data; @@ -178,7 +198,17 @@ bat_percent = ((fVoltage_mv - 3300) /8); } } - // LOG_INFO(TRACE_MODULE_APP, "The voltage is %%%d \r\n",bat_percent); + 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"); + }else{ + //power_low_flag=0; + //gps_air780_power_change(gps_power_state,1);//gps原样,开启4G +// LOG_INFO(TRACE_MODULE_APP, "电池电压正常,4G,GPS,正常工作\r\n"); + } + PCA9555_Set_One_Value_Output(PWR_GND,1);//拉高 } //static void timer_callback(void *dev, uint32_t time) //{ @@ -253,7 +283,8 @@ } void MinuteTask(void) { - adc_get(&sample[0], NUM_SAMPLES, adc_callback);//adc采样 + PCA9555_Set_One_Value_Output(PWR_GND,0);//拉低 + adc_get(&sample[0], NUM_SAMPLES, adc_callback);//adc采样 } void SecondTask(void) {static uint8_t second_count; @@ -263,7 +294,7 @@ MinuteTask(); } //UWB更新列表 - TagListUpdate(); +// TagListUpdate(); //GPS_Poll(); gps_power_state=1;//测试gps长开 //UWB状态检测 @@ -285,35 +316,55 @@ } } - HIDO_TimerTick(); - nomove_count++; +// HIDO_TimerTick(); + } -uint8_t flag_sleeptimer,flag_secondtask,secondtask_count; -uint8_t lora_wg_up=0; +// 定义状态 +typedef enum { + STATE_NORMAL, // 正常状态,3秒测距上传一次 + STATE_SLEEP // 休眠状态,1分钟测距上传一次 +} CountState_t; +// 全局变量 +uint32_t uwb_time_count = 0; // 定时器计数值 +uint32_t step_count = 0; // 步数计数 +uint32_t last_step_count = 0; // 上一次步数 +CountState_t current_state = STATE_NORMAL; // 当前状态 +uint32_t state_start_time = 0; // 状态开始时间 +uint8_t led_state; +uint8_t stationary_flag; extern uint8_t lora_tx_flag; +extern uint16_t sleep_time; +uint8_t input5v_time; +extern uint8_t uwbled,btled,loraled,powerled; +uint8_t jibu_flag; static void sleep_timer_callback(void *dev, uint32_t time) { - g_start_send_flag=1; - // #ifdef DEBUG_BOXING -//// gpio_pin_clr(IO_PIN_5);//测试 - // gpio_pin_set(IO_PIN_5);//测试 - // lora_wg_up=1; - lora_tx_flag++; -// IO_control_init(); -// UWBPoll(); -// -// -// MotorPoll(); + input5v_time=1; +// g_start_send_flag=1; + HIDO_TimerTick(); +// lora_tx_flag++; + uwb_time_count++; + jibu_flag=1; + upload_apppoll(); -// if(secondtask_count++%2==0) -// { -// flag_secondtask = 1; -// }else{ -// flag_secondtask = 0; -// } + if (current_state == STATE_NORMAL) + { + sleep_time++; + } + if(!read_5v_input_pca()) + { + if(bat_percent>15) + { + powerled=1; + } + else + { + powerled=0; + } + } -// flag_sleeptimer = 1; + input5v_time=1; //马达震动逻辑 if(g_com_map[MOTOR_ENABLE]) { @@ -331,18 +382,76 @@ }else{ motor_power_state=1; } - - //GPS工作逻辑 + nomove_count++; + } +uint16_t sleep_time=0; +uint32_t state_start_time_jibu=0; +uint8_t exercise_state=0; +void check_step_and_update_state(void) +{ + if ((step_count != last_step_count)) + { + // 步数有变化,重置状态为正常状态 + last_step_count = step_count; + + if(current_state == STATE_SLEEP) + { + state_start_time_jibu = uwb_time_count; + state_start_time=uwb_time_count; + } +// if (current_state != STATE_NORMAL) +// { +// // 关闭可能正在运行的UWB +// if (uwb_is_on) { +// CloseUWB(); +// UWB_LED_OFF; +// uwb_is_on = false; +// } +// current_state = STATE_NORMAL; +// state_start_time = uwb_time_count; // 重置测距周期 +// } + current_state = STATE_NORMAL; + exercise_state=1; + last_step_count = step_count; + + } + else + { + // 步数没有变化,检查是否需要切换到休眠状态 + if (current_state == STATE_NORMAL) + { + uint32_t inactive_time = uwb_time_count - state_start_time_jibu; + if (inactive_time >= INACTIVE_TIMEOUT) + { // 30秒后切换到休眠状态 + current_state = STATE_SLEEP; + exercise_state=2; + state_start_time_jibu=uwb_time_count; + } + } + } +} +//void phy_timer_callback(uint32_t time) +//{ +// lora_tx_flag++; +//} + +void uart0_receive_callback() +{ + uart_receive(UART_ID0,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart0_receive_callback); +} + +void uart1_receive_callback() +{ + uart_receive(UART_ID1,m_EUART_DMA_RXBuf_1,USART_RX_BUF_SIZE,uart1_receive_callback); +} + static void voltage_input_handler(enum IO_PIN_T pin) { } -static void move_handler(enum IO_PIN_T pin) -{ - nomove_count=0; -} + uint8_t flag_4G_recdata; static void _4gUsart_handler(enum IO_PIN_T pin) { @@ -355,11 +464,14 @@ void Program_Init(void) { Usart1ParseDataCallback = UsartParseDataHandler;//需改为默认为gps处理,UsartParseDataHandler为升级处理当调试时候改为 + Usart0ParseDataCallback = UsartParseDataHandler_1; parameter_init_anchor();//g_com_map表初始化角色默认为基站 - g_com_map[DEV_ID]=0x6789; - g_com_map[GROUP_ID]=1; +// g_com_map[DEV_ID]=0x0721; + g_com_map[STATIONARY_TIME] = 10; +// g_com_map[GROUP_ID]=1; dev_id=g_com_map[DEV_ID];//这里不太对 group_id=g_com_map[GROUP_ID];//组ID +// group_id=0x04; tag_frequency = 1000/g_com_map[COM_INTERVAL];//测距频率这个存的是测距时间 memcpy(&disoffset,&g_com_map[DIST_OFFSET],2); // g_com_map[ALARM_DISTANCE1] = 40; @@ -385,44 +497,64 @@ 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)|11; + 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,"固件版本:BGK-mk+蓝牙薄工卡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); } - - +uint32_t adctick = 0; +uint16_t chongman_time; 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(); - } - } - UART_CheckReceive(); +{ + UART0_CheckReceive(); + UART_CheckReceive(); +if(read_5v_input_pca()) + { + chongman_time=0; + RED_LED_OFF; + GREEN_LED_OFF; + UWB_LED_OFF; + BT_LED_OFF; + LORA_LED_OFF; + while(1) + { + nomove_count = 0; + adctick = HIDO_TimerGetTick(); + if(HIDO_TimerGetTick()-adctick>60) //10分钟采样一次 电量 + { + chongman_time=chongman_time+60; + adctick = HIDO_TimerGetTick(); + PCA9555_Set_One_Value_Output(PWR_GND,0);//拉低 + adc_get(&sample[0], NUM_SAMPLES, adc_callback);//adc采样 + } + if(bat_percent>=99&&chongman_time>=600) + { + GREEN_LED_ON; + RED_LED_OFF; + } + else + { +// RED_LED_ON; + GREEN_LED_OFF; + } + + if(!read_5v_input_pca()) + { + break; + } + } + sys_reset(0); +// NVIC_SystemReset(); +// input5vflag=1; + } + else + { + +// sys_reset(0); + } } + int bind_check(void) { if(g_com_map[BIND_DEV_ID]!=0x00) @@ -448,11 +580,16 @@ { //将boot中串口返回普通gpio // UART0 TX/RX - io_pin_mux_set(IO_PIN_5, IO_FUNC0); - io_pin_mux_set(IO_PIN_6, IO_FUNC0); + io_pin_mux_set(UART0_RX, IO_FUNC0); + io_pin_mux_set(UART0_TX, IO_FUNC0); + + gpio_pin_set_dir(UART0_RX , GPIO_DIR_OUT, 0); + gpio_pin_set_dir(UART0_TX , GPIO_DIR_OUT, 0); // UART1 RX/TX - io_pin_mux_set(IO_PIN_10, IO_FUNC0); - io_pin_mux_set(IO_PIN_9, IO_FUNC0); + io_pin_mux_set(UART1_RX, IO_FUNC0); + io_pin_mux_set(UART1_TX, IO_FUNC0); + + uart_close(UART_ID1);//解绑原来串口1 uart_close(UART_ID0);//解绑原来串口0 } @@ -467,22 +604,76 @@ } } +void mcu_deep_sleep(void) +{ + uint32_t lock; + trace_flush(); + lock = int_lock(); + boot_deinit(); + LOG_INFO(TRACE_MODULE_APP, "进入休眠\r\n"); + //关闭蓝牙 灯 + LORA_LED_OFF; + GREEN_LED_OFF; + UWB_LED_OFF; + RED_LED_OFF; + BT_LED_OFF; + PCA9555_Set_One_Value_Output(BT_EN,0); +// PCA9555_Set_One_Value_Config(BT_IRQ,0); //设置BT_IRQ为输出拉低 +// PCA9555_Set_One_Value_Output(BT_IRQ,0); + sleep_timer_stop(); + power_enter_power_down_mode(1); + sys_reset(0); + int_unlock(lock); +} +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)PCA_INPUT_DETECT, POWER_WAKEUP_LEVEL_LOW); + mcu_deep_sleep(); + + } +} #define TEST_SPI_MASTER 0 #define TEST_SPI_POLL_MODE 0 #define TEST_SPI_INTERUPT_MODE 1 #define TEST_SPI_DMA_MODE 2 #define TEST_SPI_MODE TEST_SPI_POLL_MODE -void spi_gpio_init() + +void Board_gpio_init() { - // SPI0 MOSI/MISO/CLK/CS + //SPI0/MOSI/MISO/CLK/CS io_pin_mux_set(LORA_CS, IO_FUNC0); gpio_pin_set_dir(LORA_CS , GPIO_DIR_OUT, 0); io_pull_set(LORA_CS, IO_HIGH_Z, IO_PULL_UP_NONE); - + io_pin_mux_set(LORA_MOSI, IO_FUNC2); io_pin_mux_set(LORA_MISO, IO_FUNC2); io_pin_mux_set(LORA_CLK, IO_FUNC2); - io_pin_mux_set(LORA_DIO, IO_FUNC0);//spi中断 + io_pin_mux_set(LORA_DIO, IO_FUNC0); + + + //ADC + io_pin_mux_set(ADC_PIN, IO_FUNC1); + io_pull_set(ADC_PIN, IO_HIGH_Z, IO_PULL_UP_NONE); + + //串口0 + io_pin_mux_set(UART0_RX, IO_FUNC4); + io_pin_mux_set(UART0_TX, IO_FUNC4); + uart_open(UART_ID0, &test_uart_cfg); +// io_pin_mux_set(UART0_RX, IO_FUNC0); +// gpio_pin_set_dir(UART0_RX , GPIO_DIR_OUT, 0); +// io_pin_mux_set(UART0_TX, IO_FUNC0); +// gpio_pin_set_dir(UART0_TX , GPIO_DIR_OUT, 0); +// board_debug_console_open(TRACE_PORT_UART0); + uart_receive(UART_ID0,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart0_receive_callback);//开启dma + + //串口1 + io_pin_mux_set(UART1_RX, IO_FUNC4); + io_pin_mux_set(UART1_TX, IO_FUNC4); + + board_debug_console_open(TRACE_PORT_UART1,BAUD_115200); + uart_receive(UART_ID1,m_EUART_DMA_RXBuf_1,USART_RX_BUF_SIZE,uart1_receive_callback);//开启dma } void spi_init() { @@ -524,449 +715,223 @@ uint8_t flag_4guart_needinit=0; #define TX_LEN 10 #define RX_LEN 200 -uint8_t tx_test_buf[TX_LEN] = {0, 1, 2, 3, 4, 5, 6, 7, 8, 9}; + extern uint8_t RX_Buffer[RX_LEN]; extern uint16_t BufferSize; static uint16_t source_id; extern struct RxDoneMsg RxDoneParams; -uint32_t time_flag_lorarx=0; -uint32_t lora_huanxing_count=0; -uint16_t Lora_wangguanid=0; -extern uint16_t wg_report_freq,wg_report_id; -extern uint32_t wg_lost_count; -wg_state_enum wg_state = WG_Lost; + + extern uint16_t current_count; extern uint8_t rec_index,rec_secdelay; extern uint8_t yuyin_no_sleep_flag,no_rx_flag; -uint16_t wangguan_up_id; -uint8_t LoraUp_flag; -uint8_t imu_enable,motor_enable; -extern uint8_t shengji_flag; -uint16_t rec_wenjian_daxiao; -uint16_t recnum[3]; -uint16_t recv_flag=0; -uint16_t tx_flag=0; -uint16_t CRC16=0; -uint16_t DEST_ID=0; -uint16_t rec_value,rec_delaytime,rx_count,datalen_offset; -// -uint16_t Loratx_flag=0; -uint16_t Lorarx_flag=0; -uint16_t Lorarx_time_out_flag=0; + +/********************************************************************************************************/ +/********************************************************************************************************/ +/********************************************************************************************************/ + +wg_state_enum wg_state = WG_Lost; +/********************************************************************************************************/ static void Lora_irq_handler(enum IO_PIN_T pin) { - uint16_t checksum1; - rf_irq_process(); - //这里根据SDK的那个逻辑 用你的接口看看 - tx_flag=rf_get_transmit_flag(); - recv_flag=rf_get_recv_flag(); - if(recv_flag == RADIO_FLAG_RXDONE) - { - rf_set_recv_flag(RADIO_FLAG_IDLE); - - memcpy(RX_Buffer,RxDoneParams.Payload,RxDoneParams.Size); - BufferSize=RxDoneParams.Size; - lora_huanxing_count++; - if(RX_Buffer[0]==0x04&&RX_Buffer[1]=='I'&&RX_Buffer[2]=='N'&&RX_Buffer[3]=='G') - { - - time_flag_lorarx=phy_timer_count_get(); - UwbRange(); - //rf_enter_continous_rx(); //重新进入接收模式 - //LORA_REV_uwb_up=1; - } - if(RX_Buffer[MSG_TYPE_IDX]==LORA_MSGTYPE_WGRESPTAG) - { - checksum1=Checksum_u16(RX_Buffer,BufferSize-2); - - memcpy(&DEST_ID,&RX_Buffer[DEST_ID_IDX],2); - memcpy(&CRC16,&RX_Buffer[BufferSize-2],2); - if(!memcmp(&checksum1,&RX_Buffer[BufferSize-2],2)) - if(!memcmp(&dev_id,&RX_Buffer[DEST_ID_IDX],2)) - { - memcpy(&source_id,&RX_Buffer[SOURCE_ID_IDX],2); - if(wg_state==WG_Lost) - { - wg_state = WG_Connected; - wg_report_id = source_id; - } - if(!memcmp(&wg_report_id,&RX_Buffer[SOURCE_ID_IDX],2)) - { - wg_lost_count = 0; - switch(RX_Buffer[PWTAG_RW_FLAG_IDX]) - { - case WGRSP_RWTAG_NONE: -// current_count = HAL_LPTIM_ReadCounter(&hlptim1); -// wg_report_freq = RX_Buffer[POLL_FREQ_IDX]+400; -// memcpy(&rec_delaytime,&RX_Buffer[NEXTPOLL_TIME_IDX],2); -// if(report_ancnum<2) -// { -// datalen_offset = report_ancnum*85; -// }else{ -// datalen_offset = (report_ancnum-1)*46+85; -// } -// rec_secdelay = RX_Buffer[PWTAG_SECDELAY_IDX]; -// if(BufferSize!=13||rec_secdelay>20) -// { -// rec_secdelay = 0; -// } -// -// target_count = current_count + rec_delaytime*3.2768 - delaytime-datalen_offset; -// while(target_count>=32768) -// target_count-=32768; -// __HAL_LPTIM_COMPARE_SET(&hlptim1, target_count); - // rx_count = HAL_LPTIM_ReadCounter(&hlptim1); - // printf("tx %d,rx %d,delay %d",current_count>>5,rx_count>>5,rec_delaytime); - break; - case WGRSP_RWTAG_READ: - no_rx_flag = 1; - LoraSendComMap(WGRSP_RWTAG_READ); - break; - case WGRSP_RWTAG_WRITE: - rec_index = RX_Buffer[PWTAG_WRITE_IDX_IDX]; - switch(rec_index) - { - case 0xdd: //语音下发 - break; -// case 0x20: //蜂鸣 -// memcpy(&rec_value,&RX_Buffer[PWTAG_WRITE_VALUE_IDX],2); -// motor_keeptime = rec_value; -// break; - default : - memcpy(&rec_value,&RX_Buffer[PWTAG_WRITE_VALUE_IDX],2); - g_com_map[rec_index/2] = rec_value; - save_com_map_to_flash(); - LoraRspWriteCommap(SUBMSG_WRITE_ANCPARA); - //flag_writepara_needreset = 1; - no_rx_flag = 1; - } - - break; - case WGRSP_RWTAG_UPDATE: - rec_index = RX_Buffer[PWTAG_WRITE_IDX_IDX]; - switch(rec_index) - { - case 0xaa: //升级下发 - memcpy(&rec_wenjian_daxiao,&RX_Buffer[WRITEPARA_VALUE_IDX],2);//文件大小 - if(rec_wenjian_daxiao>0XAC00||rec_wenjian_daxiao==0) - {}//文件过大,超出范围 - else - { - memcpy(&wangguan_up_id,&RX_Buffer[SOURCE_ID_IDX],2);//网关ID 占用2个字节 - shengji_flag=1; - LoraUp_flag=1; - imu_enable=0; - } -// LoraUp_Poll(); - break; - } - break; - } - } - } - - } - - - } - if(tx_flag == RADIO_FLAG_TXDONE) - { - //rf_set_mode(RF_MODE_STB3); - rf_set_transmit_flag(RADIO_FLAG_IDLE); - Loratx_flag++; - -// #ifdef DEBUG_BOXING -// //gpio_pin_clr(IO_PIN_5);//测试 -// gpio_pin_set(IO_PIN_5);//测试 -// #endif - rf_enter_single_timeout_rx(100); - // rf_enter_single_rx(); - // rf_enter_continous_rx(); - - } - if((recv_flag == RADIO_FLAG_RXTIMEOUT)) - { -// #ifdef DEBUG_BOXING -// gpio_pin_clr(IO_PIN_5);//测试 -// // gpio_pin_set(IO_PIN_5);//测试 -// #endif - - //这个超时接收是会自动重启的,所以必须将芯片状态置成STB3这样就退出了连续接收状态 - rf_set_mode(RF_MODE_STB3); - //这个超时接收是会自动重启的,所以必须将芯片状态置成STB3这样就退出了连续接收状态 - - Lorarx_time_out_flag++; - rf_set_recv_flag(RADIO_FLAG_IDLE); - - // rf_clr_irq(REG_IRQ_RX_TIMEOUT); - // rf_enter_single_timeout_rx(100); - } - if((recv_flag == RADIO_FLAG_RXERR)) - { - rf_set_recv_flag(RADIO_FLAG_IDLE); - } - + RadioIrqProcess(); } - - void Board_LORA_NVIC_Init(GPIO_IRQ_HANDLER_T irq_handler) //LORA 中断配置 { // io_pin_mux_set(_4G_USART_RX_Pin,IO_FUNC0);//把原先io 变为普通GPIO gpio_pin_set_dir(LORA_DIO , GPIO_DIR_IN, 0); io_pull_set(LORA_DIO, IO_HIGH_Z, IO_PULL_UP_NONE); - gpio_enable_irq(LORA_DIO, GPIO_IRQ_TYPE_RISING_EDGE, irq_handler); + gpio_enable_irq(LORA_DIO, GPIO_IRQ_TYPE_RISING_EDGE, irq_handler); } +extern uint8_t pca9555writedata_input[10];//暂存输入寄存器所有配置的数组 +static void pca_handler(enum IO_PIN_T pin) +{ + PCA9555_readdata(PCA9555_DEVICE_ADDR,pca9555writedata_input);//读输入寄存器的值 + check_input_change(); +} +extern uint32_t uwb_time_count; +uint8_t uwbled,btled,loraled,powerled; +uint8_t send_count=0; +void upload_apppoll() +{ + uint32_t elapsed_time_jibu; + switch (current_state) + { + case STATE_NORMAL: + elapsed_time_jibu = uwb_time_count - state_start_time; + switch(elapsed_time_jibu) + { + case UWB_OPEN_COUNT: + CloseUWB(); + LoraReportPoll(); + break; + + case UWB_MEASUREMENT_INTERVAL: + LEDTask(uwbled,btled,loraled,powerled); + LEDTask(0,0,0,2); + PCA9555_Set_One_Value_Output(IO_KONG,0); + delay_us(10000); + PCA9555_Set_One_Value_Output(IO_KONG,1); + CloseUWB(); + Uwbinit(); + OpenUWB(); + state_start_time = uwb_time_count; + break; + } + break; + + case STATE_SLEEP: + elapsed_time_jibu = uwb_time_count - state_start_time; + switch(elapsed_time_jibu) + { + case UWB_OPEN_COUNT: + CloseUWB(); + LoraReportPoll(); + + + break; + + case UWB_MEASUREMENT_INTERVAL_SLEEP: + LEDTask(uwbled,btled,loraled,powerled); + LEDTask(0,0,0,2); + PCA9555_Set_One_Value_Output(IO_KONG,0); + delay_us(10000); + PCA9555_Set_One_Value_Output(IO_KONG,1); + CloseUWB(); + Uwbinit(); + OpenUWB(); + state_start_time = uwb_time_count; + + + break; + } + break; + } + +} +int LEDTask(uint8_t Uwb_led,uint8_t Bt_led,uint8_t Lora_led,uint8_t Power_led) +{ + if(Uwb_led==1) + { + UWB_LED_ON; + }else + { + UWB_LED_OFF; + } + + if(Bt_led==1) + { + BT_LED_ON; + }else + { + BT_LED_OFF; + } + if(Lora_led==1) + { + LORA_LED_ON; + }else + { + LORA_LED_OFF; + } + + if(powerled==1) + { + GREEN_LED_ON; + GREEN_LED_OFF;; + } + else if(powerled==0) + { + RED_LED_ON; + RED_LED_OFF; + + } + +// PCA9555_Set_One_Value_Output(BT_IRQ ,0); + + +} uint8_t io14_state; uint16_t lora_freq=0; uint16_t lora_up_count=0; -uint8_t TXBuffer[8]={0,1,2,3,4,5,6,7}; -uint8_t test_buf[10]={0,1,1,1,1,1,1,1,1,1}; +//uint8_t TXBuffer[8]={0,1,2,3,4,5,6,7}; +//uint8_t test_buf[10]={0,1,1,1,1,1,1,1,1,1}; int main(void) { board_clock_run(); -// boot_deinit(); -// board_pins_config(); - board_debug_console_open(TRACE_PORT_UART1); + boot_deinit(); + // Reset reason reset_cause_get(); - reset_cause_clear(); - - // Load calibration parameters from NVM -// uint32_t internal_flash = (REG_READ(0x40000018) >> 17) & 0x1; -// uint32_t external_flash = (REG_READ(0x40010030) >> 28) & 0x3; -// if (internal_flash || external_flash == 1) -// { -// WsfNvmInit(); -// board_calibration_params_load(); -// flash_close(FLASH_ID0); -// } -// else -// { -// board_calibration_params_default(); -// } - + reset_cause_clear(); // Chip calibration calib_chip(); - // Disable watchdog timer wdt_close(WDT_ID0); -// LOG_INFO(TRACE_MODULE_APP, "UWB simple example\r\n"); - - // open system timer - //sys_timer_open(); - -// // TODO 4G -// Uart_Register(UART_ID_4G, UART_ID0); -// Internet_Init(); -// TCPClient_Init(); - gpio_open(); - -// struct TIMER_CFG_T timer_cfg = { -// .extin_type = TIMER_EXTIN_NONE, -// .load = 0x1000000, -// .int_en = true, -// .callback = timer_callback, -// }; - -// timer_open(TIMER_ID0, &timer_cfg); - spi_gpio_init(); + Board_gpio_init(); + //board_led_init(); - spi_init(); - //PCA9555_init(); + + Board_LORA_NVIC_Init(Lora_irq_handler); - Lora_init(); - //lora_freq=DEFAULT_up_FREQ+g_com_map[GROUP_ID]; - // rf_set_default_para(DEFAULT_up_FREQ+g_com_map[GROUP_ID],DEFAULT_up_SF); - rf_set_default_para(DEFAULT_WG_SET_FREQ,DEFAULT_WG_SET_SF); - //rf_enter_continous_rx(); - // rf_enter_continous_rx(); -// if((rf_single_tx_data(TXBuffer,10,0))!= OK) -// { -// -// } - //rf_set_default_para(DEFAULT_WG_SET_FREQ,DEFAULT_WG_SET_SF); - // rf_set_default_para(DEFAULT_up_FREQ,DEFAULT_up_SF); -// - //rf_enter_continous_tx(); -// rf_set_transmit_flag(RADIO_FLAG_TXDONE); -// rf_set_transmit_flag(RADIO_FLAG_TXDONE); -// if(rf_continous_tx_send_data(tx_test_buf, TX_LEN) != 0) -// { -// error_cnt++; -// } -// else -// { -// successful_cnt ++; -// } - - -// while (rf_get_transmit_flag() == RADIO_FLAG_IDLE) ; -// -// rf_set_transmit_flag(RADIO_FLAG_IDLE); - -// 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_OUT, 0); -// io_pull_set(SCL_PIN , IO_PULL_DOWN, IO_PULL_UP_LEVEL4); -// gps_air780_power_change(0,1);//开启gps,4G -////加速度计初始化必须在IO_control_init之前因为复用SDA引脚 -// adc_get(&sample[0], NUM_SAMPLES, adc_callback);//adc采样 - Program_Init(); - + pca_input_detection_init(pca_handler); + IIC2_Init(); + Accelerometer_Init(); - // rf_single_tx_data(TXBuffer,10,2); -// uart_receive(UART_ID1,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart_receive_callback); -// -//// Initialize low power mode -// power_init(); -// AIR780E_Reset(); //4G模块重启,耗时1.5秒,这个是无法同步的关键 + PCA9555_init(); + adc_open(&usr_adc_cfg); + Lora_1268_Init(); + SwitchLoraSettings(478,7,22); + Program_Init(); + power_init(); sleep_timer_open(true, SLEEP_TIMER_MODE_RELOAD, sleep_timer_callback); - sleep_timer_start(__MS_TO_32K_CNT(1000));//测试 -#ifdef DEBUG_BOXING - io_pin_mux_set(IO_PIN_5,IO_FUNC0); - gpio_pin_set_dir(IO_PIN_5,GPIO_DIR_OUT,0); - io_pull_set(IO_PIN_5,IO_PULL_DOWN,IO_PULL_UP_LEVEL4); -#endif - //rf_enter_single_timeout_rx(1000); -// board_acceleration_detection_init(move_handler); - //rf_enter_single_timeout_rx(900); - //rf_enter_single_timeout_rx(500); - //rf_enter_single_rx(); + adc_get(&sample[0], NUM_SAMPLES, adc_callback); +//#ifdef DEBUG_BOXING +// io_pin_mux_set(BOXING_PIN,IO_FUNC0); +// gpio_pin_set_dir(BOXING_PIN,GPIO_DIR_OUT,0); +// io_pull_set(BOXING_PIN,IO_PULL_DOWN,IO_PULL_UP_LEVEL4); +//#endif Uwbinit(); +// OpenUWB(); +// boot_deinit(); while (1) { -// rf_irq_process(); - - //rf_enter_single_rx(); - - Lora_Tx_Poll(); -// if((rf_single_tx_data(TXBuffer,10,0))!= OK) -// { -// -// } - // #ifdef DEBUG_BOXING -// gpio_pin_clr(IO_PIN_5);//测试 -// gpio_pin_set(IO_PIN_5);//测试 + if(jibu_flag) + { + jibu_flag=0; + step_count = mir3da_get_step(); // 获取步数 + } + +// Lora_Tx_Poll(); + uwb_app_poll(); + check_step_and_update_state(); +// upload_apppoll(); + IdleTask(); + IMUTask(); -// test_Delay_us(1000); -// gpio_pin_set(IO_PIN_5);//测试 -// test_Delay_us(100000); -// test_Delay_us(100000); -// test_Delay_us(100000); -// gpio_pin_clr(IO_PIN_5);//测试 -// test_Delay_us(2000); -// gpio_pin_set(IO_PIN_5);//测试 -// test_Delay_us(1000); -// gpio_pin_clr(IO_PIN_5);//测试 -// if(LORA_REV_uwb_up) -// { -// LORA_REV_uwb_up=0; -// UwbRange(); -// } - - - - - // UwbRange(); -// rf_irq_process(); -// if(rf_get_transmit_flag() == RADIO_FLAG_TXDONE) -// { -// rf_set_transmit_flag(RADIO_FLAG_IDLE); -// rf_delay_ms(1000); -// if(rf_continous_tx_send_data(tx_test_buf, TX_LEN) != 0) -// { -// error_cnt++; -// } -// else -// { -// successful_cnt ++; -//// DDL_Printf("Tx cnt %d\r\n", cnt ); -// } -// } - - -//// -// -//// io14_state=gpio_pin_get_val(LORA_DIO); -// rf_set_transmit_flag(RADIO_FLAG_IDLE); -// rf_delay_ms(1000); -// rf_enter_continous_tx(); -//// rf_set_transmit_flag(RADIO_FLAG_TXDONE); -// if(rf_continous_tx_send_data(tx_test_buf, TX_LEN) != OK) -// { -//// rf_enter_continous_rx(); -// } -// else -// { -// successful_cnt ++; -// } - - - - -// while (rf_get_transmit_flag() == RADIO_FLAG_IDLE) ; -// -// rf_set_transmit_flag(RADIO_FLAG_IDLE); - -// if(flag_TCP_reconnectting||IfTCPConnected()) -// { +// if(1) +// { +//// test1=gpio_pin_get_val(_4G_USART_RX_Pin); +// uint32_t lock; +// //flag_4guart_needinit = 1; +//// Internet_Poll(); +//// HIDO_ATLitePoll(); +//// HIDO_TimerPoll(); +//// TCPClient_Poll(); // -// // LOG_INFO(TRACE_MODULE_APP, "处理4G任务\r\n"); -// air780_led_on(); -// if(flag_4guart_needinit) -// { -// flag_4guart_needinit = 0; -// AIR780EUartInit(); -// } -// Internet_Poll(); -// HIDO_ATLitePoll(); -// HIDO_TimerPoll(); -// TCPClient_Poll(); -// air780_led_off(); -// } -// if(flag_secondtask) -// { -// flag_secondtask = 0; -// SecondTask(); -// } -// IdleTask(); -// //3种情况后都要发包和休眠 -// //if(send_flag){ -// //message_construct(); -// //send_udp; -// //air780_success_state=0;//关闭4G成功发送灯 -// //blink_led(&air780_success_state);//成功测距闪烁4G状态灯 -// //air780_success_state=0; -// //} -//#ifndef DEBUG_MODE -////if(flag_sleeptimer) -// if(!gpio_pin_get_val(INPUT_5V_Pin)&&((IfTCPConnected()&&Socket_IsSendQueueEmpty(0))||!flag_TCP_reconnectting&&!IfTCPConnected())) //进入休眠条件(与关系,全满足才进):1.没有5V输入 2 TCP已连接时发送队列为空||TCP无连接时不在重连状态。 -// { -// if(!flag_4guart_needinit) -// { -// LOG_INFO(TRACE_MODULE_APP, "4G RX 中断打开\r\n"); -// board_4GUsart_detection_init(_4gUsart_handler); - -// } -// flag_sleeptimer =0; -// LOG_INFO(TRACE_MODULE_APP, "进入休眠\r\n"); -// flag_4guart_needinit = 1; - -// trace_flush(); -// uint32_t lock = int_lock(); -// //LOG_INFO(TRACE_MODULE_APP, "进入低功耗"); -// power_enter_power_down_mode(0); -// int_unlock(lock); -// } -//#endif +// // delay_us(300000); +// trace_flush(); +// lock = int_lock(); +// power_enter_power_down_mode(0); +// uart_receive(UART_ID0,m_EUART_DMA_RXBuf,EUART_RX_BUF_SIZE,uart0_receive_callback); +//// test3=gpio_pin_get_val(_4G_USART_RX_Pin); +// //LOG_INFO(TRACE_MODULE_APP, "进入休眠\r\n"); +// int_unlock(lock); +// } } } -- Gitblit v1.9.3