一种基于六次多项式的六足机器人足端轨迹规划方法技术

本发明专利技术设计一种基于六次多项式的六足机器人足端轨迹规划方法，针对六足机器人爬行特性，设计提出一种包括足端垂直与地面抬起及下落阶段、抛物线摆动阶段、平稳支撑阶段的足端轨迹曲线；并且各阶段足端轨迹曲线在机体坐标系下，足端位姿、速度、加速度时刻连续，从而保证在关节空间坐标系下，各个关节电机角度、角速度、角加速度时刻连续，使得机器人爬行过程中步态始终保持稳定、连续。本方法仅需使用者给出爬行速度、爬行周期、足底抬起高度信息，就可得到精确平滑的足底轨迹曲线减少了机器人产生侧滑的可能性，增加了机体稳定性，并且在凹凸地面处理上，程序实现较为方便。程序实现较为方便。程序实现较为方便。

【技术实现步骤摘要】
一种基于六次多项式的六足机器人足端轨迹规划方法


[0001]本专利技术属于机器人足端轨迹规划领域，特别涉及一种基于六次多项式的六足机器人足端轨迹规划方法。

技术介绍

[0002]六足机器人在结构上具有较多冗余自由度，能够适应较为复杂地形，在路况复杂的野外行走，完成履带式或轮式所不能完成的非结构性环境中的运输作业任务。在海底环境下这一点尤为明显，海底洋流、视野浑浊、通讯受限、海底地形凹凸不平、淤泥沉积等因素，使得传统履带式或轮式机器人难以胜任水下作业任务。因此对六足机器人的研究具有广阔的应用前景。
[0003]在六足机器人进行工作方法的研究中，首先根据机器人机械结构进行运动学建模，得到机械腿的逆运动学解；之后对其进行运动轨迹进行规划，得到各关节随时间变化曲线；最后控制电机旋转完成工作任务。其中对机械腿的轨迹规划是至关重要的一步，它直接影响机器人爬行的方式，影响爬行过程中的机体的稳定性、关节电机的受力情况、腿臂动作的整体能耗，进一步限制机器人的工作性能及所能适应的环境。
[0004]然而在现有技术中，六足机器人爬行过程中的轨迹规划方法都是针对特定的腿臂机械结构，无法做到通法通解，并且编程复杂，在腿臂机械结构或作业环境发生改变时，很难快速准确的更改相应算法参数。例如，当六足机器人在爬行过程中遇到地面凹陷或者凸起时，按照现有技术的轨迹规划方法，很难快速准确的更改相应算法参数，使其自主适应腿臂机械结构或作业环境发生的改变。
[0005]综上所述，对六足机器人足端进行运动轨迹规划，使六足机器人既能满足爬行任务要求，能在爬行中遇到凹凸不平路面时保持机体平稳，有着重要的实践意义。

技术实现思路

