| | |
| | | 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]; |
| | |
| | | .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) |
| | | { |
| | |
| | | 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) |
| | | { |
| | | input5v_time=1; |
| | |
| | | HIDO_TimerTick(); |
| | | // lora_tx_flag++; |
| | | uwb_time_count++; |
| | | upload_apppoll(); |
| | | step_count = mir3da_get_step(); // 获取步数 |
| | | jibu_flag=1; |
| | | upload_apppoll(); |
| | | |
| | | if (current_state == STATE_NORMAL) |
| | | { |
| | | sleep_time++; |
| | | } |
| | | |
| | | |
| | | if(!read_5v_input_pca()) |
| | | { |
| | | if(bat_percent>15) |
| | | { |
| | | led_state=!led_state; |
| | | if(led_state) |
| | | GREEN_LED_ON; |
| | | else |
| | | { |
| | | GREEN_LED_OFF; |
| | | } |
| | | |
| | | powerled=1; |
| | | } |
| | | else |
| | | { |
| | | RED_LED_ON; |
| | | GREEN_LED_OFF; |
| | | powerled=0; |
| | | } |
| | | } |
| | | } |
| | | |
| | | |
| | | input5v_time=1; |
| | | //马达震动逻辑 |
| | | if(g_com_map[MOTOR_ENABLE]) |
| | |
| | | } |
| | | 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; // 重置测距周期 |
| | | // } |
| | | current_state = STATE_NORMAL; |
| | | exercise_state=1; |
| | | last_step_count = step_count; |
| | | |
| | | } |
| | |
| | | { |
| | | // 步数没有变化,检查是否需要切换到休眠状态 |
| | | 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; |
| | | } |
| | | } |
| | |
| | | { |
| | | 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) |
| | | { |
| | |
| | | void Program_Init(void) |
| | | { |
| | | Usart1ParseDataCallback = UsartParseDataHandler;//需改为默认为gps处理,UsartParseDataHandler为升级处理当调试时候改为 |
| | | Usart0ParseDataCallback = UsartParseDataHandler_1; |
| | | parameter_init_anchor();//g_com_map表初始化角色默认为基站 |
| | | g_com_map[DEV_ID]=0x1234; |
| | | // 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; |
| | | // 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; |
| | |
| | | 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)|12; |
| | | g_com_map[VERSION] = (1<<8)|13; |
| | | LOG_INFO(TRACE_MODULE_APP,"设备ID: %x .\r\n",dev_id); |
| | | 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); |
| | |
| | | void IdleTask(void) |
| | | { |
| | | UART0_CheckReceive(); |
| | | UART_CheckReceive(); |
| | | if(read_5v_input_pca()) |
| | | { |
| | | chongman_time=0; |
| | |
| | | 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); |
| | | // 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); |
| | |
| | | } |
| | | void IMUTask(void) |
| | | { |
| | | if(nomove_count>g_com_map[NOMOVESLEEP_TIME]&&g_com_map[IMU_ENABLE]==2) |
| | | 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(); |
| | |
| | | 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() |
| | | { |
| | |
| | | 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(elapsed_time_jibu) |
| | | { |
| | | case UWB_OPEN_COUNT: |
| | | UWB_LED_OFF; |
| | | LORA_LED_OFF; |
| | | LoraReportPoll(); |
| | | CloseUWB(); |
| | | CloseUWB(); |
| | | LoraReportPoll(); |
| | | break; |
| | | |
| | | case UWB_MEASUREMENT_INTERVAL: |
| | | PCA9555_Set_One_Value_Output(BT_IRQ ,0); |
| | | OpenUWB(); |
| | | state_start_time = uwb_time_count; |
| | | 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; |
| | |
| | | switch(elapsed_time_jibu) |
| | | { |
| | | case UWB_OPEN_COUNT: |
| | | UWB_LED_OFF; |
| | | LORA_LED_OFF; |
| | | LoraReportPoll(); |
| | | CloseUWB(); |
| | | CloseUWB(); |
| | | LoraReportPoll(); |
| | | |
| | | |
| | | break; |
| | | |
| | | case UWB_MEASUREMENT_INTERVAL_SLEEP: |
| | | PCA9555_Set_One_Value_Output(BT_IRQ ,0); |
| | | OpenUWB(); |
| | | state_start_time = uwb_time_count; |
| | | 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; |
| | |
| | | // io_pull_set(BOXING_PIN,IO_PULL_DOWN,IO_PULL_UP_LEVEL4); |
| | | //#endif |
| | | Uwbinit(); |
| | | // OpenUWB(); |
| | | // boot_deinit(); |
| | | while (1) |
| | | { |
| | | BT_LED_OFF; |
| | | if(jibu_flag) |
| | | { |
| | | jibu_flag=0; |
| | | step_count = mir3da_get_step(); // 获取步数 |
| | | } |
| | | |
| | | // Lora_Tx_Poll(); |
| | | // uwb_app_poll(); |
| | | uwb_app_poll(); |
| | | check_step_and_update_state(); |
| | | |
| | | // upload_apppoll(); |
| | | IdleTask(); |
| | | IMUTask(); |
| | | |
| | | // if(1) |
| | | // { |
| | | //// test1=gpio_pin_get_val(_4G_USART_RX_Pin); |