仿尺蠖爬壁机器人自适应吸附及摇杆控制

高国庆，王涛，王斌锐

爬壁机器人的吸附方式中真空吸附应用普遍。真空吸附主要包括真空泵和吸盘。真空泵不断从吸盘腔中抽气，使吸盘腔内达到一定真空度，在大气压和摩擦力作用下，机器人不会倾覆[1]。为了使吸盘和壁面紧密贴合，必须使吸盘平面和目标壁面平行，且两个平面间距足够小。足式真空吸附爬壁机器人通过接触传感器来感知吸盘和壁面的接触情况。美国密歇根州立大学研发的爬壁机器人Flipper和Crawler[2]、中国科学院沈阳自动化研究所研发的机器人[3–4]均采用单吸盘结构，在每个吸盘足安装了2个接触传感器，通过试探性地微调足端来使吸盘和壁面贴合，吸附动作缓慢；文献[5–6]采用吸盘组作为机器人的吸足，对吸盘与壁面的相对姿态要求更高；文献[7]爬壁机器人吸盘底部装有8个红外传感器组成的圆形阵列，用来判断吸盘和壁面的平行度，吸盘两侧装有光纤触觉传感器，用来感知吸盘和壁面的距离。机器人根据8个传感器的值，经位置逆解来使吸盘足和壁面平行。文献[8-9]通过在吸盘平面上安装距离传感器，来测量与壁面的距离。空间中确定吸盘平面至少需要安装3个距离传感器。根据3个距离传感器的值，计算出吸盘平面相对于壁面的夹角和距离。机器人基于运动学位置逆解调节关节角度，使吸盘和壁面贴合紧密。

在实际作业时，操作功能是机器人的关键。华南理工大学研发了爬杆机器人Climbot[10–11]，使用摇杆控制机器人从6 m高的路灯杆上拧下灯泡，但是其摇杆和机器人动作映射过于复杂。文献[12]设计了混合坐标系来操作挖掘机，作者将挖斗和根部关节分开控制，使摇杆操作更直观。文献[13]为不同支撑足的情况分别建立了运动学模型。

本文首先介绍了自主研发的爬壁机器人机构；而后根据D-H参数，建立运动学模型、吸盘足至壁面的空间几何模型，分析可靠吸附的必要条件；然后设计了一种用于机构对称机器人的摇杆操作方法，摇杆轴数值映射为机器人摆动吸盘足在笛卡尔空间中的速度；最后开发了自适应吸附装置，在爬壁机器人上进行实物验证。

1 机器人机构

仿尺蠖爬壁机器人由5个旋转关节串联组成，结构对称，可以像图1(a)中的尺蠖一样蠕动爬行。图1(b)中，J1和J5关节轴线和连杆轴线重合，传动链是直流无刷电机+行星减速机+谐波减速机，用来模仿尺蠖转向；J2、J3和J4关节轴线和连杆轴线垂直，传动链是直流无刷电机+谐波减速机+锥齿轮，用来模仿尺蠖躯体伸缩。S1和S2是两个吸盘足，对应于尺蠖头部和尾部用来附着植物的趾钩。每个吸盘足上安装有3个真空吸盘，以等边三角形分布，用以抵抗重力。多吸盘结构能够减小因吸盘形变导致的机器人倾斜[14]。

图1 仿尺蠖爬壁机器人Fig. 1 Inchworm wall-climbing robot

2 机器人建模

2.1 位置运动学建模

J2、J3和J4关节是爬行运动的关键，将爬壁机器人简化为一个平面三连杆机构。建立D-H坐标系，如图2所示。

图2 D-H坐标系Fig. 2 D-H coordinate system

建立摆动吸盘足到支撑吸盘足的齐次坐标变换矩阵：

式中：

设

可得

2.2 速度运动学建模

分别对式(2)～(4)求微分，并写成矩阵形式：

2.3 吸盘足与壁面夹角分析

如图3所示，S1为支撑吸盘足，S2为摆动吸盘足，下文分别简称为支撑足和摆动足。为吸盘和距离传感器所在平面，为目标壁面，点、和分别表示3个距离传感器的安装位置，为等边三角形，、和分别为点、和到目标平面的距离，为在平面上的投影。

图3 空间坐标系Fig. 3 Space coordinate system

3 摇杆操作与自适应吸附设计

3.1 摇杆与机器人动作映射

吸盘足交替吸附时，机器人始终以X1、Y1作为基坐标系。将摇杆轴数值映射为摆动足的速度值。

根据式(9)，在已知机器人摆动足在笛卡尔空间中X1和Y1方向上速度情况下，可求得关节J2、J3与J4的转速。机器人运动过程中有3种情况：

