带双杆臂的履带式移动机器人自主下楼梯的控制方法
【技术领域】
[0001] 本发明属于移动机器人技术领域，涉及一种针对带双杆臂的履带式移动机器人在 运动过程中如何自主下楼梯的控制方法。
【背景技术】
[0002] 近年来，移动机器人在军事、监测、搜索、排险等各种领域具有越来越广泛的应用。 在这些应用中，移动机器人常常会碰到下楼梯的问题。目前对移动机器人的最主要的控制 方法是遥操作控制方法，通过移动机器人自带的传感器采集相关信息，再把这些信息传送 给控制端，控制端的操作人员由此做出判断，再将控制指令发送回移动机器人，从而控制机 器人。但在这种方式下，由于存在时延或信息精确度不高，使得操作人员在远程控制端的临 场感很差；另外操作人员要始终保持注意力集中，容易产生疲劳，从而导致判断错误。这就 要求机器人最好具有一定的自认知能力和自主控制能力。
[0003] 研宄者通常重视研宄移动机器人上楼梯的问题，而忽视了下楼梯的问题，认为只 要让移动机器人直接摔下楼梯即可。其实为了保证移动机器人的运动安全可靠，需要实现 移动机器人从楼梯到水平地面行走过程始终保持运动的平稳，避免直接摔下楼梯造成的刚 性冲击和对移动机器人本体及搭载物的损坏。
【发明内容】
[0004] 本发明所要解决的技术问题在于，克服遥操作控制方法存在的不足，避免让履带 式移动机器人直接摔下楼梯，提供一种能够使带有双杆臂的履带式移动机器人自主完成下 楼复合运动的控制方法。
[0005] -种履带式移动机器人自主下楼梯的控制方法，所述履带式移动机器人包括前 轮、后轮以及包覆在所述前轮和后轮上的履带，其特征在于：在所述前轮设置有转动角度可 控的双杆臂，在所述双杆臂的旋转轴两端分别设置一个用于检测双杆臂每个杆臂力矩的三 轴力传感器，通过调整所述双杆臂的转角逐步降低沿着楼梯边移动的履带式移动机器人前 轮与下阶台阶踏步面的距离。
[0006] 通过调整所述双杆臂的转角逐步降低沿着楼梯边移动的履带式移动机器人前轮 与下阶楼梯平面的距离的具体方法是：
[0007] 步骤1:将移动机器人的车头对准楼梯并驶向台阶踏步，上扬双杆臂使其中心线 与履带底面垂直，记该位置为双杆臂的初始位置，进行步骤2 ;
[0011] 其中，H为台阶高度，h为移动机器人的高度，L2S双杆臂长度，L3为前后车轮圆心 之间的距离；
[0012] 驱动移动机器人前进至移动机器人重心过踏步前缘，车体在重力作用产生倾斜， 此时双杆臂上力传感器检测的扭矩小于0,进行步骤3 ;
[0013] 步骤3:保持双杆臂中心线与履带底面成0夹角，驱动移动机器人前进，当双杆臂 上力传感器检测的扭矩由小于〇变为大于〇时，停止驱动移动机器人前进，直至双杆臂前端 与下一级台阶踏步面接触，移动机器人与楼梯对正，进行步骤4 ;
[0014] 步骤4 :逆时针旋转双杆臂，配合双杆臂的旋转驱动移动机器人使移动机器人的 前端顺利通过这级台阶，进行步骤5 ;
[0015] 步骤5 :逆时针旋转双杆臂，驱动移动机器人行驶使得前轮与下一级台阶踏步面 接触，后轮靠在台阶踏步前缘，进行步骤6 ;
[0016] 步骤6 :逆时针旋转双杆臂，使双杆臂摆回初始位置从而为继续下台阶做准备，驱 动移动机器人使后轮沿踏步踢面滑下至车体平行于台阶踏步面，完成自主下楼梯过程。
[0017] 本发明带有双杆臂的履带式移动机器人包括前轮和后轮，后轮为驱动轮，前轮为 从动轮，左右两侧的前、后轮分别被两条履带包覆，组成机器人的行进机构；与机器人前轮 共轴安装有双杆臂机构，并以前轮轴为转动中心，沿机器人行进方向做360度圆周旋转；在 机器人车体顶面的前后端安装红外避障传感器，用于测量履带式移动机器人与前后方障碍 物之间的距离；在机器人车体底面的四个角装有数字防跌落传感器，用于检测楼梯，给出台 阶信号；在车体前端装有摄像头，用于拍摄移动机器人前方的画面；在机器人的双杆臂主 动轮的旋转轴两端分别设置一个用于检测双杆臂力矩FL和FR的三轴力传感器。
[0018] 本发明方法的优选方案中，步骤1中，保持移动机器人行驶方向与最顶一级的台 阶的踏步前缘垂直的具体方法为：当车体前端的两个数字防跌落传感器中只有一个检测到 有悬崖信号，则说明车身没有摆正，需要调整左右履带的转速，使得移动机器人往没有检测 到悬崖信号的一端后退；当两个数字防跌落传感器同时检测到悬崖信号时，说明车身摆 正。
[0019] 步骤3中，当只有一个力矩值从负值变为正值时，移动机器人停止前进，说明此时 只有一个杆臂与踏步面接触，认为此时移动机器人没有与楼梯完全对正；这里假设FL从负 值增大为正值，而FR仍为负值，认为此时左侧杆臂与踏步面接触，驱动右侧的前轮向前转 动，直至FL=FR>0时，前轮停止转动，此时移动机器人完全与楼梯对正。
[0020] 在其他步骤中，保持前进方向始终与离车体前端最近一级台阶的踏步前缘垂直的 具体方法为：因为步骤1中已经实现移动机器人行驶方向与最顶一级的台阶的踏步前缘垂 直，采用码盘实时调整左右履带的转速差，使其保持为零，则意味着移动机器人前进方向与 离车体前端最近一级台阶的踏步前缘垂直。
[0021] 与现有技术相比，本发明具有如下优点：
[0022] (1)从研宄者容易忽略的移动机器人下楼梯角度出发，若直接让其摔下楼梯，则可 能破坏移动机器人的内部结构从而影响其后续使用；本发明提出的是一种自主下楼的柔顺 控制方法，这一过程使得机器人在从楼梯平面到水平面的过程中始终保持运动的平稳，避 免了直接摔下楼梯造成的刚性冲击和对移动机器人本体及搭载物的损坏。
[0023] (2)针对小型履带式移动机器人，提出一种新式下楼控制方法：利用移动机器人 搭载传感器的测量结果，根据移动机器人尺寸和台阶尺寸的相对关系做出决策，控制移动 机器人车体和双杆臂的协调运动；通过调整双杆臂的转角逐步降低沿着楼梯边移动的履带 式移动机器人前轮与下阶台阶踏步面的距离，使得移动机器人可以顺利下楼。
[0024] (3)该方法使得操作人员在控制端的显示屏上发现楼梯并想移动机器人下楼时， 只需要首先手动遥控移动机器人运动到楼梯的顶部，调整移动机器人的姿态使其适合下 楼，然后发出下楼指令，移动机器人就可以进行自主下楼，在下楼过程中无需人为干预。
【附图说明】
[0025] 图1是本发明所使用的带双杆臂的履带式移动机器人的正面示意图。
[0026] 图2是本发明所使用的带双杆臂的履带式移动机器人的背面示意图。
[0027] 图3是本发明所使用的带双杆臂的履带式移动机器人的监控设备示意图。
[0028] 图4是本发明使用的带双杆臂的履带式移动机器人下楼梯过程示意图，其中：4A 为将移动机器人的车头对准楼梯并驶向台阶踏步示意图；4B为驱动移动机器人前进至移 动机器人重心过踏步前缘示意图；4C为当移动机器人重心刚过踏步前缘时，车体由于重 力作用产生倾斜示意图；4D是双杆臂与下一级台阶踏步面接触面和车体与本级台阶踏步 前缘的接触面合力支撑住整个移动机器人以防止受重力作用滑跌示意图；4E为逆时针旋 转双杆臂，配合双杆臂的旋转驱动移动机器人示意图；4F为移动机器人的前端顺利通过这 级台阶示意图；4G为驱动移动机器人行驶，逆时针旋转双杆臂的示意图；4H为驱动机器人 使得前轮与下一级台阶踏步面接触，后轮靠在台阶踏步前缘的示意图；41为逆时针旋转双 杆臂，使双杆臂摆回初始位置从而为继续下台阶做准备示意图；4J为驱动移动机器人使后 轮沿踏步踢面滑下至车体平行于台阶踏步面，完成自主下楼梯过程示意图。
【具体实施方式】
[0029] 下面结合实施例和说明书附图对本发明做进一步说明。
[0030] 本实施例是针对一种带有双杆臂5的履带式移动机器人如何自主下楼梯而提出 的一种新的控制方法。本实施例所使用的履带式移动机器人是便携式的，尺寸如下：长度为 20厘米，宽度为18厘米，高度为6厘米，双杆臂长度15厘米。本实施例所使用的小型移动 机器人参见图1和图2所示，其中1、2为车体上半和下半部分，3为前轮，4为后轮，5为双杆 臂，6为天线，7为红外测距传感器，8为摄像头，9为履带，10为三轴力传感器，11为电源充 电口，12为数字防跌落传感器，13为电源开关。车体的前轮3为驱动轮，后轮4为从动轮， 前轮3和后轮4包覆有车体履带9,双杆臂5还可以同步向上扬起或向下落下。其中四个红 外测距传感器