|
分享幾個調試通過的51單片機尋跡小車代碼

源程序:
- /*NewWay 循跡模塊專用程序*/
- /*簡單循跡程序,此程序能讓小車尋到T字路后停下*/
- /*你可以任意使用、修改該程序,如果你要把該程序用于商業,請與我聯系,不然一切后果自己承擔*/
- /*作者:劉偉*/
- /*當你看到這個程序的時候,請注意,這個程序是不能直接使用的,你要自己實現小車的向前,向后,向左,向右,及其延時的子程序*/
- #include <REGX52.H>
- void CarGo();
- void CarBack();
- void CarTurnLeft();
- void CarTurnRight();
- void Delayms(unsigned char n);
- void CarStop();
- /*定義循跡傳感器管腳*/
- sbit CLP=P1^0;
- sbit SS1=P1^1;
- sbit SS2=P1^2;
- sbit SS3=P1^3;
- sbit SS4=P1^4;
- sbit SS5=P1^5;
- sbit Near=P1^6;
- void CarGoLine() //小車沿黑線走
- {
- if(SS2==0)
- {
- CarTurnLeft();
- }
- else
- {
- if(SS4==0)
- {
- CarTurnRight();
- }
- else
- {
- CarGo();
- }
- }
- }
- void main()
- {
- unsigned char flag;
- flag=0;
- while(flag==0)
- {
- CarGoLine();
- if((SS1==0)&&(SS5==0))
- {
- CarGo();
- Delayms(200);// 判斷不是 “十” 字形接口 具體延時時間看小車的速度和性能
- if(SS3==1) flag=1;
- }
- }
- CarStop();
- }
復制代碼
完整源碼和資料下載:
http://www.zg4o1577.cn/bbs/dpj-80504-1.html
|
|