0
  • 聊天消息
  • 系统消息
  • 评论与回复
登录后你可以
  • 下载海量资料
  • 学习在线课程
  • 观看技术视频
  • 写文章/发帖/加入社区
创作中心

完善资料让更多小伙伴认识你,还能领取20积分哦,立即完善>

3天内不再提示

双轮差速底盘三灰度循迹功能的实现

jf_72402704 来源:jf_72402704 作者:jf_72402704 2023-03-03 17:29 次阅读

1. 功能说明

在小型双轮差速底盘样机前方安装3个 灰度传感器 ,实现机器人沿下图所指定的跑道路线进行运动的效果。

poYBAGQBvfyAEcV-AAATpD7bDQg052.png

2. 使用样机

本实验使用的样机为R023样机。

pYYBAGQBvf2ACOsLAABMKkngzEU959.jpg

3. 功能实现

3.1 电子硬件

在这个示例中,我们采用了以下硬件,请大家参考:

主控板 Basra(兼容Arduino Uno)
扩展板 Bigfish2.1扩展板
传感器 灰度传感器
电池 7.4V锂电池

电路连接说明:

① 左轮直流电机连在D9,D10接口上;

② 右轮直流电机连在D5,D6接口上;

③ 3个灰度传感器从左至右连接在A0,A4,A3端口上。

poYBAGQBvf2AC_LgAAB4ZkvEMVg088.jpg

3.2 编程框架

本实验的编程框架用到了有限状态机。有限状态机(Finite-state machine)简称FSM,表示有限个状态以及在这些状态之间的转移和动作等行为的数学模型。它把复杂的控制逻辑分解成有限个稳定状态,在每个状态上判断事件。由于有限状态机有有限个状态,因此可以在实际中实现。有限状态机可以广泛的应用于机器人多个传感器触发组合状态的判断,大大提高检测效率。

状态表

机器人的传感器触发一般用条件判断来做。

这时机器人程序的一般思路是:

如果
机器人的某几个传感器触发了;
机器人的某几个电机做个什么事;
做多久;
如果
机器人的另外某几个传感器触发了;
机器人的某几个电机做个什么事;
做多久;

所以我们总是要用到大量的 if 语句,比如双轮小车的某个功能:

如果
机器人的1号传感器触发了;
机器人的左侧电机顺时针转;
机器人的右侧电机逆时针转;
持续5秒;
如果
机器人的2号传感器触发了;
机器人的左侧电机逆时针转;
机器人的右侧电机顺时针转;
持续5秒;
否则
都不转

用伪码写出来就是:

