申请/专利权人：北京理工大学

申请日：2023-02-09

公开（公告）日：2023-05-09

公开（公告）号：CN116088554A

主分类号：G05D1/08

分类号：G05D1/08

优先权：

专利状态码：在审-实质审查的生效

法律状态：2023.05.26#实质审查的生效;2023.05.09#公开

摘要：本发明公开了仿人机器人动态奔跑运动在线规划方法，仿人机器人在开始奔跑与结束奔跑阶段，在双脚支撑状态与单脚支撑的周期奔跑状态相互切换过程中，利用非线性规划优化得到状态切换过程期望ZMP轨迹，实现状态切换过程质心轨迹的平滑过渡；周期奔跑运动时，加速减速切换过程中，利用迭代优化计算合适的落脚点，实现对期望速度的准确跟踪。本发明不仅能够精确跟随期望速度，而且能够实现奔跑全过程运动在线规划，显著提升仿人机器人的动态运动能力。

主权项：1.仿人机器人动态奔跑运动在线规划方法，其特征在于：1奔跑运动开始时，仿人机器人从静止的双脚支撑状态向单脚支撑的周期奔跑运动状态切换，记作状态切换①，完整的状态切换过程包含双脚支撑期和第一个单脚支撑期，该过程规划的质心高度轨迹为： 其中：状态切换的总时长为T+Tsup，T为双脚支撑期的时长，Tsup为第一个单脚支撑期的时长，为状态切换过程的质心高度轨迹，t为状态切换过程中的任意时刻，表示求解6次多项式方程系数的方程，且q＝0,1,…,6；为双脚支撑期质心高度，zlow为单脚支撑期质心的最低下蹲高度，zto为起飞时刻质心的高度，为起飞时刻质心的速度，g为重力加速度，且g＝9.81ms2；由状态切换过程中的质心高度及其加速度构建的非线性规划问题为： 利用非线性规划求解器求解优化变量ΔTi、的最优解，进而得到分段3次多项式的系数b1,j，b2,j，…,bN,j，将其代入到ysw1t中，得到状态切换过程中的ZMP轨迹；其中：ΔTi为双脚支撑期T内ZMP轨迹第i个分段的时长，为分段点处ZMP的位置，为分段点处ZMP的速度，ysw1t为状态切换①过程y轴方向的ZMP轨迹，y0为状态切换①双脚支撑期开始时刻ZMP在y轴上的分量，y1为状态切换①双脚支撑期结束时刻ZMP在y轴上的分量，b1,j，b2,j，…,bN,j为状态切换①过程中每一个分段ZMP轨迹规划的3次多项式的系数，Γ·为计算3次多项式系数的函数，Ξ为三对角矩阵，为状态切换①过程的质心轨迹，为状态切换①初始时刻的质心位置，为y轴方向初始的期望质心位置，为状态切换①初始时刻的质心速度，为状态切换①结束时刻的质心速度，为第一个单脚支撑期起飞时刻的参考质心速度；奔跑运动结束时，仿人机器人从单脚支撑的周期奔跑运动状态向双脚支撑状态切换，记作状态切换③，完整的状态切换过程包含最后一个单脚支撑期和双脚支撑期，该过程规划的质心高度轨迹为： 构建的非线性规划问题为： 进而确定优化变量的最优解，再确定状态切换过程③的ZMP轨迹；其中：ysw3t为状态切换③过程y轴方向的ZMP轨迹，y2是状态切换③双脚支撑期开始时刻ZMP在y轴上的分量，y3是状态切换③双脚支撑期结束时刻ZMP在y轴上的分量；d1,j，d2,j，…,dN,j为状态切换③过程中每一个分段ZMP轨迹规划的3次多项式的系数，为状态切换③过程的质心轨迹，为状态切换③开始时刻期望的质心位置，为状态切换③开始时刻的参考质心速度；2周期奔跑运动中加速减速切换过程中，记作状态切换②，利用迭代优化确定合适的落脚点，实现对期望速度的准确跟踪当机器人接收到期望速度指令，任意给定下一个支撑相的初始落脚点，从而得到下一个奔跑步态周期的ZMP轨迹，利用求解对应的质心轨迹cx；比较质心轨迹衔接点的质心位置误差，若误差的绝对值不大于设定的容差，则初始给定的落脚点即是目标落脚点；若误差的绝对值大于容差，将误差作为反馈量叠加给初始给定的落脚点，对初始给定的落脚点进行更新，将更新后的落脚点作为初始落脚点，重复上述过程，得到合适的目标落脚点位置；其中为修改后的三对角矩阵，为修改后的ZMP轨迹。

全文数据：

权利要求：

百度查询： 北京理工大学 仿人机器人动态奔跑运动在线规划方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD