找回密碼
 立即注冊(cè)

QQ登錄

只需一步，快速開(kāi)始

搜索
查看: 4041|回復(fù): 1
打印 上一主題 下一主題
收起左側(cè)

巡線小車(chē) 三路傳感器單片機(jī)源碼

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:303605 發(fā)表于 2018-4-8 12:27 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
單片機(jī)源程序如下:
  1. int you=18;
  2. int zuo=14;
  3. int zhong=16;
  4. void setup()
  5. {
  6.   pinMode( you, INPUT);//youbian
  7.   pinMode( zhong, INPUT);//zhognjian
  8.   pinMode( zuo, INPUT);//zuobian  
  9.   pinMode( 10, OUTPUT);
  10.   pinMode( 6, OUTPUT);
  11.   pinMode( 5, OUTPUT);
  12.   pinMode( 9, OUTPUT);
  13. }

  15.          void loop()
  16.           {
  17.             tracing();
  18.           }

  20. void tracing()
  21. {
  22.     if (( !( digitalRead(zhong) ) && ( digitalRead(zuo) && digitalRead(you) ) ))
  23.     {go2();}
  24.     if (( digitalRead(zhong) && ( digitalRead(zuo) && digitalRead(you) ) ))
  25.     {go6();}
  26.     if (( !( digitalRead(zhong) ) && ( !( digitalRead(zuo) ) && !( digitalRead(you) ) ) ))
  27.     {go3();}
  28.     if (( digitalRead(zhong) && ( digitalRead(you) && !( digitalRead(zuo) ) ) ))
  29.     {left();}
  30.     if (( !( digitalRead(zhong) ) && ( !( digitalRead(zuo) ) && digitalRead(you) ) ))
  31.     {left2();}
  32.     if (( digitalRead(zhong) && ( digitalRead(zuo) && !( digitalRead(you) ) ) ))
  33.     {right();}   
  34.     if (( !( digitalRead(zhong) ) && ( digitalRead(zuo) && !( digitalRead(you) ) ) ))
  35.     {right2();}
  36. }

  38. void left()
  39. {
  40. int num2;
  41.    while(1){
  42.     num2=digitalRead(zhong);         //循環(huán)判斷youbian傳感器度數(shù)，
  43.     if(num2==1)
  44.     {  turnL();                    //如果num2==0說(shuō)
  45.      delay(2);}
  46.      else
  47.      break;                      //檢測(cè)到num2==0說(shuō)明轉(zhuǎn)過(guò)頭了，跳出循環(huán)，檢測(cè)三個(gè)傳感器的狀態(tài)再做出相應(yīng)動(dòng)作
  48.    }   
  49. }
  50. void turnL()
  51. {
  52.     analogWrite(5 , 150);
  53.     analogWrite(6 , 0);
  54.     analogWrite(9 , 0);
  55.     analogWrite(10 , 150);
  56. }
  57. void left2()
  58. {
  59.   int num2;
  60.    while(1){
  61.     num2=digitalRead(zuo);         //循環(huán)判斷youbian傳感器度數(shù)，
  62.     if(num2==0)
  63.     {  turnL2();                    //如果num2==0說(shuō)
  64.      delay(2);}
  65.      else
  66.      break;                      //檢測(cè)到num2==0說(shuō)明轉(zhuǎn)過(guò)頭了，跳出循環(huán)，檢測(cè)三個(gè)傳感器的狀態(tài)再做出相應(yīng)動(dòng)作
  67.    }
  68. }

  70. void turnL2()
  71. {
  72.     analogWrite(5 , 255);
  73.     analogWrite(6 , 0);
  74.     analogWrite(9 , 0);
  75.     analogWrite(10 , 255);
  76. }
  77. void right()
  78. {
  79.    int num2;
  80.    while(1){
  81.     num2=digitalRead(zhong);         //循環(huán)判斷youbian傳感器度數(shù)，
  82.     if(num2==1)
  83.     {  turnR2();                    //如果num2==0說(shuō)
  84.      delay(2);}
  85.      else
  86.      break;                      //檢測(cè)到num2==0說(shuō)明轉(zhuǎn)過(guò)頭了，跳出循環(huán)，檢測(cè)三個(gè)傳感器的狀態(tài)再做出相應(yīng)動(dòng)作
  87.    }   
  88. }
  89. void turnR2()
  90. {
  91.     analogWrite(5 , 0);
  92.     analogWrite(6 , 150);
  93.     analogWrite(9 , 150);
  94.     analogWrite(10 , 0);
  95. }

  97. void right2()
  98. {  int num2;
  99.    while(1){
  100.     num2=digitalRead(you);         //循環(huán)判斷youbian傳感器度數(shù)，
  101.     if(num2==0)
  102.     {  turnR();                    //如果num2==0說(shuō)
  103.      delay(2);}
  104.      else
  105.      break;                      //檢測(cè)到num2==0說(shuō)明轉(zhuǎn)過(guò)頭了，跳出循環(huán)，檢測(cè)三個(gè)傳感器的狀態(tài)再做出相應(yīng)動(dòng)作
  106.    }   
  107. }
  108. void turnR()
  109. {
  110.     analogWrite(5 , 255);
  111.     analogWrite(6 , 0);
  112.     analogWrite(9 , 255);
  113.     analogWrite(10 , 0);
  114. }

  116. void go2()
  117. {
  118.     analogWrite(5 , 255);
  119.     analogWrite(6 , 0);
  120.     analogWrite(9 , 255);
  121.     analogWrite(10 , 0);
  122. }

  124. void go3()
  125. {
  126.     analogWrite(5 , 255);
  127.     analogWrite(6 , 0);
  128.     analogWrite(9 , 255);
  129.     analogWrite(10 , 0);
  130. }

  132. void go6()
  133. {
  134.     analogWrite(5 , 240);
  135.     analogWrite(6 , 10);
  136.     analogWrite(9 , 250);
  137.     analogWrite(10 , 10);
  138. }


復(fù)制代碼

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂 踩踩
回復(fù)

使用道具 舉報(bào)

沙發(fā)
ID:366693 發(fā)表于 2018-7-10 17:55 | 只看該作者
謝謝分享
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表