if {   Sensor(端口a,触发);//传感器触发时此句为真,否则为假 }

{

    Motor(L,顺);

    Motor(R,逆);

    Delay 5;

}

if {   Sensor(端口b,触发); }

{

    Motor(L,逆);

    Motor(R,顺);

    Delay 5;

}

else

{

    Motor(L,停);

    Motor(R,停);

}

在只有一个传感器的情况下,我们假设这是个开关量传感器。那么我们可以得到一个状态表格:

状态序号 传感器1
1 1
2 0

这个传感器有两个状态。

而当有两个传感器时,则有四个状态。

状态序号 传感器1 传感器2
1 1 1
2 1 0
3 0 1
4 0 0

如果我们用 if 语句写这四个状态,就显得比较长。

状态序号 传感器1 传感器2 伪码
1 1 1 if
{
Sensor(1,1);
Sensor(2,1);
……
}
2 1 0 if
{
Sensor(1,1);
Sensor(2,0);
……
}
3 0 1 if
{
Sensor(1,0);
Sensor(2,1);
……
}
4 0 0 else
……

在编程的时候,状态罗列的越全,机器人的bug就越少。但是随着传感器的增多,状态数量按2的N次幂增加,大量的if语句使执行效率变得很低,经常出现识别不灵的情况。我们需要换一种高效写法。

多个确定数量的传感器的触发组合,符合有限状态机的概念,有限状态机一般是用Switch语句来实现。如:

switch(s)

{

case 1 : {动作1;}break;

case 2 : {动作2;}break;

case 3 : {动作3;}break;

case 4 : Act_Stop();break;

default:;break;

}

不难发现,这段语句实现的关键,就是识别出上页表中的1、2、3、4,四个状态序号。

那么问题就来了:我们如何让机器人知道自己传感器的触发组合对应于1、2、3、4的哪个序号呢?

二进制状态表

下面,我们把每组传感器返回值看成一个二进制数值。

pYYBAGQBvemACe7-AABSPvxqzq8185.png

结果我们发现了一种新的、可计算的编码方式:

新序号 传感器1 传感器2
0 0 0
1 0 1
2 1 0
3 1 1

于是,只要我们知道了传感器们的触发状态,也就知道了序号;知道了序号,也就知道了传感器们的触发状态。用这个序号去写switch语句,再合适不过了。下面我们要做的是,用一种算法,让机器人能够返回自己接收到的传感器组合值的二进制数据。

算法精解

我们可以使用以下算法来实现:

首先设置一个变量s,这个s,将存储传感器组的二进制状态序号。

我们还需要用到一个重要的运算符“<<”,这个运算符的意义是:左移

如:1<

如:1<<1,结果就是10;1<<2,结果就是100;101<<1,结果就是1010

只要让机器人依次返回各个传感器的状态数值,最早获取的,移到最左;第二获得的,移到“倒数第二左”,……,以此类推。即可获得。

如两个传感器均触发:

先获得1号的数值(真)并左移0位,得

0 1

再获得2号的数值(真)并左移1位,得

1 0

两数值取“或”,即可得11

数学问题解决了,很容易就可以转化为程序语句:

s=0;

for(i=0;i<2;i++) //因为此例中有2个传感器,i取2

{

s=s|(Servo(i+1,触发判断)<

于是switch语句可以写为:

switch(s)

{

case 0x00 : {动作0;}break; //序号也可以写作16进制数值

case 0x01 : {动作1;}break;

case 0x02 : {动作2;}break;

case 0x03 : {动作3;}break;

default:;break;

}

策略表
下面我们以本实验中的“小型双轮差速底盘-3灰度循迹”程序为例,再来推导一遍。

传感器触发情况、小车行驶状态、对应行为策略表如下:

传感器1 传感器2 传感器3 序号 小车状态 动作
0 0 0 0 都没触发,可能是跑偏了 后退,转向
0 0 1 1 小车左偏 左轮逆时针转,向右调整
0 1 0 2 小车正中 左轮逆时针转,右轮顺时针转,前进
0 1 1 3 在这个行进方向上不可能
1 0 0 4 小车右偏 右轮顺时针转,向左调整
1 0 1 5 在此跑道上不可能
1 1 0 6 遇到转角 右轮顺时针转,左转
1 1 1 7 在此跑道上不可能

伪码如下:

s=0;

for(i=0;i<3;i++)

{

s=s|(Input(i+1,1)<

这段代码中的动作,完全由策略表分析获得,因此,当状态比较多时,用户要学会利用策略表进行分析,从而确定机器人的动作策略,而不是凭空想象。

3.3 编写程序

编程环境:Arduino 1.8.19

编写并烧录以下程序(Track_Car.ino),该程序将实现演示视频中的动作【详细例程源代码下载请见 https://www.robotway.com/h-col-113.html】

/*------------------------------------------------------------------------------------

  版权说明:Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.

           Distributed under MIT license.See file LICENSE for detail or copy at

           https://opensource.org/licenses/MIT

           by 机器谱 2023-02-09 https://www.robotway.com/                                   

------------------------------------------------------------------------------------*/

int pin[3] = {A0, A3, A4};           //按车头前进方向,从右至左定义,后面经过公式计算,会转化为从左至右的顺序

int s;

void setup()

{

  pinMode( 5 , OUTPUT);

  pinMode( 6 , OUTPUT);

  pinMode( 9 , OUTPUT);

  pinMode( 10 , OUTPUT);

}



void loop()

{

   s = 0;

        for(int i=0; i<3; i++)                 //循环获取三个传感器的值

        {

            s|= (!digitalRead(pin[i]) << i);   //经过左移运算和或运算后,按照A0、A3、A4的顺序产生一个三位2进制数值,表示3个传感器的组合触发状态

        }

        switch (s)

        {

          case 0x00: //三个均未触发

          back();

          Left();

          break;

          case 0x01: //右侧传感器触发,直线上摆动或遇到右转弯

          Right();

          break;

          case 0x02: //中间传感器触发,直线上直行

          Forwards();

          break;

          case 0x04: //左侧传感器触发,直线上摆动或遇到左转弯

          Left();

          break;

          case 0x06: //左侧两个触发,遇到左转弯

          Left();

          break;

          default:;break;

        }

  }

void Left()

{

digitalWrite( 5 , LOW );

digitalWrite( 6 , HIGH);

digitalWrite( 9 , HIGH );

digitalWrite( 10 , LOW );

}



void Right()

{

digitalWrite( 5 , HIGH );

digitalWrite( 6 , LOW );

digitalWrite( 9 , LOW );

digitalWrite( 10 , HIGH );

}



void Forwards()

{

digitalWrite( 5 , HIGH );

digitalWrite( 6 , LOW );

digitalWrite( 9 , HIGH );

digitalWrite( 10 , LOW );

}



void back()

{

digitalWrite( 5 , LOW );

digitalWrite( 6 , HIGH );

digitalWrite( 9 , LOW );

digitalWrite( 10 , HIGH );

}

审核编辑黄宇

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉
  • 传感器
    +关注

    关注

    2515

    文章

    47684

    浏览量

    738664
  • 机器人
    +关注

    关注

    206

    文章

    26820

    浏览量

    201019
收藏 人收藏

    评论

    相关推荐

    汽车底盘构造图

    驱动车轮。传动系具有减速、变速、倒车、中断动力、轮间和轴间功能,与发动机配合工作,能保证汽车在各种工况条件下的正常行驶,并具有良好
    发表于 05-27 00:09

    怎样用Labview的vision相关模块实现图像的灰度扫描以及灰度

    怎样用Labview的vision相关模块实现图像的灰度扫描以及灰度分,可以详细点:具体用到哪些模块,求赐教。
    发表于 06-26 20:08

    小车底盘结构和搭建过程

    小车底盘更新日志底盘机械结构1.1 底盘机械组装1.2 底盘硬件框图1.3 电气系统搭建2
    发表于 08-23 07:40

    基于51单片机的循迹小车的设计资料分享

    # 基于51单片机的循迹小车(详细讲解+源码)作为一名大学生,这里我就简单谈谈我们小组做这个循迹小车的一个过程。主要是实现小车寻黑线行驶的这样一个功能,速度可以调节(定时器中断模拟PW
    发表于 11-18 07:55

    如何利用STM32实现红外遥控双轮平衡小车的设计?

    如何利用STM32实现红外遥控双轮平衡小车的设计?
    发表于 11-19 06:35

    如何去实现基于STM32的循迹小车功能

    自动循迹功能现实一,硬件描述1、循迹模块五路黑线检测,黑线反馈低电平2、小车行驶速度通过PWM控制,现实无极调速。因为开发板以及小车自重太重占空比太低的时候下车无法驱动3、小车马达减速装置不够,小车
    发表于 01-14 09:03

    如何搭建实体机器人ros底盘

    目录介绍一、底盘主控板二、嵌入式开发板1. 与上位机pc的关系2. 与STM32主控板的关系介绍自下而上的分析实体机器人(分轮机器人)搭建中的关键过程。一、底盘主控板本部分搭建实体
    发表于 01-20 07:36

    底盘的设计资料分享

    SLAM+语音机器人DIY系列:(四)底盘设计——1.stm32主控硬件设计摘要 运动底盘是移动机器人的重要组成部分,不像激光雷达、IMU、麦克风、音响、摄像头这些通用部件可以直接买到,很难
    发表于 02-14 06:29

    智能循迹避障小车设计与实现

    智能循迹避障小车设计与实现
    发表于 06-06 08:48 304次下载

    使用以双灰度传感器实现的曲线循迹以及矩形循迹的资料说明

    在这次课程中,我们小组选定的课题是循迹小车,在长达数周的辛苦付出中,我组小车已能实现功能有1.红遥控小车2.以灰度传感器实现矩形
    发表于 12-23 08:00 12次下载
    使用以双<b class='flag-5'>灰度</b>传感器<b class='flag-5'>实现</b>的曲线<b class='flag-5'>循迹</b>以及矩形<b class='flag-5'>循迹</b>的资料说明

    小型双轮差速底盘的制作

    小型双轮差速底盘可以通过两个驱动轮的 差速运动 来实现前进、后退、原地转向、大半径转向等基本行驶功能
    的头像 发表于 01-13 15:17 2433次阅读
    小型<b class='flag-5'>双轮</b>差速<b class='flag-5'>底盘</b>的制作

    小型双轮差速底盘视觉循迹功能实现

    1. 任务描述       在机器人小车上搭载摄像头,摄像头采集图像信息并通过WiFi将信息传递给PC端,然后PC端使用OpenCV对摄像头读取到的视频进行灰度化、高斯滤波、腐蚀、膨胀等处理,使图像
    的头像 发表于 03-03 17:05 295次阅读
    小型<b class='flag-5'>双轮</b>差速<b class='flag-5'>底盘</b>视觉<b class='flag-5'>循迹</b><b class='flag-5'>功能</b>的<b class='flag-5'>实现</b>

    如何实现双轮差速底盘躲避悬崖的功能

    1. 功能说明        本实验使用的样机为R023样机小型双轮差速底盘。在样机前方安装3个近红外传感器 ,实现机器人躲避悬崖、在某平台上移动时不会掉下去的效果。   2. 电子硬
    的头像 发表于 03-03 17:08 231次阅读
    如何<b class='flag-5'>实现</b><b class='flag-5'>双轮</b>差速<b class='flag-5'>底盘</b>躲避悬崖的<b class='flag-5'>功能</b>?

    如何让小型双轮差速底盘实现灰度循迹功能?

    1. 功能说明    在机器人车体上安装2个 灰度传感器 ,实现机器人按照下图所指定的路线进行导航运动,来模拟仓库物流机器人按指定路线行进的工作过程。   2. 使用样机     本实验使用的样机
    的头像 发表于 03-03 17:14 297次阅读
    如何让小型<b class='flag-5'>双轮</b>差速<b class='flag-5'>底盘</b><b class='flag-5'>实现</b>双<b class='flag-5'>灰度</b><b class='flag-5'>循迹</b><b class='flag-5'>功能</b>?

    小型平行履带底盘实现灰度循迹功能

    1. 功能说明    在小型平行履带底盘样机上安装2个 灰度传感器 ,实现机器人沿指定路线进行运动的效果。 2. 使用样机    本实验使用的样机为R026a样机。 3.
    的头像 发表于 03-09 08:52 240次阅读
    小型平行履带<b class='flag-5'>底盘</b><b class='flag-5'>实现</b>双<b class='flag-5'>灰度</b><b class='flag-5'>循迹</b><b class='flag-5'>功能</b>