亚洲春色中文字幕久久久-三上亚,91精品国产亚一区二区三区,久久久九色综合亚洲成色777,涩涩视频下载,国产午夜亚洲精品午夜鲁丝片,国产精品A一区二区三区腾讯导航,影音先锋色情AV在线看片,蜜臀国产在线视频,极品少妇高潮啪啪无码吴梦梦 ,精品人妻无码一区二区三区手机版

標題: 巡線小車 三路傳感器單片機源碼 [打印本頁]
作者: 動物園園長    時間: 2018-4-8 12:27
標題: 巡線小車 三路傳感器單片機源碼
單片機源程序如下:
  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);         //循環判斷youbian傳感器度數，
  43.     if(num2==1)
  44.     {  turnL();                    //如果num2==0說
  45.      delay(2);}
  46.      else
  47.      break;                      //檢測到num2==0說明轉過頭了，跳出循環，檢測三個傳感器的狀態再做出相應動作
  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);         //循環判斷youbian傳感器度數，
  62.     if(num2==0)
  63.     {  turnL2();                    //如果num2==0說
  64.      delay(2);}
  65.      else
  66.      break;                      //檢測到num2==0說明轉過頭了，跳出循環，檢測三個傳感器的狀態再做出相應動作
  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);         //循環判斷youbian傳感器度數，
  82.     if(num2==1)
  83.     {  turnR2();                    //如果num2==0說
  84.      delay(2);}
  85.      else
  86.      break;                      //檢測到num2==0說明轉過頭了，跳出循環，檢測三個傳感器的狀態再做出相應動作
  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);         //循環判斷youbian傳感器度數，
  101.     if(num2==0)
  102.     {  turnR();                    //如果num2==0說
  103.      delay(2);}
  104.      else
  105.      break;                      //檢測到num2==0說明轉過頭了，跳出循環，檢測三個傳感器的狀態再做出相應動作
  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. }


復制代碼

作者: 遇見獨角馬    時間: 2018-7-10 17:55
謝謝分享



歡迎光臨 (http://www.denmoz.com/bbs/) Powered by Discuz! X3.1