[发明专利]一种电驱动足式机器人滑移抑制方法

说明书

本发明涉及一种电驱动足式机器人滑移抑制方法，属于足式机器人运动控制技术领域。通过对一种电驱动足式机器人滑移抑制方法的研究，使得本发明所提电驱动足式机器人在牵引力方向及侧向移动过程中具有滑移抑制功能，并可以通过检测到的足地滑移量实现足地滑移抑制功能，并提高足式机器人控制的运动稳定性。

技术领域

本发明属于足式机器人运动控制技术领域，具体涉及一种电驱动足式机器人滑移抑制方法。

背景技术

电驱动足式机器人滑移抑制方法是足式系统稳定控制的重要关键技术，承担着外部环境扰动转化为具体的滑移抑制运动控制的重要任务。以保证足式平台运动稳定性、灵活性、鲁棒性以及操作便易性为追求目标，电驱动足式机器人滑移抑制方法重点关注了足式系统行走功能及稳定性控制性能。

目前，我国足式机器人起步较晚，足式机器人普遍存在自主稳定性不高，地形适应性差，滑移抑制控制水平较低，对工作地形环境的依赖性强等缺点。由于足式机器人各条腿的地面接触信息都不完全相同，导致沿牵引力方向和切向方向都会有不同程度的运动偏差，使得沿牵引力方向的腿无法实现同步支撑，沿切向方向的各支撑腿之间内力增加。足式机器人由于自由度繁多从而增加了控制系统的复杂性，在运动过程中缺乏对实时足地滑移抑制的能力，目前足式机器人研究主要面向野外崎岖地面，大多注重于步行功能的实现，对足式机器人滑移抑制问题关注较少。

发明内容

(一)要解决的技术问题

本发明要解决的技术问题是：如何解决机器人普遍存在自主稳定性不高，地形适应性差，足式机器人滑移抑制能力差等缺点，自由度繁多从而增加了控制系统的复杂性以及运动过程中缺乏对实时足地滑移抑制能力的问题。

(二)技术方案

为了解决上述技术问题，本发明提供了一种电驱动足式机器人滑移抑制方法，包括以下步骤：

步骤一、足式机器人足力耦合分析解算：对足式机器人三足、四足、五足支撑足力进行耦合分析，根据足地接触模型和单足距离接触面的法向偏移，分析基于地形信息的法向足力耦合特性，建立足式机器人质心受到的三维力矩平衡方程，在保证支撑足具有相同的控制输入下，计算得到多支撑足的足式机器人法向力耦合表达式，并得到多足支撑的足式机器人支撑足力耦合表达式；

步骤二、利用步骤一计算得到的足式机器人足力耦合表达式，根据足端位置采用平面拟合的方法对坡面角度进行估计，建立平面估计方程并解算得到坡面角度及垂直距离参数，根据坡面地形的估计，依据地面的坡度变化以及关节极限位置，实时调整机器人本体的俯仰和滚转角度去适应地形变化，并计算得到力学转换矩阵用于修正足端受力，其力学转换矩阵如下所示：

式中，为斜坡地面和水平地面之间的旋转矩阵；G_legi为每条腿的权重矩阵；为坡面估计角；

步骤三、利用步骤二计算得到的力学转换矩阵，建立足式机器人法向和切向的受力平衡方程，基于受力平衡方程建立机器人质心所受到的滚转力矩平衡方程：

式中，^LF_Nzi为各足的法向支撑力；^LF_Tyi为各足的切向力；^LP_xi,^LP_yi,^LP_zi为各足的前进方向，切向方向和法向方向的坐标；^LP_x,^LP_y,^LP_z为机体的前进方向；切向方向和法向方向的坐标；

根据受力及力矩平衡方程，将足力优化问题转化为二次规划问题：