一种足式机器人动力学建模的混合计算方法

摘要

本发明提供一种足式机器人动力学建模的混合计算方法，通过预先存储的足式机器人的基本物理参数，对足式机器人各个关节的角度和角速度进行采样，获得采样反馈的采样数值；根据采样数值计算出坐标旋转的转移矩阵；根据基本物理参数，根据拉格朗日方法中对惯性矩阵的计算方法，对每个连杆的惯性矩阵进行推导，通过矩阵求和的方式获得足式机器人的惯性矩阵；根据采样数值、基本物理参数，在牛顿欧拉方法的基础上进行改进，通过迭代计算，获得足式机器人的离心力、科里奥利力和重力的相关向量，以完成足式机器人的动力学建模，综合拉格朗日方法和牛顿欧拉方法各自的计算优点并在不同阶段加以修改，提高动力学建模计算效率。