#define NEAR 10
#define IZQ 1
#define DCH 2
#define THRESHOLD 40 
#define MIC SENSOR_4

int parar;
int paro_total;

task avanzar(){
	while(true){
		OnFwd(OUT_BC,10);
		until(parar||paro_total);
		Off(OUT_BC);
		until((!parar)&&(!paro_total));		
	}
}

inline int medir(){
	int i,d;
	RotateMotor(OUT_A,75,90);
	d=SensorUS(IN_1);
	RotateMotor(OUT_A,-75,180);
	i=SensorUS(IN_1);
	RotateMotor(OUT_A,75,90);
	if(i<d) return DCH;
	return IZQ;
}

inline void girar(int dir){
	if(dir==DCH){
		RotateMotor(OUT_B,-75,180);
		RotateMotor(OUT_C,75,180);
	}
	if(dir==IZQ){
		RotateMotor(OUT_C,-75,180);
		RotateMotor(OUT_B,75,180);
	}
}


task check_sonido(){
	paro_total=0;
	SetSensorSound(IN_4);
	while(true){ 
		until(MIC > THRESHOLD);
		paro_total=1;
		Wait(500);
		until(MIC > THRESHOLD);
		paro_total=0;
	}
}



task main(){ 
	parar=0;
	SetSensorLowspeed(IN_1); 
	start avanzar;
	start check_sonido;
	while(true){ 
		if((SensorUS(IN_1)<NEAR)&&(!paro_total)){
			parar=1;
			girar(medir());
		}
		else{
			parar=0;
		}
   } 
}