[发明专利]一种液压驱动并联结构的控制方法与装置

摘要

本发明公开了一种液压驱动并联结构的控制方法及装置，获取机器人足部的俯仰角位移量和滚转角位移量；根据俯仰角位移量和滚转角位移量构建机器人的足部旋转矩阵；基于足部旋转矩阵计算液压缸在转动后两端部的坐标值；基于每个液压缸在转动后两端部的坐标值计算转动后液压缸的第一长度，并根据第一长度和液压缸初始长度计算液压缸的伸长量，得到伸长量与角位移量的第一关系式；本发明通过建立足心坐标系，并将踝关节各个关键点的坐标值和足部的俯仰角位移量与滚转角位移量相结合，以计算得到旋转轴踝关节液压缸的长度，最终通过液压缸长度变化量对液压缸进行调节，可以解耦机器人踝关节的俯仰和滚转两自由度运动能力。