Revert "Revert "配对完成，有bug""

zhyinch

2018-10-18 4a99709fbaf35e70ab7102c902e2c4caab74b96c

 源码/核心板/Src/application/serial_at_cmd_app.c

@@ -3,10 +3,10 @@
#include <string.h>
#include <stdio.h>
#include "dw_app.h"

#include "RTC.h"
uint8_t m_frame_data[MAX_FRAME_LEN] = {0};
uint8_t m_frame_data_len = 0;

uint8_t g_pairstart=0;
void ParseFrame(void)
{
   if(!memcmp(m_frame_data, "DIS1", 4))
@@ -87,6 +87,47 @@
      Dw1000_App_Init();
      printf("set dev id = %d. \r\n", g_com_map[DEV_ID]);
      save_com_map_to_flash();
   }else if(!memcmp(m_frame_data, "INT", 3))
   {
      g_com_map[COM_INTERVAL] = 0;
      for(uint8_t i=4; i < m_frame_data_len; i++)
      {
         if(m_frame_data[i]<58 && m_frame_data[i]>47)
         {
            g_com_map[COM_INTERVAL] = g_com_map[COM_INTERVAL]*10 + m_frame_data[i]- '0';
         }
         else
         {
            printf("Error: Wrong COM_INTERVAL.\r\n");
            break;
         }
      }
      printf("set dev interval = %d ms. \r\n", g_com_map[COM_INTERVAL]);
      RTC_Configuration(g_com_map[COM_INTERVAL]*20);
      save_com_map_to_flash();
   }else if(!memcmp(m_frame_data, "PAIRID", 6))
   {
      g_com_map[PAIR_ID] = 0;
      for(uint8_t i=7; i < m_frame_data_len; i++)
      {
         if(m_frame_data[i]<58 && m_frame_data[i]>47)
         {
            g_com_map[PAIR_ID] = g_com_map[PAIR_ID]*10 + m_frame_data[i]- '0';
         }
         else
         {
            printf("Error: Wrong PAIR_ID.\r\n");
            break;
         }
      }
      printf("set dev PAIR_ID = %d . \r\n", g_com_map[PAIR_ID]);
      save_com_map_to_flash();
   }else if(!memcmp(m_frame_data, "STARTPAIR", 9))
   {
      g_pairstart=1;
      printf("Start Pair Mode. \r\n");
   }else{
      printf("Error: Wrong Command.\r\n");
   }
}