紅外循跡小車c程序(舵機小車)

#include

sbit servo=P2^5;

uint control=12;

uint jishu;

uint pianchu;

sbit zuo11=P3^4; //為0為左邊正轉

sbit zuo12=P3^5; //為1為左邊正轉

sbit you21=P3^6; //為1為右邊正轉

sbit you22=P3^7; //為0為右邊正轉

uint sp,speed=3;

uint ji=1,guang,bi; //判斷循跡尋光變量

uint stop1,stop2,stop3;

void delay(uint a)

{

uint b,c;

for(b=a;b>0;b--)

for(c=115;c>0;c--);

}

void qianjin() //可以當做延時函數來用

{

//P3=0x0f;

//delay(speed);

P3=0xf9;

}

void initial_T0()

{

TMOD=0x21;

TH1=0x8c;

TL1=0x8c;

EA=1;

ET1=1;

TR1=1;

}

void xunji()

{

if(P1==0x00)

{

qianjin();

}

//if(P1==0x20)

//{

加速

//qianjin();

//speed=2;

//qianjin();

//qianjin();

//}

if(P1==0x10)

{

//左轉

qianjin();

control+=1;

qianjin();

while(P1!=0x20)

{

if(P1==0x08)

{

//大角度左轉

qianjin();

qianjin();

control+=1;

while(P1!=0x10)

{

//if(P1==0x00) //偏出跑道，小車停止

//{

//speed=10000;

//}

pianchu++;

if(pianchu>=20000)

{

break;

}

}

pianchu=0;

control-=1;

qianjin();

qianjin();

}

pianchu++;

if(pianchu>=20000)

{

break;

}

}

pianchu=0;

control-=1;

qianjin();

qianjin();

}

if(P1==0x40)

{

//右轉

qianjin();

control-=1;

qianjin();

while(P1!=0x20)

{

if(P1==0x80)

{

//大角度右轉

qianjin();

control-=1;

qianjin();

while(P1!=0x40)

{

//if(P1==0x00) //偏出跑道，小車停止

//{

//speed=10000;

//}

pianchu++;

if(pianchu>=20000)

{

break;

}

}

pianchu=0;

qianjin();

control+=1;

qianjin();

}

pianchu++;

if(pianchu>=20000)

{

break;

}

}

pianchu=0;

qianjin();

control+=1;

qianjin();

}

}

void main()

{

initial_T0();

P1=0xf8;

while(1)

{

stop1=P1;

if(stop1==stop2)

{

stop3++;

}

else

{

stop3=0;

}

xunji();

if(P1==0x80||P1==0x08||stop3>10000)

{

P3=0x00;

while(1);

}

stop2=P1;

}

}

void T0_

總結

以上是生活随笔為你收集整理的51循迹小车舵机c语言程序,红外循迹小车c程序(舵机小车).doc的全部內容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網站內容還不錯，歡迎將生活随笔推薦給好友。