1) 吸盘足的抬起和放下。如图4(a)，当S1为支撑足时，摆动足S2向上抬起，若此时S2为支撑足，如图4(b) ，可以看到摆动足S1是向下运动的。支撑足不同时，相同的动作，导致摆动足在Y1方向上的运动方向是相反的。为使摇杆轴和机器人运动之间的映射不因支撑足不同而改变，当S1为支撑足时，；当S2为支撑足时，。其中，表示摇杆轴的值，表示机器人摆动足沿Y1方向运动的速度，箭头表示映射。

图4 吸盘足上下运动Fig. 4 Up-and-down motion

2) 机器人躯干的伸缩。如图5，当S1或S2为支撑足时，躯干伸长代表前进，躯干缩短代表后退，摇杆与机器人动作映射为：，其中，表示摇杆轴的值，表示机器人摆动足沿X1方向运动的速度。

图5 吸盘足前后运动Fig. 5 Forward and backward motion

3) 机器人转向。如图6(a)，当S1为支撑足时，摇杆控制J1，；如图6(b)，当为S2支撑足时，摇杆控制J5，。其中，表示摇杆轴的值，表示机器人J1关节转速，表示机器人J5关节转速。

图6 转向Fig. 6 Swerve motion

机器人运动过程中，通过监测S1和S2中的气压来确定支撑足和摆动足。当摆动足至壁面距离小于设定阈值时，摇杆操作失效，机器人自动切换至自适应吸附动作。

3.2 自适应吸附设计

如图7(a)，S1为支撑足，根据式(10)求出的值；J4关节旋转，使摆动足和壁面平行，此时；之后再次获取的值，根据式(5)～(7)求得J3、J4和J5的角度，使，此时S2和壁面贴合紧密。如图7(b)， S2为支撑足，不同于S1为支撑足的情况：此时通过调节J2使摆动足和壁面平行。

图7 自适应吸附流程Fig. 7 Adaptive adsorption process

4 实验测试

4.1 控制系统

搭建了控制系统，如图8所示，控制系统包括PC、关节模块、摇杆、图像采集设备和吸附模块。

图8 控制系统结构Fig. 8 Control system structure diagram

PC作为上位机负责机器人的运动规划、状态监控、人机交互和图像采集；关节模块中，每个电机上集成有相对式编码器，伺服控制器负责底层电流、速度及位置闭环运动控制；吸附模块由微控制器最小系统和外围电路组成，微控制器作为下位机，负责响应上位机命令。PC通过CAN和5个关节模块进行通信，通过RS485和2个吸盘足上的微控制器进行通信。摇杆和图像采集设备通过USB和PC连接。

吸盘足上的微控制器和上位机约定有6种命令：0x11、0x12、0x13、0x21、0x22和 0x23，其中0x代表十六进制；第一位代表吸盘足，“1”代表吸盘足 S1，“2”代表吸盘足 S2；第二位代表命令，“1”代表读取距离，“2”代表读取气压，“3”代表吸盘足释放。

4.2 吸附装置

选用基于ARM的32位微控制器STM32F103作为足端传感和控制系统的控制器，运行频率72 MHz。距离传感器选用超声波传感器KS103，3个超声波传感器以等边三角形方式安装于吸盘足上，如图9(a)、(b)所示，微控制器通过I2C总线读取超声波传感器的数值。为了判断是否吸附成功，选用MPX5100气压传感器检测气路中气压，MPX5100输出0～5 V的模拟量，经过降压后接入微控制器的ADC端口。微控制器通过控制电磁阀和真空泵的开关，来控制吸盘足的吸附和释放。硬件框图如图9(c)所示。

图9 自适应吸附装置Fig. 9 Adaptive adsorption device

机器人有两个吸盘足，每个吸盘足上都装有自适应吸附装置。以吸盘足S1为例，微控制器上电后，经初始化进入循环，在循环中不断检查是否收到命令。微控制器收到0x11后分别测量3个超声波的值，并发送至上位机，满足设定阈值时，自动打开真空泵，开始吸附；收到0x12后测量气压传感器的值，并发送至上位机；收到0x13后，关闭真空泵，气路接大气。

4.3 爬行测试

机器人空载时，使用摇杆控制机器人在水平壁面上进行全向爬行运动。在图10(a)～(g)中，机器人前进了一个步长；在图10(h)～(n) 中，机器人改变了运动方向。操作方法如下：

1) 按下 B1按键，S1释放；

2) 按下 B2按键，S2释放；

5 结束语

