• CN:11-2187/TH
  • ISSN:0577-6686

机械工程学报 ›› 2021, Vol. 57 ›› Issue (21): 34-44.doi: 10.3901/JME.2021.21.034

• 机器人及机构学 • 上一篇    下一篇

扫码分享

并联六轮腿机器人机身平稳性控制方法研究

雷涛1,2, 徐康1,2, 汪首坤1,2, 王军政1,2, 刘冬琛1,2, 刘鹏涛1,2   

  1. 1. 北京理工大学复杂系统智能控制与决策国家重点实验室 北京 100081;
    2. 北京理工大学伺服运动系统驱动与控制工信部重点实验室 北京 100081
  • 收稿日期:2020-11-06 修回日期:2021-03-08 出版日期:2021-12-28 发布日期:2021-12-28
  • 通讯作者: 徐康(通信作者),男,1991年出生,博士。主要研究方向为机器人运动与驱动控制,机器人运动规划。E-mail:xukang_bit@163.com
  • 作者简介:雷涛,男,1996年出生。主要研究方向为机器人运动驱动与控制。E-mail:leitao080709@163.com
  • 基金资助:
    国家自然科学基金资助项目(61773060)。

Research on Stability Control Method of Parallel Six-wheel-legged Robot

LEI Tao1,2, XU Kang1,2, WANG Shoukun1,2, WANG Junzheng1,2, LIU Dongchen1,2, LIU Pengtao1,2   

  1. 1. Key Laboratory of Complex System Intelligent Control and Decision, Beijing Institute of Technology, Beijing 100081;
    2. Key Laboratory of Servo Motion System and Control, Beijing Institute of Technology, Beijing 100081
  • Received:2020-11-06 Revised:2021-03-08 Online:2021-12-28 Published:2021-12-28

摘要: 轮腿式机器人在非结构化路面运动时,机身平稳性控制对于提高运动平稳性、降低系统能耗、提高定位与建图精度等具有重要意义。针对并联式六轮腿机器人在通过不规则地形时足端悬空、姿态倾斜、机身晃动等问题,提出一种融合足端力控制器、姿态控制器及重心高度控制器的机身平稳性控制框架。其中,足端力控制器通过阻抗控制算法抑制机器人足端受力因地形变化带来的突变扰动;机身姿态控制器对机身倾斜角进行解耦,并控制各腿的长度补偿机身的偏移量;重心高度控制器根据各腿的伸长量自适应地调节机身高度,保证腿部执行机构具有足够的运动空间。针对三种控制器相互耦合、对外部扰动抑制效果不佳等问题,利用串级控制的思想将三种控制目标统一为力跟踪控制,降低机身振荡的风险。在并联式六轮腿机器人上进行了实验验证,结果表明所提出的控制算法框架能有效抑制外部地形扰动,当机器人以大约0.6 m/s的速度前进时,机身的俯仰角及横滚角保持在-0.7°~0.7°范围内,足端接触力维持在期望力附近,且机身重心高度随地面起伏自适应地调整,确保了机器人的运动平稳性。

关键词: 轮腿机器人, 平稳性控制, 串级控制

Abstract: The stability control of the wheel-legged robot passing on uneven roads is the main challenge to improve the stability of the movement and reduce system energy consumption and increase the accuracy of positioning and mapping. Aiming at the problems of hanging legs, body shaking, and tilting of the body of a six-wheel-legged robot, a body stability control framework is proposed which integrates the leg force controller, the attitude controller, and the height controller. Firstly, the leg force controller uses an impedance control algorithm to limit the sudden disturbance of the force due to terrain changes; the attitude controller decouples the tilt angle of the body and changes the length of each leg to compensate for the offset of the body; The height controller adaptively adjusts the height of the center of the body according to the length of each leg to ensure that the leg actuator has enough space for movement. Furthermore, using the idea of the cascade controller to unify the three control targets into force tracking control to solve the problem of coupling of three controllers and restrain external disturbances. Finally, experimental results show that BIT-NAZA can move in an uneven road with a pitch and roll angle of -0.7° to 0.7° under the speeds of up to 0.6 m/s, as well as the foot contact force maintained near the expected force, and the height of the robot is adaptively adjusted with the undulation of the ground, which ensures the motion stability of the robot.

Key words: wheel-legged robot, stability control, cascade control

中图分类号: