Total centroid state estimation method, humanoid robot and computer readable storage medium using the same
Abstract:
A total centroid state estimation method as well as a humanoid robot and a computer readable storage medium using the same are provided. The method includes: obtaining a motion state of each real joint of the humanoid robot and a motion state of its floating base, where the floating base is equivalent to a plurality of sequent-connected virtual joints; calculating a joint position, a centroid position, and a rotation matrix of each link in the world coordinate system in sequence using the chain rule of homogeneous multiplication according to the position of the joint corresponding to the link to solve a Jacobian matrix of the centroid of the link; solving a total centroid Jacobian matrix based on the Jacobian matrix of the centroid of each link and the total mass; and calculating the total centroid velocity based on the total centroid Jacobian matrix and other parameters.
Information query
Patent Agency Ranking
0/0