From a05285d3b4ea5aa0609a2a23aa867c17c0611a38 Mon Sep 17 00:00:00 2001 From: yincheng.zhong <634916154@qq.com> Date: 星期日, 18 二月 2024 10:17:57 +0800 Subject: [PATCH] 配合网关调试标签上传回复部分,测距部分已经调通 --- Src/radio/Lora.c | 456 +++++++++++++++++++++++++------------------------------- 1 files changed, 202 insertions(+), 254 deletions(-) diff --git a/Src/radio/Lora.c b/Src/radio/Lora.c index c7f17f6..4c1101d 100644 --- a/Src/radio/Lora.c +++ b/Src/radio/Lora.c @@ -10,52 +10,32 @@ #include "stdio.h" #include "delay.h" #include "main.h" +#include <stdlib.h> +#include "dw_mbx_tag.h" +#include "WS2812.h" static RadioEvents_t RadioEvents; #define USE_MODEM_LORA //#define USE_MODEM_FSK -#define REGION_CN779 +#define REGION_CN779 +void Lora47xrx_Init(void); +void Lora433_change(void); +void Lora433rx_Init(void); uint32_t RxDutyCycle_RX_time =128; uint32_t RxDutyCycle_SLEEP_time=256; -#if defined( REGION_AS923 ) - -#define RF_FREQUENCY 923000000 // Hz - -#elif defined( REGION_AU915 ) - -#define RF_FREQUENCY 915000000 // Hz - -#elif defined( REGION_CN779 ) - +#define LORA_FREQUENCY0 470200000 +#define LORA_FREQUENCY1 471200000 +#define LORA_FREQUENCY2 472200000 +#define LORA_FREQUENCY3 473200000 +#define LORA_FREQUENCY4 474200000 +uint16_t Lora_rece_error; +#define LORA_RX_433 1 +#define LORA_TX_47X 2 +#define LORA_RX_47X 3 +uint8_t Lora_status=0; +extern uint32_t uwbled,gpsled,loraled,powerled; #define RF_FREQUENCY 433000000 // Hz #define RF_FREQUENCY_R 500000000 // Hz #define RF_FREQUENCY_T 470200000 // Hz - - -#elif defined( REGION_EU868 ) - -#define RF_FREQUENCY 868000000 // Hz - -#elif defined( REGION_KR920 ) - -#define RF_FREQUENCY 920000000 // Hz - -#elif defined( REGION_IN865 ) - -#define RF_FREQUENCY 865000000 // Hz - -#elif defined( REGION_US915 ) - -#define RF_FREQUENCY 915000000 // Hz - -#elif defined( REGION_US915_HYBRID ) - -#define RF_FREQUENCY 915000000 // Hz - -#else - - #error "Please define a frequency band in the compiler 'options." - -#endif #define TX_OUTPUT_POWER 22 // 22 dBm @@ -85,8 +65,8 @@ // 2: 4/6, // 3: 4/7, // 4: 4/8] -#define LORA_PREAMBLE_LENGTH_T 10 // Same for Tx -#define LORA_PREAMBLE_LENGTH_R 64 // Same for Rx +#define LORA_PREAMBLE_LENGTH_T 8 // Same for Tx +#define LORA_PREAMBLE_LENGTH_R 8 // Same for Rx //#define LORA_PREAMBLE_LENGTH 990 // Same for Tx and Rx #define LORA_SYMBOL_TIMEOUT 0 // Symbols #define LORA_FIX_LENGTH_PAYLOAD_ON false @@ -118,11 +98,10 @@ }States_t; //#define RX_TIMEOUT_VALUE 1000 -#define RX_TIMEOUT_VALUE 64000 -#define BUFFER_SIZE 64 // Define the payload size here +#define RX_TIMEOUT_VALUE 10 +#define BUFFER_SIZE 255 // Define the payload size here -const uint8_t PingMsg[] = "PING"; -const uint8_t PongMsg[] = "PONG"; + uint16_t BufferSize = BUFFER_SIZE; uint8_t TX_Buffer[BUFFER_SIZE]; @@ -140,64 +119,65 @@ void OnRxError( void ); uint8_t lora_chongfuyingda_flag; uint8_t Lora_rx_open_flag; +extern u32 Loratx_frequency; void LedToggle(void) { // HAL_GPIO_TogglePin(GPIOB, LED1_Pin); } -void Lora_tx_mode( void ) -{ - Radio.SetChannel( 470200000 ); - Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, 0, - 7, LORA_CODINGRATE,LORA_PREAMBLE_LENGTH_T, LORA_FIX_LENGTH_PAYLOAD_ON, - false, 0, 0, LORA_IQ_INVERSION_ON_T, 3000 ); +//void Lora_tx_mode( void ) +//{ +//Lora_status=LORA_TX_47X; +// RadioEvents.TxDone = OnTxDone; +// RadioEvents.RxDone = OnRxDone; +// RadioEvents.TxTimeout = OnTxTimeout; +// RadioEvents.RxTimeout = OnRxTimeout; +// RadioEvents.RxError = OnRxError; -} -void Lora_rx_open( void ) -{ - if(Lora_rx_open_flag==1) - { - Lora_Init(); - Lora_rx_open_flag=0; - } - if(lora_yingda_flag&&lora_chongfuyingda_flag==0) - { - printf("Lora:%d %d\r\n",lora_yingda_flag,lora_chongfuyingda_flag); - lora_chongfuyingda_flag=1; - RadioEvents.TxDone = OnTxDone; - RadioEvents.RxDone = OnRxDone; - RadioEvents.TxTimeout = OnTxTimeout; - RadioEvents.RxTimeout = OnRxTimeout; - RadioEvents.RxError = OnRxError; +// Radio.Init( &RadioEvents ); +// Radio.SetChannel( Loratx_frequency ); +// +// Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, 2, +// 7, LORA_CODINGRATE,LORA_PREAMBLE_LENGTH_T, LORA_FIX_LENGTH_PAYLOAD_ON, +// false, 0, 0, LORA_IQ_INVERSION_ON_T, 3000 ); - Radio.Init( &RadioEvents ); - Radio.SetChannel( 500000000 ); - Radio.SetRxConfig( MODEM_LORA, 0, 7, - LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH_R, - LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, - 0, false, 0, 0, true, 1 ); +//} +//void Lora_rx_open( void ) +//{ +// if(Lora_rx_open_flag==1) +// { +// Lora_Init(); +// Lora_rx_open_flag=0; +// } +// if(lora_yingda_flag&&lora_chongfuyingda_flag==0) +// { +// printf("Lora:%d %d\r\n",lora_yingda_flag,lora_chongfuyingda_flag); +// lora_chongfuyingda_flag=1; +// RadioEvents.TxDone = OnTxDone; +// RadioEvents.RxDone = OnRxDone; +// RadioEvents.TxTimeout = OnTxTimeout; +// RadioEvents.RxTimeout = OnRxTimeout; +// RadioEvents.RxError = OnRxError; - SX126xClearIrqStatus( IRQ_RADIO_ALL ); -// Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); - Radio.Rx( RX_TIMEOUT_VALUE ); +// Radio.Init( &RadioEvents ); +// Radio.SetChannel( 500000000 ); +// Radio.SetRxConfig( MODEM_LORA, 0, 7, +// LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH_R, +// LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, +// 0, false, 0, 0, true, 1 ); - - } -} +// SX126xClearIrqStatus( IRQ_RADIO_ALL ); +//// Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); +// Radio.Rx( RX_TIMEOUT_VALUE ); + +// +// } +//} +uint32_t lora_zhuangtai; void OnTxDone( void ) -{ - LED_TB_OFF; - if(lora_yingda_num>1000) - { - lora_yingda_num=0; - lora_yingda_flag=1; - } - - if(lora_yingda_flag==0) - Lora_rx_open_flag=1; - else - {} - +{ + Radio.Standby(); + Radio.Rx( RX_TIMEOUT_VALUE ); } extern uint32_t lp_time; @@ -216,199 +196,167 @@ u8 lora_seq_nb2; extern uint8_t stationary_flag; extern uint8_t anjian_flag; -void Lora_tx_zubao( void ) -{ - uint16_t checksum; - usart_send[2] = 0x22;//正常模式 - usart_send[3] = 9+Lora_tx_ancnum*4;//数据段长度 - memcpy(&usart_send[4],&dev_id,2); - usart_send[6] = lora_seq_nb2;//包序 - power_and_key=stationary_flag<<1;//把按键跟静止2合1,发出去 - power_and_key=power_and_key+anjian_flag;; - memcpy(usart_send+7,&bat_percent,1); - memcpy(usart_send+8,&power_and_key,1); - usart_send[9] = lora_yingda_flag;//lora等待应答位 - usart_send[10] = Lora_tx_ancnum; -// usart_send[9] = lora_yingda_flag; - memcpy(&usart_send[11],&Lora_tx_ancid,2*Lora_tx_ancnum); - memcpy(&usart_send[11+Lora_tx_ancnum*2],&Lora_tx_ancdist,2*Lora_tx_ancnum); - checksum = Checksum_u16(&usart_send[2],8+4*Lora_tx_ancnum); - memcpy(&usart_send[11+4*Lora_tx_ancnum],&checksum,2); -} +uint16_t Lora_wangguanid=0; + +extern uint8_t lora_tx_flag; uint16_t current_count; u16 Lora_recevcount; -extern uint8_t no_data_chongqi_num; +extern uint16_t no_data_chongqi_num; +uint8_t du_flag; +uint8_t xie_flag; +extern uint8_t no_yingdaflag; +uint16_t Beepchixutime; +uint8_t xiafayuyin_data[200]; +uint8_t yuyin_sendflag; +uint8_t yuyinzidongguan_time; +uint8_t yuyin_no_sleep_flag; +extern uint8_t usart5_state; void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr ) { - Lora_recevcount=HAL_LPTIM_ReadCounter(&hlptim1); - Lora_recevcount=Lora_recevcount+197;//197代表6ms - if(Lora_recevcount>=32768) - { - Lora_recevcount -=32768; - } -// HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_SET); - BufferSize = size; - memcpy( RX_Buffer, payload, BufferSize ); - RssiValue = rssi; - SnrValue = snr; + BufferSize = size; + memcpy( RX_Buffer, payload, BufferSize ); + RssiValue = rssi; + SnrValue = snr; + Radio.Standby(); +//printf("收到lora\r\n"); +// if(Lora_status==LORA_RX_433) no_data_chongqi_num=0; - Radio.Standby(); - HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_SET); - if(lora_yingda_flag) + if(RX_Buffer[MSG_TYPE_IDX]==LORA_MSGTYPE_RANGEPOLL) { - memcpy(&lora_recv_devid,&RX_Buffer[4],2); - if(lora_recv_devid==dev_id) - { - - - } - } - if(lora_yingda_flag==0) - { - lora_chongfuyingda_flag=0; -// HAL_GPIO_WritePin(GPIOB, GPIO_PIN_2, GPIO_PIN_SET); -// Delay_Ms(10); -// HAL_GPIO_WritePin(GPIOB, GPIO_PIN_2, GPIO_PIN_RESET); - uint16_t i=0; -// for(i=0;i<BufferSize;i++) - {printf("R %d:\r\n",RX_Buffer[3]);} - RX_TIMEOUTs++; -// printf("RX_num :%d\r\n",RX_TIMEOUTs); -// start_time=HAL_LPTIM_ReadCounter(&hlptim1); -// end_time=start_time+((32768/1000)*20); -// if(end_time>=32768) -// {end_time-=32768;} -// current_time=HAL_LPTIM_ReadCounter(&hlptim1); - HAL_GPIO_WritePin(RADIO_NSS_GPIO_Port, RADIO_NSS_Pin, GPIO_PIN_SET); //片选lora无效 - - id = dwt_readdevid() ; - while (0xDECA0130!=id) - { - u8 iderror_count = 0; - id = dwt_readdevid() ; - if(iderror_count++>100) - { -//////// printf("UWB芯片ID错误"); - break; - } - } -//////// printf("Anchor_App\r\n"); - current_count=HAL_LPTIM_ReadCounter(&hlptim1); - while(current_count<Lora_recevcount||current_count>Lora_recevcount+16384) - { - current_count=HAL_LPTIM_ReadCounter(&hlptim1); - if(current_count<Lora_recevcount-300) - { - break; - } - } -// HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_RESET); - Anchor_App(); -// HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_RESET); + UWB_Wkup(); + MbxTagUwbRec(); HAL_GPIO_WritePin(RADIO_NSS_GPIO_Port, RADIO_NSS_Pin, GPIO_PIN_RESET); //片选lora有效 - delay_ms(1); -// if(lp_time-lora_txtime_old>=1) -// { -// LED_TB_ON; -// lora_txtime_old=lp_time; -// lora_seq_nb2++; -// lora_yingda_num++; -// Lora_tx_zubao(); -// Lora_tx_mode(); -// Radio.Send( usart_send, 12+Lora_tx_ancnum*4); -// Lora_tx_ancnum=0; -// } -// else -// { - Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); -// } - - } + if(RX_Buffer[MSG_TYPE_IDX]==LORA_MSGTYPE_WGRESPTAG) + { + if(!memcmp(&dev_id,&RX_Buffer[DEST_ID_IDX],2)) + { + if(RX_Buffer[6]==0)//不需要操作,正常应答 + { + Lora_rece_error=0; + memcpy( &Lora_wangguanid, &RX_Buffer[2], 2 ); + } + if(RX_Buffer[6]==2) //读操作,下一次lora发送的时候要发出去 + { +// no_yingda_time=5; + Lora_rece_error=0; + if(no_yingdaflag==0) + { + du_flag=1; + LoraSendComMap(RX_Buffer[8],RX_Buffer[7]>>1); + } + } + if(RX_Buffer[6]==1)//写操作 + { + Lora_rece_error=0; + + if(no_yingdaflag==0) + { + if(RX_Buffer[7]==0x10) + { + + } + else + { + if(RX_Buffer[7]==0xDD)//下发语音 + { + if(usart5_state==1) + { + Usart5Init(); + usart5_state=0; + } + HAL_GPIO_WritePin(GPIOC, GPIO_PIN_7, GPIO_PIN_SET); + HAL_GPIO_WritePin(GPIOC, GPIO_PIN_13, GPIO_PIN_SET); + memcpy(&xiafayuyin_data,&RX_Buffer[9],RX_Buffer[8]); + yuyin_sendflag=1; + yuyinzidongguan_time=0; + yuyin_no_sleep_flag=1; + } + else + { + uint16_t pinlv1; + if(RX_Buffer[7]==0x06) + { + memcpy(&pinlv1, &RX_Buffer[9], RX_Buffer[8]); + pinlv1=(1000/pinlv1)*1000; + memcpy((uint8_t*)&g_com_map + RX_Buffer[7], &pinlv1, RX_Buffer[8]); + save_com_map_to_flash(); + delay_ms(100); + NVIC_SystemReset(); + } + + memcpy((uint8_t*)&g_com_map + RX_Buffer[7], &RX_Buffer[9], RX_Buffer[8]); + save_com_map_to_flash(); + delay_ms(100); + NVIC_SystemReset(); + } + } + } + } + } + SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0); + } + Radio.Rx(0); } void OnTxTimeout( void ) { Radio.Standby(); - Lora_Init(); - Lora_rx_open_flag=0; - - Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); + SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0); } - + uint8_t tm; +uint16_t Lora_rece_error; void OnRxTimeout( void ) { Radio.Standby(); - Lora_Init(); - Lora_rx_open_flag=0; - - Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); -// printf("slave OnRxTimeout\r\n"); - + SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0); } void OnRxError( void ) { Radio.Standby(); - Lora_Init(); - Lora_rx_open_flag=0; - Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); + SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0); } -void Lora_Init(void) + +void SwitchLoraSettings(uint32_t freq,uint8_t sf,uint8_t power) +{ + +// RadioEvents.TxDone = OnTxDone; +// RadioEvents.RxDone = OnRxDone; +// RadioEvents.TxTimeout = OnTxTimeout; +// RadioEvents.RxTimeout = OnRxTimeout; +// RadioEvents.RxError = OnRxError; + //HAL_GPIO_WritePin(GPIOB, GPIO_PIN_12, GPIO_PIN_SET); +// Radio.Init( &RadioEvents ); + Radio.Standby(); + // HAL_GPIO_WritePin(GPIOB, GPIO_PIN_12, GPIO_PIN_RESET); + Radio.SetChannel( freq*1000000 ); + + Radio.SetTxConfig( MODEM_LORA, power, 0, 2, + sf, LORA_CODINGRATE,LORA_PREAMBLE_LENGTH_T, LORA_FIX_LENGTH_PAYLOAD_ON, + false, 0, 0, LORA_IQ_INVERSION_ON_T, 3000 ); + + Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, + sf,LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH_R, + LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, + 0, false, 0, 0, LORA_IQ_INVERSION_ON_R, 0 ); + + +} + +void LoraInit(void) { RadioEvents.TxDone = OnTxDone; RadioEvents.RxDone = OnRxDone; RadioEvents.TxTimeout = OnTxTimeout; RadioEvents.RxTimeout = OnRxTimeout; RadioEvents.RxError = OnRxError; -// printf("Lora_Init3\r\n"); - Radio.Init( &RadioEvents ); - Radio.SetChannel( RF_FREQUENCY ); -// Radio.SetStandby( STDBY_RC ); - -// Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, -// LORA_SPREADING_FACTOR, LORA_CODINGRATE, -// LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON, -// true, 0, 0, LORA_IQ_INVERSION_ON, 3000 ); - -// Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, -// LORA_SPREADING_FACTOR, LORA_CODINGRATE, -// LORA_PREAMBLE_LENGTH_T, LORA_FIX_LENGTH_PAYLOAD_ON, -// false, 0, 0, LORA_IQ_INVERSION_ON_T, 1000 ); - -// Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, -// LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, -// LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, -// 0, true, 0, 0, LORA_IQ_INVERSION_ON, false ); -// printf("Lora_Init1\r\n"); - Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, - LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH_R, - LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, - 0, false, 0, 0, LORA_IQ_INVERSION_ON_R, 1 ); + Radio.Init( &RadioEvents ); + SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],5,0); //切换lora接收频点 + Radio.Rx( 9999 ); +// Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); -// Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, -// LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, -// LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, -// 0, false, 0, 0, LORA_IQ_INVERSION_ON, true ); - - - - { - SX126xClearIrqStatus( IRQ_RADIO_ALL ); -// SX126xSetDioIrqParams( IRQ_RX_DONE | IRQ_CRC_ERROR, -// IRQ_RX_DONE | IRQ_CRC_ERROR, -// IRQ_RADIO_NONE, IRQ_RADIO_NONE -// ); -// SX126xSetDioIrqParams( IRQ_RADIO_ALL, //IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT, -// IRQ_RADIO_ALL, //IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT, -// IRQ_RADIO_NONE, -// IRQ_RADIO_NONE ); - Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); -// Radio.Rx( RX_TIMEOUT_VALUE ); -// printf("I am Slave!\r\n"); - } - } -- Gitblit v1.9.3