#include<reg51.h>
#include"Config.h"
#include"IOCfg.c"
#include"TimeDLY.h"
#include"StepMot.h"

//障礙物檢測，并且避障前進(jìn)函數(shù)：Ultra_DTC()
void  Ultra_DTC(void)
{
	INT8U temp;
	UltraDTC_TR = 1;   //發(fā)射超聲波
	if(UltraDTC_RE) temp=0x01;
	else            temp=0x00;
	switch(temp)
	{
		//避障：原地打轉(zhuǎn)
		case 0x00:  LMotRun(LSPEED);RMotStop();     break;
		//無障礙：正常，前進(jìn)
		case 0x01:  LMotRun(HSPEED);RMotRun(HSPEED);break;
		default: break;
		}
	}