自适应吸附和摇杆控制设计，使机器人无需人工干预，自动调整吸盘足位姿，完成吸附动作，实验验证得出以下结论：1)在机器人吸盘足上安装3个距离传感器，测量吸盘足相对壁面的距离和倾角，经位置逆运动学求解，控制关节位置闭环，可使机器人自适应吸附至壁面；2)经逆速度运动学求解，将摇杆映射为机器人关节速度闭环，设定自适应吸附动作触发阈值，吸盘接近壁面时自动触发自适应吸附，降低了操控复杂度。由于超声波传感器的物理特性限制，当吸盘和壁面夹角大于超声波传感器波束角时，测距误差过大，无法正常使用，以后可选用其他类型的距离传感器。

[1]CHU B, JUNG K, HAN C S, et al. A survey of climbing robots: locomotion and adhesion[J]. International journal of precision engineering and manufacturing, 2010, 11(4):633–647.

[2]TUMMALA R L, MUKHERJEE R, XI Ning, et al. Climbing the walls[J]. IEEE robotics and automation magazine,2002, 9(4): 10–19.

[3]姜勇, 王洪光, 房立金. 基于主动试探的微小型爬壁机器人步态控制[J]. 机械工程学报, 2009, 45(7): 56–62.JIANG Yong, WANG Hongguang, FANG Lijin. Gait control of micro wall-climbing robot based on initiative exploration[J]. Journal of mechanical engineering, 2009, 45(7):56–62.

[4]王洪光, 姜勇, 房立金, 等. 双足爬壁机器人壁面凹过渡步态规划研究[J]. 智能系统学报, 2007, 2(4): 40–45.WANG Hongguang, JIANG Yong, FANG Lijin, et al. Gait planning of concave transitions between different slopes for bipedal wall-climbing robots[J]. CAAI transactions on intelligent systems, 2007, 2(4): 40–45.

[5]王斌锐, 冯伟博, 骆浩华, 等. 曲面上双足三自由度爬壁机器人设计与稳定性分析[J]. 机器人, 2014, 36(3): 349–354.WANG Binrui, FENG Weibo, LUO Haohua, et al. Design and stability analysis of dual-foot 3 DOF climbing robot for blade surface[J]. Robot, 2014, 36(3): 349–354.

[6]BALAGUER C, GIMENEZ A, JARDON A. Climbing robots’ mobility for inspection and maintenance of 3d complex environments[J]. Autonomous robots, 2005, 18(2):157–169.

[7]李满天. 微小型尺蠖式壁面移动机器人的研究[D]. 哈尔滨: 哈尔滨工业大学, 2006.LI Mantian. Research on inchworm-like wall-climbing microrobot[D]. Harbin: Harbin Institute of Technology, 2006.

[8]ZHU Haifei, GUAN Yisheng, WU Wenqing, et al.Autonomous pose detection and alignment of suction modules of a biped wall-climbing robot[J]. IEEE/ASME transactions on mechatronics, 2015, 20(2): 653–662.

[9]张联盟, 管贻生, 朱海飞, 等. 双足爬壁机器人吸附模块位姿的检测[J]. 机器人, 2012, 34(6): 758–763.ZHANG Lianmeng, GUAN Yisheng, ZHU Haifei, et al.Posture detection of suction modules for a biped wall-climbing robot[J]. Robot, 2012, 34(6): 758–763.

[10]GUAN Y, JIANG L, ZHU H, et al. Climbot: a bio-inspired modular biped climbing robot—system development, climbing gaits, and experiments[J]. Journal of mechanisms and robotics, 2016, 8(2): 21026.

[11]蔡传武, 管贻生, 周雪峰, 等. 双手爪式仿生攀爬机器人的摇杆控制[J]. 机器人, 2012, 34(3): 363–368.CAI Chuanwu, GUAN Yisheng, ZHOU Xuefeng, et al.Joystick-based control for a biomimetic biped climbing robot[J]. Robot, 2012, 34(3): 363–368.

[12]YOON J, MANURUNG A. Development of an intuitive user interface for a hydraulic backhoe[J]. Automation in construction, 2010, 19(6): 779–790.

[13]XIAO Jizhong, MINOR M, DULIMARTA H, et al. Modeling and control of an under-actuated miniature crawler robot[C]//Proceedings of 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium.Maui, HI, USA: IEEE, 2001: 1546–1551.

[14]GUAN Yisheng, ZHU Haifei, WU Wenqiang, et al. A modular biped wall-climbing robot with high mobility and manipulating function[J]. IEEE/ASME transactions on mechatronics, 2013, 18(6): 1787–1798.

[15]余夫. 爬行——从容不迫的运动方式[J]. 百科知识, 2009(5):29–31.YU Fu. The crawling motion way take it leisurely and unoppressively[J]. Encyclopedia knowledge, 2009(5):29–31.