【正文】 int i。delay_nus(1700)。P1_0=0。i=65。P1_0=1。}}int main(void){int irDetectLeft,irDetectRight。R39。L39。amp。}else if(irDetectLeft==0)//只有左邊接收到紅外線{Backward()。}elseForward()。參考程序：includeincludeincludedefine LeftIR P1_2 //左邊紅外接收連接到P1_2define RightIR P3_5 //右邊紅外接收連接到P3_5define LeftLaunch P1_3 //左邊紅外發(fā)射連接到P1_3define RightLaunch P3_6 //右邊紅外發(fā)射連接到P3_6void IRLaunch(unsigned char IR){int counter。counter38。 _nop_()。_nop_()。 _nop_()。 _nop_()。 _nop_()。 _nop_()。R39。_nop_()。 _nop_()。 _nop_()。RightLaunch=0。 _nop_()。 _nop_()。 _nop_()。printf(Program Running!\n)。 //右邊發(fā)射irDetectRight = RightIR。 //左邊發(fā)射irDetectLeft = LeftIR。pulseRight=1700。pulseRight=1700。pulseRight=1300。delay_nus(pulseLeft)。P1_0=0。寶貝車在桌子上行走，IR檢測器向下監(jiān)測桌子表面。if(IR==39。counter++){LeftLaunch=1。 _nop_()。 _nop_()。 _nop_()。 _nop_()。_nop_()。 _nop_()。)//右邊發(fā)射for(counter=0。 _nop_()。 _nop_()。 _nop_()。_nop_()。 _nop_()。 _nop_()。}}int main(void){int i,pulseCount。printf(Program Running!\n)。 //右邊發(fā)射irDetectRight = RightIR。 //左邊發(fā)射irDetectLeft = LeftIR。pulseLeft=1700。(irDetectRight==0)) //右轉(zhuǎn){pulseCount=10。amp。}else //后退{pulseCount=15。ipulseCount。P1_0=1。}}while(1)。機器人紅外測距及跟隨策略的實現(xiàn)。TCON控制寄存器位符 號 描述TF1定時器1溢出標(biāo)志位。 模式0：定時/計數(shù)器按13位自加1計數(shù)器工作。這種模式使用起來非常方便，一旦設(shè)置好TMOD和THn，定時器就可以按設(shè)定好的周期溢出。模式2最大計數(shù)值為256us（28），滿足要求，因此用模式2來顯示LED燈閃爍功能。 //調(diào)用定時/計數(shù)器初始化函數(shù)while(1)。 //工作在定時器0的模式2中TH0=0x38。 //P1_0的值取反}機器人用紅外發(fā)射頻率掃描進行編程做距離探測。依賴于探測器不能再檢測到物體的紅外線頻率，就可以推斷物體的大概位置。參考程序：includeincludedefine LeftIR P1_2 //左邊紅外接受連接到P1_2define LeftLaunch P1_3 //左邊紅外發(fā)射連接到P1_3unsigned int time。void timer_init(void){IE=0x82。 //高八位設(shè)FFTL0 = time。 //停止定時器}void Timer0_Interrupt(void) interrupt 1 //定時器中斷{LeftLaunch = ~LeftLaunch。leftdistance = 0。//發(fā)射頻率irDetectLeft = LeftIR。timer_init()。printf(distanceLeft = %d\n,leftdistance)。讓一個寶貝車跟隨另一個寶貝車行走，跟隨的寶貝車，也叫尾隨車，必須知道距離引導(dǎo)車有多遠。把紙片置于寶貝車的前面，就像障礙物墻。移動紙片距離寶貝車特別近時，寶貝車應(yīng)該后退，遠離紙片。參考程序：include include define LeftIR P1_2 //左邊紅外接受連接到P1_2define RightIR P3_5 //右邊紅外接收連接到P3_5define LeftLaunch P1_3 //左邊紅外發(fā)射連接到P1_3define RightLaunch P3_6 //右邊紅外發(fā)射連接到P3_6define Kpl 70define Kpr 70define SetPoint 2define CenterPulse 1500unsigned int time。void timer_init(void){IE=0x82。TL0 = time 。}void Timer0_Interrupt(void) interrupt 1{LeftLaunch = ~LeftLaunch。}void Get_lr_Distances(){unsigned char count。count5。if (irDetectLeft == 1)leftdistance++。P1_1=0。delay_nms(18)。while(1){Get_lr_Distances()。}}四、實驗報告要求驗證機器人紅外測距及跟隨策略的實現(xiàn)。二、實驗設(shè)備及軟件寶貝車機器人、ISP下載線、串行接口、USB接口、計算機、電源、LCD顯示器。搭建機器人，觸覺及紅外電路分別參考前面實驗。四、實驗報告要求驗證基于多傳感器信息的機器人導(dǎo)航。程序運行效果并加以分析55 / 55。實驗報告實驗名稱 姓名 班級 學(xué)號 日期 同組實驗者姓名 按要求進行程序設(shè)計。根據(jù)傳感器的優(yōu)先級，方便地制作機器人行為控制策略。三、實驗內(nèi)容及步驟熟悉LCD顯示機器人的運動狀態(tài)。實驗七 多傳感器智能機器人一、實驗?zāi)康恼莆斩鄠鞲衅餍畔⑴cC語言結(jié)構(gòu)體的使用與編程。pulseRight=(SetPointrightdistance)*Kpr+CenterPulse。uart_Init()。delay_nus(pulseRight)。}}void Send_Pulse(unsigned int pulseLeft,unsigned int pulseRight){P1_1=1。irDetectRight = RightIR。 //初始化左邊的距離rightdistance = 0。TH0 = 0XFF。delay_nus(800)。 //定時器0工作在模式1：16位定時器模式}void FreqOut(unsigned int Freq){time = 256 (50000/Freq)。//左邊和右邊的距離int delayCount,distanceLeft,distanceRight,irDetectLeft,irDetectRight。尾隨車應(yīng)該跟隨一個固定的距離，只要它不被其它的諸如手或附近墻壁等引開。嘗試輕輕旋轉(zhuǎn)一下紙片，寶貝車應(yīng)該跟隨之旋轉(zhuǎn)。如果尾隨車距離引導(dǎo)車太近，它也要能察覺并減速。delay_nms(1000)。printf(FREQENCY ETECTED\n)。if(irDetectLeft == 1)leftdistance++。count5。 //重新設(shè)值TL0 = time。 //啟動定時器delay_nus(800)。 //定時器0工作在模式1：16位定時器模式}void FreqOut(unsigned int Freq){time = 256 (500000/Freq)。 //左邊的距離int distanceLeft, irDetectLeft。嘗試測量不同物體的距離，弄清物體的顏色、材質(zhì)是否會造成距離測量的差異。選擇5個不同頻率，然后從最高靈敏度到最低靈敏度進行測試。 //設(shè)置定時器初值TR0=1。 //開總中斷EA，允許定時器0中斷ET0TCON=0x00。 IE（中斷使能）寄存器簡表 參考電路：參考程序：include include void initial(void)。定時器1在模式3下不工作。 模式1：定時/計數(shù)器按16位自加1計數(shù)器工作。由軟件置或清除：置1為啟動；置0為停止TF0定時器0溢出標(biāo)志位TR0定時器0運行控制位IE1外部中斷1邊沿觸發(fā)標(biāo)志IT1外部中斷1類型標(biāo)志位IE0 外部中斷0邊沿觸發(fā)標(biāo)志IT0外部中斷0類型標(biāo)志位TMOD模式寄存器 定時器工作模式 工作模式 每個定時/計數(shù)器都有一個16位的寄存器Tn（n=0或1）來控制計數(shù)長度，由高8位THn和低8位TLn置初值。Keil uVision2 IDE集成開發(fā)環(huán)境、串口調(diào)試軟件。五、思考題注：實驗操作現(xiàn)場檢查。P1_0=0。delay_nus(pulseLeft)。pulseRight=1700。pulseLeft=1700。pulseRight=1300。}else if((irDetectLeft==1)amp。amp。L39。R39。int irDetectLeft,irDetectRight。 _nop_()。_nop_()。 _nop_()。 _nop_()。 _nop_()。 _nop_()。counter++){RightLaunch=1。}if(IR==39。 _nop_()。 _nop_()。_nop_()。 _nop_()。 _nop_()。 _nop_()。)//左邊發(fā)射for(counter=0。如果有一邊的IR探測器沒有發(fā)現(xiàn)桌面（即發(fā)現(xiàn)邊沿），寶貝車會向另一個方向轉(zhuǎn)動。}while(1)。P1_0=1。pulseRight=1300。amp。amp。amp。L39。R39。int irDetectLeft,irDetectRight。 _nop_()。 _nop_()。 _nop_()。 _nop_()。_nop_()。 _nop_()。counter38。 _nop_()。 _nop_()。 _nop_()。LeftLaunch=0。 _nop_()。 _nop_()。_nop_()。L39。在觸須導(dǎo)航里使用的預(yù)編程機動動作很好，但是在使用IR LED和探測器時會造成不必要的遲鈍。}else if(irDetectRight==0)//只有右邊接收到紅外線{Backward()。Left_Turn()。 //左邊發(fā)射irDetectLeft = LeftIR。 //右邊發(fā)射irDetectRight = RightIR。printf(Program Running!\n)。P1_0=0。delay_nus(1300)。}}void Backward(void) //向后行走子程序{int i。