写在前面

运动底盘是移动机器人的重要组成部分,不像激光雷达、IMU、麦克风、音响、摄像头这些通用部件可以直接买到,很难买到通用的底盘。一方面是因为底盘的尺寸结构和参数是要与具体机器人匹配的;另一方面是因为底盘包含软硬件整套解决方案,是很多机器人公司的核心技术,一般不会随便公开。出于强烈的求知欲与学习热情,我想自己DIY一整套两轮差分底盘,并且将完整的设计过程公开出去供大家学习。说干就干,本章节主要内容:

1.stm32主控硬件设计

2.stm32主控软件设计

3.底盘通信协议

4.底盘ROS驱动开发

5.底盘PID控制参数整定

6.底盘里程计标定

6.底盘里程计标定

机器人底盘运行的精度是衡量底盘的重要指标。底盘精度受里程计的走直线误差和转角误差影响。因此,需要对里程计的走直线和转角进行标定,尽量减小误差。miiboo机器人底盘的ROS驱动中已经写好了相应的标定程序,跟里程计标定有关的文件主要有:

.../miiboo_bringup/launch/check_linear.launch为里程计走直线标定启动文件

.../miiboo_bringup/launch/check_angular.launch为里程计转角标定启动文件

.../miiboo_bringup/launch/minimal.launch为设置标定参数及底盘控制启动文件

下面是标定步骤过程。

第一步:

打开终端,给标定脚本赋予可执行权限

cd miiboo_bringup/scripts/
sudo chmod +x ./*

第二步:

连接好底盘DATA-uart2串口,启动底盘

roslaunch miiboo_bringup minimal.launch

第三步:

设定前进1米的目标,对走直线进行标定

roslaunch miiboo_bringup check_linear.launch

测量底盘停止时实际走的直线距离M,按下面的规则调整里程计直线参数speed_ratio

如果M > 1米,增大speed_ratio

如果M < 1米,减小speed_ratio

里程计的参数存放在miiboo_bringup/launch/minimal.launch文件中,如图53所示。

(图53)里程计待标定参数

修改好参数后,需要保存,然后重新启动一下底盘节点,这样参数才能生效。

roslaunch miiboo_bringup minimal.launch

重复第三步的操作,直到走直线的误差达到我们能接受的范围(比如1%的误差),则进入下一步。

第四步:

设定旋转360度的目标,对转角进行标定

roslaunch miiboo_bringup check_angular.launch

测量底盘停止旋转时实际转过的角度A,按下面的规则调整里程计转角参数wheel_distance

如果A > 360度,减小wheel_distance

如果A < 360度,增大wheel_distance

上面已经讲过,里程计的参数存放在miiboo_bringup/launch/minimal.launch文件中,如图53所示。

修改好参数后,需要保存,然后重新启动一下底盘节点,这样参数才能生效。

roslaunch miiboo_bringup minimal.launch

重复第四步的操作,直到走转角的误差达到我们能接受的范围(比如1%的误差),则标定完成。

当然,有兴趣的朋友可以阅读miiboo_bringup/scripts/中的标定脚本源码,结合航迹推演算法,理解里程计标定的整个原理。其实wheel_distance这个参数是编码脉冲值与电机轮胎位移值的一个比例系数,简单点说就是电机转过一个编码脉冲,这个时候电机轮胎走过多少距离;wheel_distance这个参数是左右两个轮子的间距。有了这个认识后,我们可以在这两个参数的理论值附近对参数进行微调,标定起来会更快。

参考文献 

[1] 张虎,机器人SLAM导航核心技术与实战[M]. 机械工业出版社,2022.

Github源码:https://github.com/xiihoo/Books_Robot_SLAM_Navigation