#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 1  // 100ms

#define ONTIME3 1   // 500ms
#define OFFTIME3 5  // 500ms
int32_t min_dist;
void main_logic(void)	//Ö÷Âß¼­ÔÚÕâÀïÖ´ÐÐ
{
	static uint8_t beep_state,timer_state,beep_timer,beep_ontime,beep_offtime;
	int16_t i;
	//³ýUWBÖ®ÍâµÄÆäËû´úÂë...
	static uint16_t beep_judge_cnt = 0;
	if(beep_judge_cnt++ >= 100)
	{	
		beep_judge_cnt = 0;
		min_dist=0x7fffff;
		for(i = 0; i < 255;i++)
		{
			if(g_Tagdist[i] < min_dist)
			{
				min_dist=g_Tagdist[i];
			}
				
		}
		
		if(min_dist <= g_com_map[ALARM_DISTANCE1])
		{
			beep_ontime = ONTIME1;
			beep_offtime = OFFTIME1;
			beep_state=1;
			RELAY1_ON;
			RELAY2_ON;
		
		}
		else if (min_dist <= g_com_map[ALARM_DISTANCE2])
		{
			beep_ontime = ONTIME2;
			beep_offtime = OFFTIME2;
			beep_state=1;
			RELAY2_ON;
		}
		//else if (min_dist <= g_com_map[ALARM_DISTANCE3])
//		{
//			beep_ontime = ONTIME3;
//			beep_offtime = OFFTIME3;
//			beep_state=1;
//		}
		else{
			beep_state=0;
		}
		if (min_dist >= g_com_map[ALARM_DISTANCE1]+20)
		{
			RELAY1_OFF;
		}
		
		if (min_dist >= g_com_map[ALARM_DISTANCE2]+20)
		{
			RELAY2_OFF;
		}
		
//		
//		if(beep_state==1)
//		{
//			if(timer_state==1)
//			{
//				if(beep_timer++ < beep_ontime)
//				{
//					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{
//					timer_state=0;
//					beep_timer=0;
//				}
//			}else{
//			    if(beep_timer++ < beep_offtime)
//					{
//						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;
//							}
//					}else{
//							timer_state=1;
//							beep_timer=0;
//					}
//				
//			}
//		
//		}	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;
//			}
//		}
	}
}