1. 功能说明
本文示例将实现R023样机小型双轮差速底盘悬崖巡检的功能。在小型双轮差速底盘上安装一个检测装置,它可以由1个 近红外传感器 和1个 灰度传感器 组成。近红外传感器可以识别桌面,灰度传感器可以识别“悬崖”,让机器人沿着“悬崖”巡逻,既不远离,也不掉下去。
2. 电子硬件
在这个示例中,我们采用了以下硬件,请大家参考:
主控板 | Basra主控板(兼容Arduino Uno) |
扩展板 | Bigfish2.1扩展板 |
传感器 | 近红外传感器 |
灰度传感器 | |
电池 | 7.4V锂电池 |
电路连接:
① 近红外传感器连接在Bigfish扩展板的A0端口;灰度传感器连接在Bigfish扩展板的A4端口。
② 2个直流电机分别连在Bigfish扩展板的9,10接口和5,6接口。
3. 功能实现
编程环境:Arduino 1.8.19
下面提供一个小型双轮差速底盘悬崖巡检的参考例程(Cliff_avoidance_robot.ino):
/*------------------------------------------------------------------------------------
版权说明: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-07-19 https://www.robotway.com/
------------------------------*/
/*************************************************************************************************************************************************
实验需求:
实现悬崖巡检机器人
实现思路:
程序的整体思路为:用近红外来检测停放小车的桌面,用灰度来检测悬崖。
当近红外持续触发时,说明小车在桌面,小车保持前进,如果灰度传感器触发,说明小车遇到悬崖,
小车先后退350毫秒,在左转350毫秒远离悬崖。如果近红外没有触发,说明小车也检测到了悬崖。否则,小车前进。
*************************************************************************************************************************************************/
/******************************************************************
实验接线:
近红外传感器接到A0(即14引脚);
灰度传感器接到A4(即18引脚);
直流电机1接5,6引脚;
直流电机2接9,10引脚;
******************************************************************/
int _ABVAR_1_Near_infrared_sensor = 0 ;
int _ABVAR_2_Grayscale_sensor = 0 ;
boolean __ardublockDigitalRead(int pinNumber)
{
pinMode(pinNumber, INPUT);
return digitalRead(pinNumber);
}
void forward();
void back();
void Cliff();
void left();
void setup()
{
pinMode( 10, OUTPUT);
pinMode( 6, OUTPUT);
pinMode( 5, OUTPUT);
pinMode( 9, OUTPUT);
_ABVAR_1_Near_infrared_sensor = 14 ;
_ABVAR_2_Grayscale_sensor = 18 ;
}
void loop()
{
if (__ardublockDigitalRead(_ABVAR_1_Near_infrared_sensor))
{
Cliff(); //如果近红外没有触发,说明小车检测到了悬崖。
}
if (!( __ardublockDigitalRead(_ABVAR_2_Grayscale_sensor) ))
{
Cliff(); //如果灰度传感器触发,说明小车遇到悬崖,小车先后退350毫秒,在左转350毫秒远离悬崖。
}
else
{
forward();
}
}
void back()
{
analogWrite(5 , 0);
analogWrite(6 , 100);
analogWrite(9 , 0);
analogWrite(10 , 100);
}
void forward()
{
analogWrite(5 , 100);
analogWrite(6 , 0);
analogWrite(9 , 80);
analogWrite(10 , 0);
}
void Cliff()
{
back();
delay( 350 );
left();
delay( 350 );
}
void left()
{
analogWrite(5 , 100);
analogWrite(6 , 0);
analogWrite(9 , 0);
analogWrite(10 , 100);
}
悬崖巡检-程序源代码详见 小型双轮差速底盘-悬崖巡检