久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 4037|回復: 2
打印 上一主題 下一主題
收起左側

基于arduino2560的循線小車制作 附程序

[復制鏈接]
跳轉到指定樓層
樓主
基于arduino2560的循線小車的整體圖


部分代碼如下
  1. /*

  3. * 電機：
  4. *      10 -> 左側：前進( > 90 ) ; 后退( < 90 ) ; 停止( 82 - 92)
  5. *      12 -> 右側：前進( < 90 ) ; 后退( > 90 ) ; 停止( 93 - 103);
  6. * F表示前B為后，D是在雙線上，S表示單線上
  7. *
  8. */
  9. /****************************整體實驗例程****************************/
  10. #include <Arduino.h>
  11. #include <Wire.h>
  12. #include <MultiLCD.h>
  13. #include <ServoTimer2.h>

  15. //定義車行進方向
  16. enum Dir{
  17.   FORWARD = 1, BACK, LEFT, RIGHT, STOP
  18. };


  21. enum Trackingmode{
  22.   FD= 1, BD, FS, BS       //舉例FD就表示在雙線上前進循跡，主要前傳感器
  23. };//

  25. enum Turnmode{
  26.   RFD= 1, LFD, RBD, LBD, RFS, LFS, RBS, LBS  
  27. //舉例RFD表示 R向右轉彎，F轉完后要前進，D表示在雙線上
  28. };


  31. //Motor
  32. int left_motor_port = 4; //定義左側電機引腳
  33. int right_motor_port = 7; //定義右側電機引腳
  34. int motor_speed = 135; //定義電機停止速度


  37. void setup() {
  38.   Serial.begin(9600);
  39.   SensorInit();
  40.   MotorInit();

  42. }


  45. /******************************設備初始化部分********************************/
  46. //傳感器引腳初始化
  47. void SensorInit(){
  48.   //pinMode(f[3], INPUT);
  49.   //pinMode(rf_s, INPUT);
  50.   for(int i=0;i<8;i++){pinMode(f[i], INPUT);}    //前傳感器數組
  51.   //pinMode(b[3], INPUT);
  52.   //pinMode(b[6], INPUT);
  53.   for(int i=0;i<8;i++){pinMode(b[i], INPUT);}    //后傳感器數組
  54.   //pinMode(l_s, INPUT);
  55.   //pinMode(r_s, INPUT);
  56.   for(int i=0;i<8;i++){pinMode(l[i], INPUT);}    //中間傳感器數組
  57.   pinMode(debug_sensor, INPUT);
  58.   //digitalWrite(A1,LOW);
  59.   //digitalWrite(A5,LOW);
  60.   
  61. }

  63. /******************************車行進控制部分********************************/
  64. int left_speed = 20;
  65. int right_speed = 20;

  67. void SpeedSet(int l, int r){
  68.   left_speed = l; right_speed = r;
  69. }

  71. void Forward(){
  72.   l_Servo.write(Angle2Pwm(motor_speed + left_speed));
  73.   r_Servo.write(Angle2Pwm(motor_speed - right_speed));
  74. }

  76. void Back(){
  77.   l_Servo.write(Angle2Pwm(motor_speed - left_speed));
  78.   r_Servo.write(Angle2Pwm(motor_speed + right_speed));
  79. }

  81. void Left(){
  82.   l_Servo.write(Angle2Pwm(motor_speed - 1.5*left_speed));
  83.   r_Servo.write(Angle2Pwm(motor_speed - 1.5*right_speed));
  84. }

  86. void Right(){
  87.   l_Servo.write(Angle2Pwm(motor_speed + 1.5*left_speed));
  88.   r_Servo.write(Angle2Pwm(motor_speed + 1.5*right_speed));
  89. }

  91. void Stop(){
  92.   l_Servo.write(Angle2Pwm(motor_speed));
  93.   r_Servo.write(Angle2Pwm(motor_speed));
  94.   delay(1000);
  95. }

  97. void Move(int dir){
  98.   switch(dir){
  99.     case FORWARD: Forward(); break;
  100.     case BACK: Back(); break;
  101.     case LEFT: Left(); break;
  102.     case RIGHT: Right(); break;   
  103.     case STOP: Stop(); break;
  104.     default: break;  
  105.   }
  106. }
  107.   //電機速度寫入函數，調速的時候使用
  108. void CorrectLeftF(){
  109.   l_Servo.write(Angle2Pwm(motor_speed));
  110.   r_Servo.write(Angle2Pwm(motor_speed - 20));
  111. }

  113. void CorrectRightF(){
  114.   l_Servo.write(Angle2Pwm(motor_speed + 20));
  115.   r_Servo.write(Angle2Pwm(motor_speed));
  116. }

  118. void CorrectRightB(){
  119.   l_Servo.write(Angle2Pwm(motor_speed - 20));
  120.   r_Servo.write(Angle2Pwm(motor_speed));
  121. }

  123. void CorrectLeftB(){
  124.   l_Servo.write(Angle2Pwm(motor_speed ));
  125.   r_Servo.write(Angle2Pwm(motor_speed + 20));
  126. }  






  133. /*
  134. void Turn(int mode){   //轉向函數
  135.   switch(mode){
  136.    
  137.     case 1:              //RF_D
  138.   Move(RIGHT);
  139.   while(!digitalRead(f[7]));
  140.   //delay(500);
  141.   while(!digitalRead(f[5]));
  142.   SpeedSet(15,15);
  143.   Move(RIGHT);
  144.   //delay(dy);
  145.   while(!digitalRead(f[2]));
  146.   Move(STOP);
  147.   SpeedSet(20,20);
  148.   break;
  149.   
  150.     case 2:             //LF_D
  151.   Move(LEFT);
  152.   while(!digitalRead(f[0]));
  153.   //delay(500);
  154.   while(!digitalRead(f[2]));
  155.   SpeedSet(15,15);
  156.   Move(LEFT);
  157.   //delay(dy);
  158.   while(!digitalRead(f[5]));
  159.   Move(STOP);
  160.   SpeedSet(20,20);
  161.   break;
  162.   
  163.     case 3:               //RB_D
  164.   Move(RIGHT);
  165.   while(!digitalRead(b[7]));
  166.   //delay(500);
  167.   while(!digitalRead(b[5]));
  168.   SpeedSet(15,15);
  169.   Move(RIGHT);
  170.   //delay(dy);
  171.   while(!digitalRead(b[2]));
  172.   Move(STOP);
  173.   SpeedSet(20,20);
  174.   break;
  175.   
  176.     case 4:               //LB_D
  177.   Move(LEFT);
  178.   while(!digitalRead(b[0]));
  179.   //delay(500);
  180.   while(!digitalRead(b[2]));
  181.   SpeedSet(15,15);
  182.   Move(LEFT);
  183.   //delay(dy);
  184.   while(!digitalRead(b[5]));
  185.   Move(STOP);
  186.   SpeedSet(20,20);
  187.   break;
  188.   
  189.       case 5:                 //RF_S
  190.   Move(RIGHT);
  191.   while(!digitalRead(f[7]));
  192.   //delay(500);
  193.   while(!digitalRead(f[6]));
  194.   SpeedSet(15,15);
  195.   Move(RIGHT);
  196.   //delay(dy);
  197.   while(!digitalRead(f[3]));
  198.   Move(STOP);
  199.   SpeedSet(20,20);
  200.   break;
  201.   
  202.     case 6:             //LF_S
  203.   Move(LEFT);
  204.   while(!digitalRead(f[0]));
  205.   //delay(500);
  206.   while(!digitalRead(f[1]));
  207.   SpeedSet(15,15);
  208.   Move(LEFT);
  209.   //delay(dy);
  210.   while(!digitalRead(f[4]));
  211.   Move(STOP);
  212.   SpeedSet(20,20);
  213.   break;
  214.   
  215.     case 7:            //RB_S
  216.   Move(RIGHT);
  217.   while(!digitalRead(b[7]));
  218.   //delay(500);
  219.   while(!digitalRead(b[6]));
  220.   SpeedSet(15,15);
  221.   Move(RIGHT);
  222.   //delay(dy);
  223.   while(!digitalRead(b[3]));
  224.   Move(STOP);
  225.   SpeedSet(20,20);
  226.   break;
  227.   
  228.     case 8:            //LB_S
  229.   Move(LEFT);
  230.   while(!digitalRead(b[0]));
  231.   //delay(500);
  232.   while(!digitalRead(b[1]));
  233.   SpeedSet(15,15);
  234.   Move(LEFT);
  235.   //delay(dy);
  236.   while(!digitalRead(b[4]));
  237.   Move(STOP);
  238.   SpeedSet(20,20);
  239.   break;
  240. }
  241. }



  245. /******************************路徑部分********************************/
  246. /*
  247. * 循跡函數
  248. * 返回值：無
  249. * 參數：mode：
  250. *       FD：前進雙線循跡
  251. *       BD：后退雙線循跡
  252. *       FS：前進單線循跡
  253. *       BS：后退單線循跡
  254. * 功能：通過車底傳感器檢測路線進行循跡
  255. */
  256. void Tracking(int mode){
  257. if(mode==1){//FD
  258.     if(digitalRead(f[2]) && digitalRead(f[5])){
  259.       Move(FORWARD);
  260.       delay(20);
  261.     }
  262.     else if(digitalRead(f[2])){
  263.        CorrectLeftF();
  264.       }
  265.     else if(digitalRead(f[5])){
  266.        CorrectRightF();
  267.       }
  268.     else
  269.       Move(FORWARD);
  270.       delay(20);
  271.       
  272. }   
  273.       
  274. if(mode==2){    //BD
  275.     if(digitalRead(b[2]) && digitalRead(b[5])){
  276.       Move(BACK);
  277.       delay(20);
  278.     }
  279.     else if(digitalRead(b[2])){
  280.      CorrectRightB();  
  281.     }
  282.     else if(digitalRead(b[5])){
  283.      CorrectLeftB();  
  284.     }
  285.     else
  286.       Move(BACK);
  287.       delay(20);
  288.       
  289. }   
  290.       
  291. if(mode==3){   //FS
  292.     if(digitalRead(f[3]) && digitalRead(f[4])){
  293.       Move(FORWARD);
  294.       delay(20);
  295.     }
  296.     else if(digitalRead(f[3])){
  297.        CorrectLeftF();
  298.       }
  299.     else if(digitalRead(f[4])){
  300.        CorrectRightF();
  301.       }
  302.     else
  303.       Move(FORWARD);
  304.       delay(20);
  305.    
  306.     }
  307.       
  308. if(mode==4){  //BS
  309.     if(digitalRead(b[3]) && digitalRead(b[4])){
  310.       Move(BACK);
  311.       delay(20);
  312.     }
  313.     else if(digitalRead(b[3])){
  314.      CorrectRightB();  
  315.     }
  316.     else if(digitalRead(b[4])){
  317.      CorrectLeftB();  
  318.     }
  319.     else
  320.       Move(BACK);
  321.       delay(20);
  322.   }
  323. }


  326. /*
  327. * 循線計數函數
  328. * 返回值：無
  329. * 參數：mode：
  330. *       FD：前進雙線循跡
  331. *       BD：后退雙線循跡
  332. *       FS：前進單線循跡
  333. *       BS：后退單線循跡
  334. * 參數：line：表示準備走幾條線
  335. * 功能：確定走的線數
  336. */

  338. void Trackingline(int mode, int line){
  339.   switch(mode){
  340.   case 1:
  341.     for(int i=0;i<20;i++){Tracking(FD);}
  342.     while(1){
  343.     if(meridians < line){
  344.       if(meridians < line-1){
  345.         if(digitalRead(l[3])){
  346.           meridians++;
  347.           while(digitalRead(l[3]));
  348.           delay(200);
  349.           }
  350.         else{
  351.           Tracking(FD);  
  352.       }
  353.       }
  354.       else{
  355.         if(digitalRead(l[3])){meridians++;}
  356.         else{Tracking(FD);}
  357.       }
  358.     }
  359.     else{
  360.       //Move(BACK);
  361.       //delay(200);
  362.       //Move(STOP);
  363.       meridians = 0;
  364.       //Move(BACK);
  365.       //while(!digitalRead(l[3]));
  366.       Move(STOP);
  367.       break;
  368.     }
  369.    
  370.     }
  371.   break;


  374.   case 2:
  375.   for(int i=0;i<20;i++){Tracking(BD);}
  376.     while(1){
  377.     if(meridians < line){
  378.       if(meridians < line-1){
  379.         if(digitalRead(l[4])){
  380.           meridians++;
  381.           while(digitalRead(l[4]));
  382.           delay(200);
  383.           }
  384.         else{
  385.           Tracking(BD);  
  386.       }
  387.       }
  388.       else{
  389.         if(digitalRead(l[4])){meridians++;}
  390.         else{Tracking(BD);}
  391.       }
  392.     }
  393.     else{
  394.       //Move(FORWARD);
  395.       //delay(200) ;
  396.       //Move(STOP);
  397.       meridians = 0;
  398.       //Move(FORWARD);
  399.       //while(!digitalRead(l[4]));
  400.       Move(STOP);
  401.       break;
  402.     }
  403.     }
  404.     break;
  405.    
  406.    
  407.     case 3:
  408.   for(int i=0;i<20;i++){Tracking(FS);}
  409.     while(1){
  410.     if(meridians < line){
  411.       if(meridians < line-1){
  412.         if(digitalRead(l[3])){
  413.           meridians++;
  414.           while(digitalRead(l[3]));
  415.           delay(600);
  416.           }
  417.         else{
  418.           Tracking(FS);  
  419.       }
  420.       }
  421.       else{
  422.         if(digitalRead(l[3])){meridians++;}
  423.         else{Tracking(FS);}
  424.       }
  425.     }
  426.     else{
  427.       //Move(BACK);
  428.       //delay(200);
  429.       //Move(STOP);
  430.       meridians = 0;
  431.       //Move(BACK);
  432.       //while(!digitalRead(l[3]));
  433.       Move(STOP);
  434.       break;
  435.     }
  436.     }
  437.   break;

  439.   case 4:
  440.   for(int i=0;i<20;i++){Tracking(BS);}
  441.     while(1){
  442.     if(meridians < line){
  443.       if(meridians < line-1){
  444.         if(digitalRead(l[4])){
  445.           meridians++;
  446.           while(digitalRead(l[4]));
  447.           delay(600);
  448.           }
  449.         else{
  450.           Tracking(BS);  
  451.       }
  452.       }
  453.       else{
  454.         if(digitalRead(l[4])){meridians++;}
  455.         else{Tracking(BS);}
  456.       }
  457.     }
  458.     else{
  459.       //Move(FORWARD);
  460.       //delay(200);
  461.       //Move(STOP);
  462.       meridians = 0;
  463.       //Move(FORWARD);
  464.       //while(!digitalRead(l[4]));
  465.       Move(STOP);
  466.       break;
  467.     }
  468.     }
  469.     break;  
  470.    
  471. }
  472. }



  476. /******************************路段部分********************************/

  478. //主函數部分,直接寫入要走的路
  479. void loop (){
  480.   Turn(LFD);
  481.   Trackingline(FD,3);
  482.   Turn(RBS);
  483.   Trackingline(BS,1);
  484.   Turn(LBD);
  485.   Trackingline(BD,2);
  486.   Turn(RFS);
  487.   Trackingline(FS,1);
  488. }
復制代碼

w.png (935.92 KB, 下載次數: 143)

使用的八路巡線傳感器 前中后各一 全部接在數字口上

使用的八路巡線傳感器 前中后各一 全部接在數字口上

e.jpg (55.61 KB, 下載次數: 130)

小車跑的場地，由單雙線交叉構成的網格，本程序讓小車沿線跑

小車跑的場地，由單雙線交叉構成的網格，本程序讓小車沿線跑

sketch_mar30a.zip

6.61 KB, 下載次數: 27, 下載積分: 黑幣 -5

程序的源碼

評分

參與人數 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎勵！

查看全部評分

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

使用道具 舉報

沙發
ID:859280 發表于 2021-11-3 21:26 | 只看該作者
里面有一些庫文件用不了，庫文件能分享嗎？
回復

使用道具 舉報

板凳
ID:417658 發表于 2021-11-28 16:50 | 只看該作者
小車底盤是自己制作的嗎？
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 日韩在线免费视频 | 天天躁日日躁狠狠很躁 | 欧美成人a∨高清免费观看 91伊人 | 中文字幕视频在线 | 久久av在线播放 | 成人免费一区二区三区视频网站 | 国产高清一二三区 | 国产乱码精品一区二区三区五月婷 | 日韩不卡一二区 | 天天干天天干 | 久久久久一区二区 | 欧美区在线 | 91久久国产综合久久 | 日韩午夜激情 | 日日噜噜噜夜夜爽爽狠狠视频97 | 国产精品国产馆在线真实露脸 | 国产一区二区不卡 | 一本色道精品久久一区二区三区 | 欧美精品乱码久久久久久按摩 | 亚洲激情在线观看 | 亚洲一区中文 | 成人午夜免费福利视频 | 日韩一级电影免费观看 | 看羞羞视频免费 | 国产成人福利在线 | 精品免费观看 | 色视频网站免费 | 午夜电影一区二区 | 在线不卡av | 日本精品一区二区三区在线观看视频 | 精品国产免费一区二区三区演员表 | 一区二区三区视频在线观看 | 色视频在线免费观看 | 欧美综合自拍 | 成人精品福利 | 国产精品美女久久久久久免费 | 正在播放国产精品 | 久久久久久久久久性 | 美女天天操 | 一级片子 | 国产精品一区二区久久精品爱微奶 |