增加配置确认回复

zhyinch

2020-10-05 ac5a474250f6560c7aa509b5e6c496c27a9db6d7

 源码/核心板/Src/main.c

@@ -48,6 +48,29 @@
u16 slottime,max_slotpos;
extern u8 module_power;
extern u16 total_slotnum;
void ComMapCheck(void)
{
   if(g_com_map[COM_INTERVAL]<10)
   {
     g_com_map[COM_INTERVAL]=500;
   }
         if(g_com_map[COM_INTERVAL]>1000)
   {
     g_com_map[COM_INTERVAL]=1000;
   }
    if(module_power>67)
      {module_power=67;}
      if(module_power<0)
      {module_power=0;}
      if(g_com_map[MAX_REPORT_ANC_NUM]>10)
      {g_com_map[MAX_REPORT_ANC_NUM]=10;}
      if(g_com_map[MAX_REPORT_ANC_NUM]<1)
      {g_com_map[MAX_REPORT_ANC_NUM]=1;}
      if(g_com_map[IMU_THRES]>10)
      {g_com_map[IMU_THRES]=10;}
      if(g_com_map[IMU_THRES]<1)
      {g_com_map[IMU_THRES]=1;}
}
void Program_Init(void)
{   float temp;
   u16 temp2;
@@ -67,18 +90,16 @@
      save_com_map_to_flash();
#endif
   OUT485_ENABLE;
   g_com_map[VERSION] = 0x0116;	
   ComMapCheck();
   g_com_map[VERSION] = 0x0200;	
   dev_id = g_com_map[DEV_ID];
   slottime=ceil((double)g_com_map[MAX_REPORT_ANC_NUM]*0.4)+3;
   slottime=ceil((double)g_com_map[MAX_REPORT_ANC_NUM]*SLOT_SCALE)+3;
   max_slotpos=g_com_map[COM_INTERVAL]/slottime;
   tyncpoll_time=(g_com_map[DEV_ID]%max_slotpos)*slottime;   
   module_power = g_com_map[POWER];
   total_slotnum = 1000/g_com_map[COM_INTERVAL];
      if(module_power>67)
      {
         module_power=67;
      }
	

 
   if(g_com_map[DEV_ROLE])
   {
   printf("鏍囩ID: %d .\r\n",dev_id);
@@ -152,7 +173,7 @@
   if(g_com_map[DEV_ROLE]==0&&usart_send_flag)
   {u16 checksum;
            usart_send_flag=0;
            usart_send_anc[2] = 4;//姝ｅ父妯″紡
            usart_send_anc[2] = 5;//姝ｅ父妯″紡
            usart_send_anc[3] = anc_report_num*6+2;//姝ｅ父妯″紡
            checksum = Checksum_u16(&usart_send_anc[2],anc_report_num*6+2);
            memcpy(&usart_send_anc[4+anc_report_num*6],&checksum,2);
@@ -212,7 +233,7 @@
   usart_send[1]=0xAA;
   usart_send_anc[0]=0x55;
   usart_send_anc[1]=0xAA;

  //SendComMap(50, 0);
   while(1)
   {
   g_start_sync_flag=0;