US 12,138,802 B1
Kinematics modeling method, apparatus and device for multi-degree-of-freedom mechanism and storage medium
Jian Gao, Guangzhou (CN); Disai Chen, Guangzhou (CN); Yuheng Luo, Guangzhou (CN); Lanyu Zhang, Guangzhou (CN); Zhuojun Zheng, Guangzhou (CN); Guoqing Wu, Guangzhou (CN); and Xin Chen, Guangzhou (CN)
Assigned to GUANGDONG UNIVERSITY OF TECHNOLOGY, Guangzhou (CN)
Filed by GUANGDONG UNIVERSITY OF TECHNOLOGY, Guangzhou (CN)
Filed on Jul. 10, 2024, as Appl. No. 18/769,309.
Application 18/769,309 is a continuation of application No. PCT/CN2023/122593, filed on Sep. 28, 2023.
Claims priority of application No. 202310265164.6 (CN), filed on Mar. 20, 2023.
Int. Cl. B25J 9/16 (2006.01)
CPC B25J 9/1664 (2013.01) [B25J 9/1607 (2013.01); B25J 9/163 (2013.01)] 3 Claims
OG exemplary drawing
 
1. A kinematics modeling method for a multi-degree-of-freedom mechanism, comprising the following steps of:
using three linear axes of the multi-degree-of-freedom mechanism as a whole to construct a point coordinate system, and constructing a transformation matrix of the point coordinate system based on a homogeneous linear equation set;
respectively constructing transformation matrices of two rotating axes;
constructing a transformation matrix from an end-effector coordinate system of the multi-degree-of-freedom mechanism to a workpiece coordinate system;
constructing a forward kinematics model based on the transformation matrix of the point coordinate system, the transformation matrices of the two rotating axes and the transformation matrix from the end-effector coordinate system to the workpiece coordinate system; and
solving a value of a rotating axis motor through a rotation matrix at the end-effector of the multi-degree-of-freedom mechanism by an attitude representation method, using a translation matrix at the end-effector of the multi-degree-of-freedom mechanism as a non-homogeneous linear equation set, and solving a value of a linear axis motor through a Cramer rule to obtain an inverse kinematics model; wherein,
the using the three linear axes of the multi-degree-of-freedom mechanism as a whole to construct the point coordinate system, comprises:
integrating the three linear axes of the multi-degree-of-freedom mechanism into a whole, and placing a coordinate system on the whole, wherein an origin of the coordinate system coincides with an origin of a coordinate system of an adjacent rotating axis in a direction parallel to a base coordinate system;
the respectively constructing the transformation matrices of the two rotating axes, comprises:
when the multi-degree-of-freedom mechanism is a mechanism translated first and then rotated, using three rotation matrices to construct a transformation matrix of a first rotating axis, and determining a transformation matrix of a second rotating axis based on the modeling method; and
when the multi-degree-of-freedom mechanism is a mechanism rotated first and then translated, using the three rotation matrices to construct the transformation matrix of the second rotating axis, and determining the transformation matrix of the first rotating axis based on the modeling method;
the constructing the forward kinematics model based on the transformation matrix of the point coordinate system, the transformation matrices of the two rotating axes and the transformation matrix from the end-effector coordinate system to the workpiece coordinate system, comprises:
when the multi-degree-of-freedom mechanism is the mechanism translated first and then rotated, sequentially subjecting the transformation matrix of the point coordinate system to right multiplication by the transformation matrix of the first rotating axis, the transformation matrix of the second rotating axis and the transformation matrix from the end-effector coordinate system to the workpiece coordinate system to obtain the forward kinematics model; and
when the multi-degree-of-freedom mechanism is the mechanism rotated first and then translated, sequentially subjecting the transformation matrix of the point coordinate system to left multiplication by the transformation matrix of the second rotating axis and the transformation matrix of the first rotating axis, and then to right multiplication by the transformation matrix from the end-effector coordinate system to the workpiece coordinate system to obtain the forward kinematics model.