| Summary: | Task and Motion Planning for a 7-DOF serial robot containing only revolute joints needs a fast and numerically stable inverse kinematics solution. The analytical methods are real-time, but they are robot dependent. Although the numerical methods based on inverse differential kinematics can solve the inverse kinematics problem (IKP) of 7R robots with arbitrary geometric parameters, their numerical stability is insufficient. Moreover, it is time-consuming for them to converge to a single solution that depends on the initial guess. The main innovation of this article is the development of a practical method for solving the IKP of general 7R robots. The proposed method can find multiple solutions and is also faster than the numerical method. It combines symbolic preprocessing, Sylvester dialytic elimination, and eigendecomposition. First, according to the Denavit-Hartenberg convention of geometric representation, a general kinematics model of a 7R manipulator is established. Secondly, the joint variables are separated by symbolic preprocessing, and then two symbolic matrices are obtained. After numerical substitution, a square matrix of polynomial coefficients is computed through Gaussian and Sylvester dialytic elimination. Finally, utilizing the eigendecomposition of the matrix restructured from the square matrix, the values of some variables are obtained, and then the remaining variables are solved by back-substitution. The simulation and experimental data are analyzed. The comparison results verify that the proposed method applies to solving the IKP of general 7R robots and is almost real-time, effective, and numerically stable.
|
|---|