From c2802ee207528de2d06403061405f0faadffb922 Mon Sep 17 00:00:00 2001
From: WXK <287788329@qq.com>
Date: 星期二, 05 三月 2024 18:03:36 +0800
Subject: [PATCH] 初步修改完成，跟工卡相似，gps采用外包代码
---
Src/radio/Lora.c | 274 +++++++++++++++++++++++++-----------------------------
1 files changed, 125 insertions(+), 149 deletions(-)
diff --git a/Src/radio/Lora.c b/Src/radio/Lora.c
index 4c1101d..eebb467 100644
--- a/Src/radio/Lora.c
+++ b/Src/radio/Lora.c
@@ -12,7 +12,6 @@
#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
@@ -20,6 +19,7 @@
void Lora47xrx_Init(void);
void Lora433_change(void);
void Lora433rx_Init(void);
+void SwitchLoraSettings(uint32_t freq,uint8_t sf,uint8_t power);
uint32_t RxDutyCycle_RX_time =128;
uint32_t RxDutyCycle_SLEEP_time=256;
#define LORA_FREQUENCY0 470200000
@@ -32,21 +32,15 @@
#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
-
#define TX_OUTPUT_POWER 22 // 22 dBm
extern bool IrqFired;
extern uint8_t lora_yingda_flag;
uint16_t lora_yingda_num;
-
-
-//bool EnableMaster=true;//主选择
-bool EnableMaster=false;//从选择
-
uint16_t crc_value;
/*!
* Radio events function pointer
@@ -98,10 +92,8 @@
}States_t;
//#define RX_TIMEOUT_VALUE 1000
-#define RX_TIMEOUT_VALUE 10
+#define RX_TIMEOUT_VALUE 0
#define BUFFER_SIZE 255 // Define the payload size here
-
-
uint16_t BufferSize = BUFFER_SIZE;
uint8_t TX_Buffer[BUFFER_SIZE];
@@ -120,97 +112,79 @@
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 )
-//{
-//Lora_status=LORA_TX_47X;
-// 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 );
-
-//}
-//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( 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 );
-
-//
-// }
-//}
+uint8_t flag_writepara_needreset = 0;
+uint32_t wg_lost_count = 10;
uint32_t lora_zhuangtai;
+uint16_t current_count;
+extern wg_state_enum wg_state;
void OnTxDone( void )
{
+ if(flag_writepara_needreset) //配置写入完成设备需要重启
+ {
+ printf("网关下发配置写入完成，重启");
+ SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader
+ }
Radio.Standby();
- Radio.Rx( RX_TIMEOUT_VALUE );
+ Radio.Rx( 50 );
+// LED_TB_OFF;
}
-
-extern uint32_t lp_time;
-uint32_t lora_txtime_old;
-extern uint8_t frame_seq_nb2,rec_nearbase_num,ancidlist_num;
-uint16_t RX_TIMEOUTs;
extern LPTIM_HandleTypeDef hlptim1;
uint16_t current_time,start_time,end_time;
- uint16_t lora_recv_devid=0;
-u32 id;
-extern uint8_t Lora_tx_ancnum;
-extern uint16_t Lora_tx_ancid[50];
-extern uint16_t Lora_tx_ancdist[50];
uint8_t power_and_key=0;
extern u8 battary,button;
u8 lora_seq_nb2;
extern uint8_t stationary_flag;
extern uint8_t anjian_flag;
-uint16_t Lora_wangguanid=0;
-
extern uint8_t lora_tx_flag;
-uint16_t current_count;
-u16 Lora_recevcount;
-extern uint16_t no_data_chongqi_num;
-uint8_t du_flag;
-uint8_t xie_flag;
+extern uint16_t wg_report_id,wg_report_freq;
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;
+uint8_t yuyin_no_sleep_flag,no_rx_flag;
extern uint8_t usart5_state;
+extern uint8_t lora_sendbuffer[200];
+void LoraSendComMap(uint8_t cmd)
+{
+ uint8_t data_length = 0x28;
+ uint16_t checksum = 0;
+ lora_sendbuffer[MSG_TYPE_IDX] = LORA_MSGTYPE_READPARARESP;
+ lora_sendbuffer[MSG_LENGTH] = data_length+9;
+ memcpy(&lora_sendbuffer[SOURCE_ID_IDX],&g_com_map[DEV_ID],2);
+ memcpy(&lora_sendbuffer[DEST_ID_IDX],&wg_report_id,2);
+ lora_sendbuffer[RP_CMD_IDX] = cmd;
+ lora_sendbuffer[RP_INDEX_IDX] = 2;
+ lora_sendbuffer[RP_LEN_IDX] = data_length;
+ memcpy(&lora_sendbuffer[7], &g_com_map[1], data_length);
+ checksum = Checksum_u16(lora_sendbuffer,9+data_length);
+ memcpy(&lora_sendbuffer[9+data_length],&checksum,2);
+ Radio.Send(lora_sendbuffer,data_length+11);
+ // Delay_Ms(100);
+}
+void LoraRspWriteCommap(uint8_t index)
+{
+ uint8_t data_length = 2;
+ uint16_t checksum = 0;
+ lora_sendbuffer[MSG_TYPE_IDX] = LORA_MSGTYPE_READPARARESP;
+ lora_sendbuffer[MSG_LENGTH] = data_length+9;
+ memcpy(&lora_sendbuffer[SOURCE_ID_IDX],&g_com_map[DEV_ID],2);
+ memcpy(&lora_sendbuffer[DEST_ID_IDX],&wg_report_id,2);
+ lora_sendbuffer[RP_CMD_IDX] = WGRSP_RWTAG_WRITE;
+ lora_sendbuffer[RP_INDEX_IDX] = index;
+ lora_sendbuffer[RP_LEN_IDX] = data_length;
+ memcpy(&lora_sendbuffer[7], &g_com_map[index/2], data_length);
+ checksum = Checksum_u16(lora_sendbuffer,9+data_length);
+ memcpy(&lora_sendbuffer[9+data_length],&checksum,2);
+ Radio.Send(lora_sendbuffer,data_length+11);
+ // Delay_Ms(100);
+}
+static uint16_t delaytime = 1050;
+static uint16_t source_id;
+uint8_t rec_index;
+uint16_t rec_value,rec_delaytime,rx_count;
+int16_t target_count;
void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr )
{
BufferSize = size;
@@ -218,9 +192,7 @@
RssiValue = rssi;
SnrValue = snr;
Radio.Standby();
-//printf("收到lora\r\n");
-// if(Lora_status==LORA_RX_433)
- no_data_chongqi_num=0;
+ no_rx_flag = 0;
if(RX_Buffer[MSG_TYPE_IDX]==LORA_MSGTYPE_RANGEPOLL)
{
UWB_Wkup();
@@ -231,77 +203,70 @@
{
if(!memcmp(&dev_id,&RX_Buffer[DEST_ID_IDX],2))
{
- if(RX_Buffer[6]==0)//不需要操作，正常应答
+ memcpy(&source_id,&RX_Buffer[SOURCE_ID_IDX],2);
+ if(wg_state==WG_Lost)
{
- Lora_rece_error=0;
- memcpy( &Lora_wangguanid, &RX_Buffer[2], 2 );
+ wg_state = WG_Connected;
+ wg_report_id = source_id;
}
- if(RX_Buffer[6]==2) //读操作，下一次lora发送的时候要发出去
- {
-// no_yingda_time=5;
- Lora_rece_error=0;
- if(no_yingdaflag==0)
+ if(!memcmp(&wg_report_id,&RX_Buffer[SOURCE_ID_IDX],2))
+ {
+ wg_lost_count = 0;
+ switch(RX_Buffer[PWTAG_RW_FLAG_IDX])
{
- 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]);
+ 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);
+ target_count = current_count + rec_delaytime*3.2768 - delaytime;
+ if(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];
+ if(rec_index==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{
+ memcpy(&rec_value,&RX_Buffer[PWTAG_WRITE_VALUE_IDX],2);
+ g_com_map[rec_index/2] = rec_value;
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();
- }
- }
- }
+ LoraRspWriteCommap(SUBMSG_WRITE_ANCPARA);
+ flag_writepara_needreset = 1;
+ no_rx_flag = 1;
+ }
+ break;
+ }
}
}
- SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0);
}
- Radio.Rx(0);
+ if(!no_rx_flag)
+ {
+ SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0);
+ Radio.Rx(0);
+ }
}
void OnTxTimeout( void )
{
- Radio.Standby();
+ Radio.Standby();
SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0);
}
uint8_t tm;
@@ -309,7 +274,13 @@
void OnRxTimeout( void )
{
Radio.Standby();
+ current_count = HAL_LPTIM_ReadCounter(&hlptim1);
+ target_count-=current_count%3276;
+ if(target_count<0)
+ target_count+=32768;
+ __HAL_LPTIM_COMPARE_SET(&hlptim1, target_count);
SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0);
+ Radio.Rx(0);
}
void OnRxError( void )
@@ -319,7 +290,7 @@
SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],UWB_CHANNEL_SF,0);
}
-
+uint16_t freq_test;
void SwitchLoraSettings(uint32_t freq,uint8_t sf,uint8_t power)
{
@@ -333,7 +304,7 @@
Radio.Standby();
// HAL_GPIO_WritePin(GPIOB, GPIO_PIN_12, GPIO_PIN_RESET);
Radio.SetChannel( freq*1000000 );
-
+ freq_test = freq;
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 );
@@ -345,7 +316,7 @@
}
-
+extern u8 active_flag;
void LoraInit(void)
{
RadioEvents.TxDone = OnTxDone;
@@ -356,7 +327,12 @@
Radio.Init( &RadioEvents );
SwitchLoraSettings(UWB_CHANNEL_FRQ+g_com_map[GROUP_ID],5,0); //切换lora接收频点
- Radio.Rx( 9999 );
+ if(active_flag)
+ {
+ Radio.Rx( 0 );
+ }else{
+ Radio.Sleep();
+ }
// Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time);
}
--
Gitblit v1.9.3