From 430e7e3574d90061aa74def66f4c2231e0aa4679 Mon Sep 17 00:00:00 2001
From: yincheng.zhong <634916154@qq.com>
Date: 星期一, 25 三月 2024 18:12:55 +0800
Subject: [PATCH] 1.13 修改基站不报时间3秒到5秒

---
 Src/radio/Lora.c |   71 ++++++++++++++++++++++++-----------
 1 files changed, 48 insertions(+), 23 deletions(-)

diff --git a/Src/radio/Lora.c b/Src/radio/Lora.c
index daf7937..72f1e36 100644
--- a/Src/radio/Lora.c
+++ b/Src/radio/Lora.c
@@ -39,7 +39,8 @@
 #define RF_FREQUENCY_R                              500000000 // Hz
 #define RF_FREQUENCY_T                              470200000 // Hz
 #define TX_OUTPUT_POWER                             22        // 22 dBm
-
+uint16_t rec_wenjian_daxiao;
+uint16_t wangguan_up_id;
 extern bool IrqFired;
 extern uint8_t lora_yingda_flag;
 uint16_t lora_yingda_num;
@@ -238,15 +239,17 @@
     Radio.Send(lora_sendbuffer,data_length+11);
   //  Delay_Ms(100);
 }
-extern u8 lora_jianting_flag;
-static uint16_t delaytime = 1050;
+extern uint8_t imu_enable,motor_enable;
+extern u8 lora_jianting_flag,report_ancnum;
+static uint16_t delaytime = 771;
 static uint16_t source_id;
 uint8_t rec_index;
-uint16_t rec_value,rec_delaytime,rx_count;
+uint16_t rec_value,rec_delaytime,rx_count,datalen_offset;
 int32_t target_count;
 extern uint16_t motor_keeptime;
+uint8_t shengji_flag;
 void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr )
-{   
+{   uint16_t checksum1;
         BufferSize = size;
         memcpy( RX_Buffer, payload, BufferSize );
         RssiValue = rssi;
@@ -262,6 +265,9 @@
     }
     if(RX_Buffer[MSG_TYPE_IDX]==LORA_MSGTYPE_WGRESPTAG)
     {
+        checksum1=Checksum_u16(RX_Buffer,BufferSize-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); 
@@ -278,8 +284,15 @@
                     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;
+                        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;
+                    }
+                        
+                        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);
@@ -294,9 +307,6 @@
                         rec_index = RX_Buffer[PWTAG_WRITE_IDX_IDX];
                     switch(rec_index)
                     {
-                        case 0xaa:  //升级下发
-                            LoraUp_Poll();
-                            break;
                         case 0xdd:  //语音下发
                             break;
                         case 0x20:  //蜂鸣
@@ -312,7 +322,26 @@
                             no_rx_flag = 1;                           
                     }
 
-                        break;                                 
+                        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; 
                 }
             }
         }
@@ -405,8 +434,6 @@
                                    
 }
 
-uint16_t rec_wenjian_daxiao;
-uint16_t wangguan_up_id;
 uint8_t send_lora_data[250];
 //extern uint8_t lora_recbuffer[255];
 uint8_t muqiandeshengjibao;
@@ -420,13 +447,9 @@
 void LoraUp_Poll()
 {    uint16_t  result ;
     uint16_t crc16;
-    memcpy(&rec_wenjian_daxiao,&RX_Buffer[WRITEPARA_VALUE_IDX],2);//文件大小
-//    rec_wenjian_daxiao=rxbuffer[WRITEPATE_VALUE_IDX];
-    if(rec_wenjian_daxiao>0XAC00)
-    {}//文件过大,超出范围
-    else
-    { 
-    memcpy(&wangguan_up_id,&RX_Buffer[SOURCE_ID_IDX],2);//网关ID 占用2个字节
+    if(shengji_flag)
+    {
+//    memcpy(&wangguan_up_id,&RX_Buffer[SOURCE_ID_IDX],2);//网关ID 占用2个字节
     send_lora_data[MSG_TYPE_IDX]=LORA_MSGTYPE_UPDATE_CONFIRM;
     memcpy(&send_lora_data[SOURCE_ID_IDX],&dev_id,2);//网关ID 占用2个字节
     memcpy(&send_lora_data[DEST_ID_IDX],&wangguan_up_id,2);//标签或者基站的设备ID 2个字节
@@ -436,7 +459,7 @@
     huifushengjibao_flag=0;
     LoraUp_flag=1;
     Radio.Send(send_lora_data,8);//基站发送升级确认回复
-    Delay_Ms(1000);    
+    Delay_Ms(1000); 
     SwitchLoraSettings(LORA_UPCHANNEL_FRQ,LORA_UPCHANNEL_SF,22); //切换lora升级频点  
     delay_ms(200);   
     __disable_irq();
@@ -532,10 +555,12 @@
         huifushengjibaoerror_num++;
             if(huifushengjibaoerror_num>=5)
             {
-            huifushengjibaoerror_num=0;    
+            huifushengjibaoerror_num=0;  
+                    Delay_Ms(500);
+                    HAL_NVIC_SystemReset();                  
             break;
             }                
         }
     }
-   }
+  }
 }

--
Gitblit v1.9.3