[0006]本专利技术解决的技术问题是：为了解决现有技术中六足机器人运动轨迹规划方法无法在凹凸不平路面时保持机体平稳且可能会对腿部足端进行损坏的缺陷，本专利技术设计一种基于六次多项式的六足机器人足端轨迹规划方法。
[0007]本专利技术的技术方案是：一种基于六次多项式的六足机器人足端轨迹规划方法，包括以下步骤：
[0008]步骤1：在机体坐标系下，将六足机器人单腿足端的运动轨迹分为：足端垂直与地面抬起阶段、抛物线摆动阶段、足端垂直与地面下落阶段和平稳支撑阶段四个阶段，其中足端垂直与地面抬起阶段和足端垂直与地面下落阶段的运动轨迹控制方法相同，同时定义AB段为足端垂直与地面抬起阶段，BCD段为抛物线摆动阶段，C为抛物线最高点；DE阶段为足端垂直与地面下落阶段，EA阶段为平稳支撑阶段；
[0009]步骤2：采用六次多项式，建立几个阶段的轨迹曲线，包括以下步骤：
[0010]步骤2.1：建立足端位置轨迹曲线：其中E(t)表示足端点E在t时刻的位置矩阵；
[0011]步骤2.2：根据上一步骤的轨迹曲线，得到足端速度轨迹曲线为：
[0012]足端加速度轨迹曲线为：
[0013]步骤2.3：根据步骤2.1和步骤2.2的多项式得到足端在某一时刻的某一方向的位置、速度及加速度的约束条件：
[0014][0015]进一步得到A
i
和B
i
矩阵：
[0016][0017]B
i
＝[E
i
(t
i
)
…
V
i
(t
i
)
…
a
i
(t
i
)]T
[0018]步骤2.4：确定A、B、C、D、E五个点具体参数，包括以下内容：
[0019]位置参数表达式：
[0020]速度参数表达式：
[0021][0022]加速度参数表达式：
[0023][0024]时间参数表达式：
[0025][0026]其中，S为步幅，T为爬行周期，X0为初始侧向位置，Z0为触底垂向位置，H_max为最大抬起高度，H_tir为垂直抬起高度，T_tir为垂直抬起时间，V
Bz
为B点z轴方向速度，V
Cy
为C点y轴方向速度，a
Bz
为B点z轴方向加速度，a
Cy
为C点y轴方向加速度，a
Cz
为C点z轴方向加速度，a
Dz
为D点z轴方向加速度；
[0027]步骤2.5：将步骤2.4中的各个表达式代入A
i
和B
i
矩阵，得到各个阶段的变化曲线的参数矩阵，其中：
[0028]足端垂直与地面抬起阶段和足端垂直与地面下落阶段的z轴变化曲线的参数矩阵为：
[0029][0030]B1＝[Z
0 H_tir H_max Z
0 0 0 0]T
[0031]抛物线摆动阶段y轴变化曲线的参数矩阵：
[0032][0033][0034]抛物线摆动阶段z轴变化曲线：
[0035]抛物线摆动阶段z轴变化曲线的参数矩阵与足端垂直与地面抬起阶段和足端垂直与地面下落阶段的z轴变化曲线的参数矩阵相同。
[0036]平稳支撑阶段y轴变化曲线的参数矩阵：
[0037][0038][0039]步骤3：通过步骤2得到ABCDE五个点的变化曲线的参数矩阵，根据公式c
i
'＝A
i
'B
i
计算c
i
'，最终得到六足机器人足端的运动轨迹。
[0040]专利技术效果
[0041]本专利技术的技术效果在于：
[0042](1)提供了一种较为通用的六足机器人足端轨迹规划算法，仅需使用者给出爬行速度、爬行周期、足底抬起高度信息，就可得到精确平滑的足底轨迹曲线。
[0043](2)将运动过程分为四个阶段，利于分时段改变算法参数，提高算法灵活性，使其适应多种地形。
[0044](3)由于垂直落地的存在，减少了机器人产生侧滑的可能性，增加了机体稳定性，并且在凹凸地面处理上，程序实现较为方便。
[0045](4)以六次方程作为轨迹曲线，减少了足底坐标运算的复杂度，提高了工程实现的实时性，且易于根据腿臂机械结构和作业环境的改变而修改。
附图说明
[0046]图1为本专利技术提出的机体坐标系下单腿足端空间运动轨迹示意图
[0047]图2为单纯抛物线突起地面足端空间运动轨迹示意图
[0048]图3为单纯抛物线凹陷地面足端空间运动轨迹示意图
具体实施方式
[0049]在本专利技术的描述中，需要理解的是，术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”、“顺时针”、“逆时针”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本专利技术和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本专利技术的限制。
[0050]参本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于六次多项式的六足机器人足端轨迹规划方法，其特征在于，包括以下步骤：步骤1：在机体坐标系下，将六足机器人单腿足端的运动轨迹分为：足端垂直与地面抬起阶段、抛物线摆动阶段、足端垂直与地面下落阶段和平稳支撑阶段四个阶段，其中足端垂直与地面抬起阶段和足端垂直与地面下落阶段的运动轨迹控制方法相同，同时定义AB段为足端垂直与地面抬起阶段，BCD段为抛物线摆动阶段，C为抛物线最高点；DE阶段为足端垂直与地面下落阶段，EA阶段为平稳支撑阶段；步骤2：采用六次多项式，建立几个阶段的轨迹曲线，包括以下步骤：步骤2.1：建立足端位置轨迹曲线：其中E(t)表示足端点E在t时刻的位置矩阵；步骤2.2：根据上一步骤的轨迹曲线，得到足端速度轨迹曲线为：足端加速度轨迹曲线为：步骤2.3：根据步骤2.1和步骤2.2的多项式得到足端在某一时刻的某一方向的位置、速度及加速度的约束条件：进一步得到A
i
和B
i
矩阵：B
i
＝[E
i
(t
i
)
ꢀ…ꢀ
V
i
(t
i
)
ꢀ…ꢀ
a
i
(t
i
)]
T
步骤2.4：确定A、B、C、D、E五个点具体参数，包括以下内容：位置参数表达式：速度参数表达式：
加速度参数表达式：时间参数表达式：其中，...

【专利技术属性】
技术研发人员：李乐，徐景明，戴祯，刘卫东，高立娥，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：