更改距离设置格式

zhyinch

2018-10-01 96ca4b1952c1c4bf85704208f53c97b45a875b04

 Ô´Âë/ºËÐÄ°å/Src/main.c

@@ -6,15 +6,12 @@
#include "beep.h"
#include "dw_driver.h"
#include "dw_app.h"
#include "filters.h"
#include "stm32f10x_it.h"
#include "serial_at_cmd_app.h"
#include "global_param.h"

//#define WORK_MODE_TAG
#define WORK_MODE_ANCHOR
#define START_ALARM_DIST_CM         200
#define BEEM_ON_TIME_MS            200

float dis_after_filter = 0;
#define WORK_MODE_TAG
//#define WORK_MODE_ANCHOR

void Device_Init(void)
{
@@ -22,16 +19,29 @@
   SystemInit();
   Nvic_Init();
   Systick_Init();
#ifdef WORK_MODE_TAG	
   RTC_Configuration();
#endif
   Led_Init();
   Beep_Init();
   DW_GPIO_Init();
   Usart_Init();
   Uart1_Init();
   Spi_Init();
	
   
   GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE);
}
		
      uint8_t aa;

void Program_Init(void)
{uint16_t i;
   Usart1ParseDataCallback = UsartParseDataHandler;
   parameter_init();
   for(i=0;i<255;i++)
   {
      g_Tagdist[i]=0xffff;
   }
}

/*! ------------------------------------------------------------------------------------------------------------------
 * @fn main()
 *
@@ -41,52 +51,34 @@
 *
 * @return none
 */

int main(void)
{
   LPFilter_Frac* p_Dis_Filter;
	
   Device_Init();
   Dw1000_Init();
   p_Dis_Filter = New_LP_Frac(0.9);

   Device_Init();
   Program_Init();
   Dw1000_Init();

#ifdef WORK_MODE_TAG
   tag_sleep_configuraion();
#endif
   Dw1000_App_Init();
    /* Loop forever initiating ranging exchanges. */
   while(1)
   {
#ifdef WORK_MODE_TAG
   if(g_start_send_flag)
   {
      g_start_send_flag = 0;
      Tag_App();
   }
//   UART_CheckReceive();
   RCC_APB1PeriphClockCmd(RCC_APB1Periph_PWR, ENABLE);
   PWR_EnterSTOPMode(PWR_Regulator_LowPower, PWR_STOPEntry_WFI);	
#else 
      Anchor_App();

#endif
      if(USART_GetFlagStatus(EXT_USART, USART_FLAG_RXNE) != RESET)
      {
         aa = USART_ReceiveData(EXT_USART);
         USART_SendData(EXT_USART, 0x66);//向串口1发送数据

         while(USART_GetFlagStatus(EXT_USART, USART_FLAG_TC)!=SET);//等待发送结束
			
         aa = 0;
      }
		
      //除UWB之外的其他代码...
      dis_after_filter = LP_Frac_Update(p_Dis_Filter, dist_cm);
		
      if(dis_after_filter <= START_ALARM_DIST_CM)
      {
//         g_beep_off_time = (uint32_t)dis_after_filter * 10;
//         if(g_beep_off_time <= 0) 
//            g_beep_off_time = 0;
//         g_beep_on_time = BEEM_ON_TIME_MS;
         OUT2_ON;		
			
      }
      else
      {
//         g_beep_on_time = 0;
//         g_beep_off_time = 0;
         OUT2_OFF;
      }
		
   }
}