#include "beep_logic_app.h"
#include "led.h"
#include "beep.h"
#include "global_param.h"
#include "dw_app.h"

void main_logic(void)	//Ö÷Âß¼­ÔÚÕâÀïÖ´ÐÐ
{uint16_t i, min_dist;
	//³ýUWBÖ®ÍâµÄÆäËû´úÂë...
	static uint16_t beep_judge_cnt = 0;
	if(beep_judge_cnt++ >= 200)
	{	
		beep_judge_cnt = 0;
		min_dist=0xffff;
		for(i = 0; i < 255;i++)
		{
			if(g_Tagdist[i] < min_dist)
			{
				min_dist=g_Tagdist[i];
			}
				
		}
		if(min_dist <= g_com_map[ALARM_DISTANCE])
		{
			switch(g_com_map[ALARM_DEV]) 
			{
				case 0:
					BEEP2_ON;
					BEEP_OFF;
					OUT2_OFF;
					break;
				case 1:
					BEEP_ON;
					BEEP2_OFF;
					OUT2_OFF;
					break;
				case 2:
					OUT2_ON;
					BEEP_OFF;
					BEEP2_OFF;
					break;
				default:
					BEEP2_ON;
					BEEP_ON;
					OUT2_ON;
					break;
			}
		}
		else
		{
			switch(g_com_map[ALARM_DEV]) 
			{
				case 0:
					BEEP2_OFF;
					break;
				case 1:
					BEEP_OFF;
					break;
				case 2:
					OUT2_OFF;
					break;
				default:
					BEEP2_OFF;
					BEEP_OFF;
					OUT2_OFF;
					break;
			}
		}
	}
}