V2.71

yincheng.zhong

2023-10-24 f64e5147dfd5f33e098b97a00ff19d0cd5e58e85

 Src/application/dw_app.c

@@ -72,6 +72,7 @@
#define STARTPOLL  REGPOLL//#define SWITCHBASE_DIST
#define SWITCHBASE_ZHUANDIAN
#define SWITCHBASE_DIST
void GetNearMsg(void);
enum enumtagstate
{
   REGPOLL,
@@ -368,7 +369,9 @@
            tmp_time-=999;
            sync_timer++;
            if(sync_timer>=1010)
               {sync_timer=0;}
                        {
                            sync_timer=0;
                        }
         }
      //   TIM3->CNT=tmp_time;
      }
@@ -555,7 +558,9 @@
                    tmp_time-=999;
                    sync_timer++;
                    if(sync_timer>=1010)
                        {sync_timer=0;}
                        {
                            sync_timer=0;
                        }
                }

                //offsettimeus=ancsync_time-current_count*LPTIMER_LSB+offset;
@@ -613,6 +618,7 @@
         trygetnearmsg_times = 0;
            tag_state = GETNEARMSG;
            mainbase_id = mindist_ancid;   
        GetNearMsg();
    }
   
   if(getsync_flag==0)
@@ -816,7 +822,9 @@
      next_nearbase_num = MAX_NEARBASE_NUM-1;
   }
   if(nearbase_num>10)
   {nearbase_num = 10;}
    {
        nearbase_num = 10;
    }
//   HAL_GPIO_WritePin(LED0_GPIO, GPIO_PIN_9, GPIO_PIN_SET);

   recbase_num=0;
@@ -877,7 +885,9 @@
   timeout=ceil((float)nearbase_num*SLOT_SCALE)+3;
   end_count=start_count+(timeout<<5);
   if(end_count>=32768)
   {end_count-=32768;}
    {
        end_count-=32768;
    }
   mainbase_dist=100000;
   mainbase_lost_count++;
   current_count=HAL_LPTIM_ReadCounter(&hlptim1);
@@ -975,13 +985,16 @@
                              tmp_time-=999;
                              sync_timer++;
                              if(sync_timer>=1000)
                                 {sync_timer=0;}
                        {
                            sync_timer=0;
                        }
                           }
                           ancsync_time=((sync_timer)*1000+tmp_time);   
                           SetLPTimer(ancsync_time);
                           if(result==0)
                                 {while (!(dwt_read32bitreg(SYS_STATUS_ID) & SYS_STATUS_TXFRS))//不断查询芯片状态直到发送完成
                                 { };}			
                        { };
                    }
//HAL_GPIO_WritePin(LED1_G_GPIO_Port, LED1_G_Pin, GPIO_PIN_RESET);                                 
                              break;
                        }else{
@@ -1009,6 +1022,7 @@
                                            mainbase_id = rec_nearbaseid;
                                            tag_state = GETNEARMSG;
                                 trygetnearmsg_times = 0;
                        GetNearMsg();
                                        }
                                    #endif

@@ -1018,7 +1032,9 @@
                  }else{
                  dwt_write32bitreg(SYS_STATUS_ID,SYS_STATUS_RXFCG| SYS_STATUS_ALL_RX_ERR);
                  if(recbase_num!=nearbase_num+1)
                     {dwt_rxenable(0);   }
            {
                dwt_rxenable(0);
            }
                     //                  if(flag_rxon)
//                     {
                  //      dwt_rxenable(0);   
@@ -1027,7 +1043,9 @@
               //   dwt_write32bitreg(SYS_STATUS_ID,SYS_STATUS_RXFCG| SYS_STATUS_ALL_RX_ERR);
         }
            if(flag_finalsend!=1)
            {flag_finalsend = 2;}
    {
        flag_finalsend = 2;
    }
         dwt_forcetrxoff();
         dwt_write32bitreg(SYS_STATUS_ID,SYS_STATUS_RXFCG| SYS_STATUS_ALL_RX_ERR);
//         HAL_GPIO_WritePin(LED1_G_GPIO_Port, LED1_G_Pin, GPIO_PIN_SET);
@@ -1037,17 +1055,18 @@
            if(salvebase_mindist<mainbase_dist- THRESHOLD_CHANGE_MAINBASE_DIST )
            {
               changemainbase_count++;
               if(changemainbase_count>tag_frequency*2)
            if(changemainbase_count>=3)
               {
                              mainbase_id = mindist_slavebaseid;
                              tag_state = GETNEARMSG;
                              trygetnearmsg_times = 0;
                GetNearMsg();
               }
            }else{
               changemainbase_count = 0;
            }
         #endif
         }else if(mainbase_lost_count>5*tag_frequency)
    } else if(mainbase_lost_count>3*tag_frequency)
         {
            tag_state = DISCPOLL;
         }   
@@ -1181,7 +1200,9 @@
                              tmp_time-=999;
                              sync_timer++;
                              if(sync_timer>=1010)
                                 {sync_timer=0;}
                {
                    sync_timer=0;
                }
                           }
                           ancsync_time=((sync_timer)*1000+tmp_time);                                                         
                           SetLPTimer(ancsync_time);