#include "beep_logic_app.h"
|
#include "led.h"
|
#include "beep.h"
|
#include "global_param.h"
|
#include "dw_app.h"
|
|
#define ONTIME1 1 // 100ms
|
#define OFFTIME1 0 // 100ms
|
|
#define ONTIME2 1 // 100ms
|
#define OFFTIME2 0 // 100ms
|
|
#define ONTIME3 5 // 500ms
|
#define OFFTIME3 5 // 500ms
|
u8 distoffset1=0,distoffset2=0;
|
uint16_t min_dist;
|
void main_logic(void) //Ö÷Âß¼ÔÚÕâÀïÖ´ÐÐ
|
{
|
// static uint8_t beep_state,timer_state,beep_timer,beep_ontime,beep_offtime;
|
// uint16_t i;
|
// //³ýUWBÖ®ÍâµÄÆäËû´úÂë...
|
// static uint16_t beep_judge_cnt = 0;
|
// if(beep_judge_cnt++ >= 100)
|
// {
|
// beep_judge_cnt = 0;
|
// min_dist=0xffff;
|
// for(i = 0; i < 255;i++)
|
// {
|
// if(g_Tagdist[i] < min_dist&&g_Tagdist[i]>g_com_map[ALARM_DISTANCE1])
|
// {
|
// min_dist=g_Tagdist[i];
|
// }
|
//
|
// }
|
//
|
// if (min_dist <= g_com_map[ALARM_DISTANCE2]+distoffset1)
|
// {
|
// beep_ontime = ONTIME2;
|
// beep_offtime = OFFTIME2;
|
// beep_state=2;
|
// distoffset1=0;
|
// distoffset2=0;
|
// }
|
// else if (min_dist <= g_com_map[ALARM_DISTANCE3]+distoffset2)
|
// {
|
// beep_ontime = ONTIME3;
|
// beep_offtime = OFFTIME3;
|
// beep_state=1;
|
// distoffset1=0;
|
// distoffset2=0;
|
// }
|
// else{
|
// beep_state=0;
|
// distoffset1=0;
|
// distoffset2=0;
|
// }
|
//
|
// if(beep_state!=0)
|
// {
|
// if(timer_state==1)
|
// {
|
// if(beep_timer++ < beep_ontime)
|
// {
|
// RELAY1_ON;
|
// RELAY2_ON;
|
// }else{
|
// timer_state=0;
|
// beep_timer=0;
|
// }
|
// }else{
|
// if(beep_timer++ < beep_offtime)
|
// {
|
// RELAY1_OFF;
|
// RELAY2_OFF;
|
// }else{
|
// timer_state=1;
|
// beep_timer=0;
|
// }
|
//
|
// }
|
//
|
// } else {
|
// RELAY1_OFF;
|
// RELAY2_OFF;
|
// }
|
// }
|
}
|
