移動機器人設計與制作設計(一)——智能循跡小車(編輯修改稿)
2024-11-12 09:19 本頁面
【文章內容簡介】 /舵機控制函數 { left=b。 right=d。 c=a。 TH0=(a/256)。 TL0=(a%256)。 ET0=1。 //定時器 T0 中斷允許 TR0=1。 //定時器 T0 啟 PT0=0。 //定時器 T0 低優(yōu)級 智能循跡小車 7 } void go_forward(void) //前進函數 { servo(1,1)。 Delay()。 ET0=0。 TR0=0。 } void go_left(void) //左轉函數 { servo(0,1)。 Delay()。 ET0=0。 TR0=0。 } void go_right(void) //右轉函數 { servo(1,0)。 Delay()。 ET0=0。 TR0=0。 } void stop(void) //停止函數 { servo(0,0)。 Delay()。 ET0=0。 TR0=0。 } void turn_head(uint l,uint r) //轉向函數，參數為（ 1， 0），左轉；為（ 0， 1），右轉 { uint aa=360。 while(aa) { 智能循跡小車 8 servo(r,l)。 Delay()。 ET0=0。 TR0=0。 display(ge,shi,bai)。 if (middle_s==0) { break。 } } } void main(void) //主函數 { uint i=0。 p1_1=0。 //工作狀態(tài)顯示 IN1=1。 IN2=1。 IN3=1。 EA=1。 ET1=1。 TR1=1。 PT1=1。 TMOD=0x11。 //定時器工作方式為 1 //IE = 0x81。 //允許總中斷中斷 ,使能 INT0 外部中斷 //TCON = 0x01。 //觸發(fā)方式為脈沖負邊沿觸發(fā) while(1) { display(ge,shi,bai)。 //調用顯示函數，各判斷中也或有調用以保持顯示的連續(xù)性 if (eye==0) //檢測到障礙物，轉向 turn_head(1,0)。 else if (left_s==0amp。amp。middle_s==0amp。amp。right_s==0) //遇到障礙物回來后檢測到節(jié)點，轉向 { i=6。 while (i) { go_forward()。 智能循跡小車 9 } turn_head(0,1)。 } /* else if (LEFT_S1==1amp。amp。RIGHT_S1==0) //前進途中遇到轉向節(jié)點，轉向 { turn_head(0,1)。 } */ else if ((middle_s==0)||(IN1==1amp。amp。IN2==0amp。amp。IN3==1)) //前進 go_forward()。 else if ((left_s==0amp。amp。right_s==1)||(IN1==0amp。amp。IN2==1amp。amp。IN3==1)) //左轉 go_left()。 else if ((left_s==1amp。amp。right_s==0)||(IN1==1amp。amp。IN2==1amp。amp。IN3==0)) //右轉 go_right()。 else if((left_s==1amp。amp。
醫(yī)療健康相關推薦
鄂ICP備17016276號-1