Invention Grant
- Patent Title: Total centroid state estimation method, humanoid robot and computer readable storage medium using the same
-
Application No.: US17485412Application Date: 2021-09-25
-
Publication No.: US11872701B2Publication Date: 2024-01-16
- Inventor: Xiaozhu Ju , Yuesong Wang , Mingguo Zhao , Youjun Xiong
- Applicant: UBTECH ROBOTICS CORP LTD
- Applicant Address: CN Shenzhen
- Assignee: UBTECH ROBOTICS CORP LTD
- Current Assignee: UBTECH ROBOTICS CORP LTD
- Current Assignee Address: CN Shenzhen
- Priority: CN 2011535826.X 2020.12.23
- Main IPC: B25J9/16
- IPC: B25J9/16

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.
Public/Granted literature
Information query
IPC分类: