极客工坊

 找回密码
 注册

QQ登录

只需一步,快速开始

查看: 8123|回复: 1

寻线避障机器人,避障不了,这是为什么?

[复制链接]
发表于 2014-2-27 12:10:38 | 显示全部楼层 |阅读模式
  ----连接图      
   这是我自己拍的视频,本来想发给我买这个机器人那公司的,但是那边没能给出很好的解答,说“很忙”。。。
  1. 下面是代码:
  2. void setup()
  3. {
  4.   pinMode(8,OUTPUT);//定义输入、输出接口
  5.   pinMode(9,OUTPUT);
  6.   pinMode(10,OUTPUT);
  7.   pinMode(5,OUTPUT);
  8.   pinMode(6,OUTPUT);
  9.   pinMode(7,OUTPUT);
  10.   pinMode(11,INPUT);
  11.   pinMode(12,INPUT);
  12.   pinMode(14,INPUT);       /*这个假如换成13的话,接在这个口的mini避障传感器总是亮着微弱的光,这是为什么?*/
  13.   pinMode(2,INPUT);
  14.   pinMode(3,INPUT);
  15.   pinMode(4,INPUT);
  16. }
  17. void qianjin()//前进
  18. {
  19.      digitalWrite(10,300);//输入数字量进行设定速度
  20.      digitalWrite(5,300);
  21.      digitalWrite(9,HIGH);//使直流电机(右)顺时针转
  22.      digitalWrite(8,LOW);
  23.      digitalWrite(7,HIGH);//使直流电机(左)逆时针转
  24.      digitalWrite(6,LOW);
  25. }
  26. void youzhuan()//右转
  27. {
  28.      
  29.      digitalWrite(10,100);//输入数字量进行设定速度
  30.      digitalWrite(5,100);
  31.      digitalWrite(6,LOW);//使直流电机(右)逆时针转
  32.      digitalWrite(7,HIGH);
  33.      digitalWrite(8,HIGH);//使直流电机(左)逆时针转
  34.      digitalWrite(9,LOW);
  35. }
  36. void zuozhuan()//左转
  37. {
  38.      
  39.      digitalWrite(10,100);//输入数字量进行设定速度
  40.      digitalWrite(5,100);
  41.      digitalWrite(6,HIGH);//使直流电机(右)顺时针转
  42.      digitalWrite(7,LOW);
  43.      digitalWrite(8,LOW);//使直流电机(左)顺时针转
  44.      digitalWrite(9,HIGH);
  45. }
  46. void tingzhi()//停止
  47. {
  48.      digitalWrite(6,HIGH);//使直流电机(右)制动
  49.      digitalWrite(7,HIGH);
  50.      digitalWrite(8,HIGH);//使直流电机(左)制动
  51.      digitalWrite(9,HIGH);
  52. }
  53. void houtui(int a)
  54. {
  55.      analogWrite(10,a);//输入模拟值进行设定速度

  56.      analogWrite(5,a);
  57.      digitalWrite(6,HIGH);//使直流电机(右)逆时针转
  58.      digitalWrite(7,LOW);
  59.      digitalWrite(9,LOW);//使直流电机(左)顺时针转
  60.      digitalWrite(8,HIGH);
  61. }
  62. void loop()
  63. {
  64.     int r,m,l;//定义寻线传感器接口
  65.     r=digitalRead(2);//定义右侧寻线接口
  66.     m=digitalRead(3);//定义中间寻线接口
  67.     l=digitalRead(4);//定义左侧寻线接口
  68.     int r1,m1,l1;//定义避障传感器接口
  69.     r1=digitalRead(14);//定义右侧避障接口
  70.     m1=digitalRead(12);//定义中间避障接口
  71.     l1=digitalRead(11);//定义左侧避障接口
  72.     if(l==LOW || m==LOW || r==LOW)//判断是否有黑线 有则继续
  73.     {
  74.       if(l==LOW && m==LOW && r==LOW)
  75.       qianjin();
  76.       if(l==HIGH && m==LOW && r==HIGH)
  77.       qianjin();
  78.       if(l==HIGH && m==LOW && r==LOW)
  79.     {
  80.        youzhuan();
  81.       delay(400);
  82.      // tingzhi();
  83.      // delay(80);
  84.     }
  85.       if(l==LOW && m==LOW && r==HIGH)
  86.     {
  87.       zuozhuan();
  88.      delay(400);
  89.      // tingzhi();
  90.      // delay(80);
  91.    }
  92.       if(l==HIGH && m==HIGH && r==LOW)
  93.        {
  94.        youzhuan();
  95.      delay(400);
  96.      // tingzhi();
  97.       //delay(80);
  98.     }
  99.       if(l==LOW && m==HIGH && r==HIGH)
  100.      {
  101.       zuozhuan();
  102.       delay(400);
  103.      // tingzhi();
  104.      // delay(80);
  105.     }
  106.     }
  107.     if(l==HIGH && m==HIGH && r==HIGH)//判断是否有障碍 有则继续
  108.     {
  109.     if(l1==HIGH && m1==HIGH && r1==HIGH)
  110.     qianjin();
  111.     if(l1==HIGH && m1==LOW && r1==HIGH)
  112.     {
  113.       houtui(200);
  114.       delay(400);
  115.       zuozhuan();
  116.       delay(300);
  117.     }
  118.     if(l1==HIGH && m1==HIGH && r1==LOW)
  119.     zuozhuan();
  120.     if(l1==LOW && m1==HIGH && r1==HIGH)
  121.     youzhuan();
  122.     if(l1==HIGH && m1==LOW && r1==LOW)
  123.     zuozhuan();
  124.     if(l1==LOW && m1==LOW && r1==HIGH)
  125.     youzhuan();
  126.     if(l1==LOW && m1==LOW && r1==LOW)
  127.       {
  128.         houtui(200);
  129.         delay(400);
  130.         zuozhuan();
  131.         delay(300);
  132.       }
  133.     }
复制代码

本帖子中包含更多资源

您需要 登录 才可以下载或查看,没有帐号?注册

x
回复

使用道具 举报

 楼主| 发表于 2014-2-27 12:15:56 | 显示全部楼层
怎么没视频了啊?
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则 需要先绑定手机号

Archiver|联系我们|极客工坊

GMT+8, 2024-4-25 06:49 , Processed in 0.039470 second(s), 18 queries .

Powered by Discuz! X3.4 Licensed

Copyright © 2001-2021, Tencent Cloud.

快速回复 返回顶部 返回列表