From d8dd7c6e256bc607904ef1c1b1a36471c99db873 Mon Sep 17 00:00:00 2001
From: WXK <287788329@qq.com>
Date: 星期二, 21 十一月 2023 14:58:09 +0800
Subject: [PATCH] 免布线lora，调试差不多，即将加入自动跳频功能，固提交保存
---
Src/radio/Lora.c | 328 +++++++++++++++++++++++++++++-------------------------
1 files changed, 178 insertions(+), 150 deletions(-)
diff --git a/Src/radio/Lora.c b/Src/radio/Lora.c
index 79319fc..9aafe2b 100644
--- a/Src/radio/Lora.c
+++ b/Src/radio/Lora.c
@@ -13,9 +13,14 @@
static RadioEvents_t RadioEvents;
#define USE_MODEM_LORA
//#define USE_MODEM_FSK
-#define REGION_CN779
+#define REGION_CN779
uint32_t RxDutyCycle_RX_time =128;
uint32_t RxDutyCycle_SLEEP_time=256;
+#define LORA_FREQUENCY0 470200000
+#define LORA_FREQUENCY1 471200000
+#define LORA_FREQUENCY2 472200000
+#define LORA_FREQUENCY3 473200000
+#define LORA_FREQUENCY4 474200000
#if defined( REGION_AS923 )
#define RF_FREQUENCY 923000000 // Hz
@@ -60,8 +65,8 @@
#define TX_OUTPUT_POWER 22 // 22 dBm
extern bool IrqFired;
-
-
+extern uint8_t lora_yingda_flag;
+uint16_t lora_yingda_num;
//bool EnableMaster=true;//主选择
@@ -138,14 +143,24 @@
void OnTxTimeout( void );
void OnRxTimeout( void );
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( 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)
@@ -153,162 +168,201 @@
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 );
+
+
+ }
}
void OnTxDone( void )
-{
-Lora_rx_open_flag=1;
+{
+ 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
+ {}
+
}
+
+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;
-void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr )
+ 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;
+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 current_count;
+u16 Lora_recevcount;
+extern uint8_t no_data_chongqi_num;
+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;
-
+ no_data_chongqi_num=0;
Radio.Standby();
+ HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_SET);
+ if(lora_yingda_flag)
{
+ 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("RXD %d:\r\n",RX_Buffer[i]);}
+// for(i=0;i<BufferSize;i++)
+ {printf("R %d:\r\n",RX_Buffer[3]);}
RX_TIMEOUTs++;
- printf("RX_num :%d\r\n",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);
-// while(current_time<end_time||current_time>end_time+15000)
-// {
-// current_time=HAL_LPTIM_ReadCounter(&hlptim1);
- Anchor_App();
-// }
+ HAL_GPIO_WritePin(RADIO_NSS_GPIO_Port, RADIO_NSS_Pin, GPIO_PIN_SET); //片选lora无效
- HAL_GPIO_WritePin(RADIO_NSS_GPIO_Port, RADIO_NSS_Pin, GPIO_PIN_RESET);
- delay_ms(10);
-
- 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 );
-
- Radio.Send( usart_send, 12+rec_nearbase_num*4);
-// printf("RX_TIMEOUTs :%d\r\n",RX_TIMEOUTs);
-// Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time);
-// printf("RX_TIMEOUTs :XXXX\r\n");
-// Radio.Rx( RX_TIMEOUT_VALUE );
-// printf("Slave TXD XXXX\r\n");
+ 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);
+ 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);
+// }
+
}
}
void OnTxTimeout( void )
{
-
+ Radio.Standby();
+ Lora_Init();
+ Lora_rx_open_flag=0;
+
+ Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time);
}
void OnRxTimeout( void )
{
Radio.Standby();
- if(EnableMaster)
- {
-// TX_Buffer[0] = 'P';
-// TX_Buffer[1] = 'I';
-// TX_Buffer[2] = 'N';
-// TX_Buffer[3] = 'G';
-//
-//// crc_value=RadioComputeCRC(TX_Buffer,4,CRC_TYPE_IBM);//计算得出要发送数据包CRC值
-//// TX_Buffer[4]=crc_value>>8;
-//// TX_Buffer[5]=crc_value;
-// //Radio.Send( TX_Buffer, 6);
-// Radio.Send( TX_Buffer, 4);
-
-// HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_SET);
-// HAL_Delay_nMS( 1 );
-// HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_RESET);
- printf("Master TXD PING!\r\n");
- }
- else
- {
- Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time);
-// printf("slave OnRxTimeout\r\n");
-
-// Radio.Rx( RX_TIMEOUT_VALUE );
- printf("slave OnRxTimeout\r\n");
- }
+ Lora_Init();
+ Lora_rx_open_flag=0;
+
+ Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time);
+// printf("slave OnRxTimeout\r\n");
+
}
void OnRxError( void )
{
Radio.Standby();
- if(EnableMaster)
- {
- TX_Buffer[0] = 'P';
- TX_Buffer[1] = 'I';
- TX_Buffer[2] = 'N';
- TX_Buffer[3] = 'G';
-
-// crc_value=RadioComputeCRC(TX_Buffer,4,CRC_TYPE_IBM);//计算得出要发送数据包CRC值
-// TX_Buffer[4]=crc_value>>8;
-// TX_Buffer[5]=crc_value;
- //Radio.Send( TX_Buffer, 6);
- Radio.Send( TX_Buffer, 4);
-// HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_SET);
-// HAL_Delay_nMS( 1 );
-// HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_RESET);
- printf("Master TXD PING!\r\n");
- }
- else
- {
- Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time);
- printf("slave OnRxError\r\n");
-// Radio.Rx( RX_TIMEOUT_VALUE );
-
- }
-
+ Lora_Init();
+ Lora_rx_open_flag=0;
+ Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time);
}
-
-
-
-//void T_R_Init(uint8_t kind)
-//{
-// Radio.Init( &RadioEvents );
-// if(kind==1) //1:Txd config
-// {
-// Radio.SetChannel( RF_FREQUENCY );
-// 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 );
-
-// }
-// else //0:Rxd config
-// {
-// Radio.SetChannel( RF_FREQUENCY );
-// 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, false );
-// }
-//
-//// 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_R,
-//// LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON,
-//// 0, false, 0, 0, LORA_IQ_INVERSION_ON_R, false );
-//}
void Lora_Init(void)
{
@@ -317,16 +371,10 @@
RadioEvents.TxTimeout = OnTxTimeout;
RadioEvents.RxTimeout = OnRxTimeout;
RadioEvents.RxError = OnRxError;
-
+// printf("Lora_Init3\r\n");
Radio.Init( &RadioEvents );
- if(EnableMaster)
- {
- Radio.SetChannel( RF_FREQUENCY );
- }
- else
- {
Radio.SetChannel( RF_FREQUENCY );
- }
+
// Radio.SetStandby( STDBY_RC );
// Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH,
@@ -343,39 +391,19 @@
// 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.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 );
- if(EnableMaster)
- {
-
- printf("I am Master!\r\n");
-
- TX_Buffer[0] = 'P';
- TX_Buffer[1] = 'I';
- TX_Buffer[2] = 'N';
- TX_Buffer[3] = 'G';
-
- crc_value=RadioComputeCRC(TX_Buffer,4,CRC_TYPE_IBM);//计算得出要发送数据包CRC值
- TX_Buffer[4]=crc_value>>8;
- TX_Buffer[5]=crc_value;
- //Radio.Send( TX_Buffer, 6);
- Radio.Send( TX_Buffer, 4);
-
-// HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_SET);
-// HAL_Delay_nMS( 1 );
-// HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_RESET);
-
- printf("Master TXD PING!\r\n");
- }
- else
+
+
{
SX126xClearIrqStatus( IRQ_RADIO_ALL );
// SX126xSetDioIrqParams( IRQ_RX_DONE | IRQ_CRC_ERROR,
@@ -390,5 +418,5 @@
// Radio.Rx( RX_TIMEOUT_VALUE );
// printf("I am Slave!\r\n");
}
-
+
}
--
Gitblit v1.9.3