[发明专利]一种双足机器人逆运动学的几何计算方法

摘要

本发明涉及一种双足机器人逆运动学的几何计算方法，所述方法包括建立双足机器人的运动模型，其运动模型包括躯体位置rbody(n)运动描述、脚部位置rfoot(n)运动描述以及腿部位置运动描述，进而基于所述躯体位置rbody(n)运动描述、脚部位置rfoot(n)运动描述分别求取双足机器人运动过程中髋关节rhip(n)位置和踝关节位置rankle(n)，通过双足机器人运动过程中腿部关节间的几何关系，求取双足机器人腿部关节执行器位置及相对角度，最终依据机器人运动过程中关节执行器控制角度的参考方向，确定逆运动学求解的关节执行器角度Q(n)。本发明在三维机器人逆运动学计算中采用低维矩阵组织运算，减少了逆运动学解算的运算量，适用于机器人运动优化过程中需要大规模并行计算的场合。