一种足式机器人运动轨迹规划方法、系统、设备及终端技术方案

本发明专利技术属于机器人技术领域，公开了一种足式机器人运动轨迹规划方法、系统、设备及终端，包括：上层全局无碰撞轨迹生成，中层非线性动力学轨迹优化，底层模型预测控制期望状态轨迹跟踪；上层模块在全局障碍地图上快速生成一条机器人质心运动的粗糙多项式轨迹，包含机器人运动的平面位置[x，y]、方向角θ以及轨迹时间T；中层模块根据初始轨迹和机器人动力学，构建非线性优化问题，优化指标包括：避障代价、状态轨迹平滑度、机器人动力学限制、足式机器人全向运动约束和轨迹时间代价，优化变量为分段表达的轨迹多项式系数以及时间；底层模块将优化的轨迹作为非线性模型预测控制器的期望质心时空状态轨迹，进行机器人的具体运动控制。

【技术实现步骤摘要】

本专利技术属于机器人，尤其涉及一种足式机器人运动轨迹规划方法、系统、设备及终端。

技术介绍

1、足式机器人是仿生机器人，模仿自然界中有足类哺乳动物的运动，例如人类、猫科动物等，足式机器人拥有全向运动能力和复杂地形的通过能力。现如今，足式机器人的本体运动控制具有较高水准，具备了一定的实际动物运动能力，例如平移运动、转向运动、跳跃、崎岖地面行走，但是大部分的运动控制涉及的都是单一运动模式，真实世界中动物的灵活运动是各种运动模式的组合，当前的各种运动控制器距离实现动物的敏捷运动还有一段距离。

2、模型预测控制器被广泛应用于具有无碰撞约束条件的足式机器人运动控制中，来实现机器人的导航规划。但是模型预测控制器的预测周期极大地影响了控制效果，长预测周期导致求解花费的时间长，短预测周期易使优化求解陷入局部最优。基于学习的方法能够实现机器人的实时导航，但是需要预训练或使用数据集。这些数据集主要是在模拟环境中获取的，在实际环境中使用时会出现差异，而真实世界数据集的制作成本非常大。使用传统的基于采样或者搜索的路径规划方法生成的轨迹难以符合足式机器人复杂的动力学模型本文档来自技高网...

【技术保护点】

1.一种足式机器人运动轨迹规划方法，其特征在于，所述足式机器人的运动轨迹规划方法有三层，分别为：

2.如权利要求1所述的足式机器人运动轨迹规划方法，其特征在于，上层全局无碰撞轨迹生成中，规划的机器人状态为平面位置和方向角[x，y，θ]，将给定的均匀空间离散为g×g个网格，将每个网格与对应的状态P2D(idx，idy)＝[x，y，θ]关联，采样策略为：

3.如权利要求1所述的足式机器人运动轨迹规划方法，其特征在于，足式机器人可以全向运动，所以状态量[x，y，θ]分开考虑，将两个状态点的连接构建为一个最优边界值问题，初始状态给定为si＝[spi，svi]，是父节点的状...

【技术特征摘要】

1.一种足式机器人运动轨迹规划方法，其特征在于，所述足式机器人的运动轨迹规划方法有三层，分别为：

2.如权利要求1所述的足式机器人运动轨迹规划方法，其特征在于，上层全局无碰撞轨迹生成中，规划的机器人状态为平面位置和方向角[x，y，θ]，将给定的均匀空间离散为g×g个网格，将每个网格与对应的状态p2d(idx，idy)＝[x，y，θ]关联，采样策略为：

3.如权利要求1所述的足式机器人运动轨迹规划方法，其特征在于，足式机器人可以全向运动，所以状态量[x，y，θ]分开考虑，将两个状态点的连接构建为一个最优边界值问题，初始状态给定为si＝[spi，svi]，是父节点的状态，终止状态为sf＝[spf，svf]，终止位置是子节点的位置，终止速度由求解得到，优化整个状态轨迹的能量j(t)＝∫0tsa(t)2dt最小(即加速度积分最小)，使用庞德里亚金极大值原理，得到状态估计的显示解为：

4.如权利要求1所述的足式机器人运动轨迹规划方法，其特征在于，非线性动力学轨迹优化中，优化指标包括：状态轨迹的平滑性代价，权重为λs、状态轨迹距离障碍物的代价权重为λc和...

【专利技术属性】
技术研发人员：朱力军，张文涛，徐兆辉，许绍航，蔡培原，
申请(专利权)人：华中科技大学，
类型：发明
国别省市：