关键词:
六足机器人
运动规划
轨迹规划
力规划
柔顺控制
摘要:
星球探测、灾难救援、山地运输等复杂环境中的作业任务对移动机器人的发展提出了新的挑战,这些作业环境中遍布沟壑、岩石、废墟等障碍,传统的轮式、履带式等移动机器人难以通行。足式机器人与地面之间具有非连续作用点,能够适应几何和物理特征突变的非平坦地形,重型六足机器人具有稳定性好、负载能力强、地形适应性强等优点,可以实现多种运动步态,具有强大的非平坦地形通过能力。然而,重型六足机器人具有众多自由度以及离散的落足点,它的运动规划问题具有高维、离散、多约束等特点。由于非平坦地形的复杂性及六足机器人的冗余驱动特性,机器人的足端在法向和切向均存在运动偏差,导致各个支撑腿之间存在内力对抗。本文针对非平坦地形下的重型六足机器人运动规划与力规划展开深入研究,充分考虑机器人在非平坦地形的力学稳定约束,以提高非平坦地形下的通过能力。
首先,规划非平坦地形下满足力学稳定约束的六足机器人足地作用点序列。对非平坦地形下的机器人进行力学分析,建立多个力学稳定约束,包括:准静态平衡约束、足端力约束、关节力矩约束、摩擦锥约束,提出三维力学稳定区域约束,以保证单步运动的稳定性。将非平坦地形下的六足机器人足地作用点序列搜索建模为图模型,将三维力学稳定区域作为贯穿整个搜索算法的约束,提出基于启发式搜索的足地作用点序列搜索算法以保证搜索的结果满足力学稳定约束。利用动力学仿真平台Gazebo搭建多个典型地形开展仿真分析,用以验证该足地作用点序列搜索方法的可行性和有效性。
其次,机器人实现步态行走需要规划连接相邻离散落足点的连续轨迹,六足机器人的轨迹规划包括:机体轨迹、支撑腿轨迹和摆动腿轨迹。将三维力学稳定区域作为约束,以最小化加加速度为目标,将机体轨迹规划转化为二次优化问题,提出考虑力学稳定约束的机体轨迹优化方法;针对摆动腿轨迹与未建模障碍物存在的干涉问题,基于足端外力扰动构建摆动腿的局部地形人工势场,采用梯度下降优化算法求解摆动腿轨迹,提出基于虚拟地形势场的摆动腿重规划策略,并在六足实验样机上验证策略的有效性。
再次,为避免非平坦地形下足端力的内力对抗,对六足机器人的期望足端力和关节力矩进行规划。为抑制足端受力不均导致足端打滑,进而增强六足机器人的爬坡能力,提出能够降低足端牵引系数的分步二次优化足端力规划算法。为降低六足机器人的能耗,建立其瞬时功率模型,并将其转化为二次优化的目标函数,提出能够降低六足机器人能耗的关节力矩规划算法。采用数值仿真将本文提出的足端力规划算法和关节力矩规划算法与已有算法进行对比分析,证明算法的有效性。搭建基于力规划的柔顺控制框架,采用动力学仿真和样机实验对本章提出的力规划算法进行验证,证明算法的可行性。
最后,为充分验证本文提出的非平坦地形下运动规划与力规划方法,针对重型六足机器人El Spider搭建控制系统软硬件架构,基于ROS(Robot Operating System)通信框架搭建六足机器人的运动规划软件架构,基于Twin CAT(The Windows Control and Automation Technology)实现六足机器人控制系统硬件控制架构,通过模式步态行走实验验证该软硬件架构的可行性。提出基于外部传感器的足地作用点序列跟踪策略,根据期望位姿与实际位姿的误差,实时调整每一步的跨步距离、前进方向,以及每条腿的落足点位置。最后开展融合柔顺控制的室内、室外典型地形的六足机器人行走实验,综合验证所提出的运动规划算法和力规划算法。