Inverse Displacement Analysis of a General 6R Manipulator Based on the Hyper-chaotic Least Square Method

The hyper‐chaotic least square method for finding all real solutions of nonlinear equations was proposed and the inverse displacement analysis of a general 6R manipulator was completed. Applying the D‐ H method, a 4 4  matrix transform was obtained and the first type twelve constrained equations were established. Analysing the characteristics of the matrix, the second type twelve constrained equations were established by adding variables and restriction. Combining the least square method with hyper‐chaotic sequences, the hyper‐chaotic least square method based on utilizing a hyper‐chaotic discrete system to obtain and locate initial points to find all the real solutions of the nonlinear questions was proposed. The numerical example was given for two type constrained equations. The results show that all the real solutions have been obtained, and it proves the correctness and validity of the proposed method.


Introduction
The inverse displacement analysis of a robot plays an important role in robotics, which is directly related to the problems of the off-line programming, trajectory planning and real-time control. It is most difficult in relation to inverse displacement analysis on a general space 6R manipulator. This issue with the 6R mechanism belongs to the same problem, which has been called the Mount Everest of the position analysis on a space mechanism [1]. In 1973, J. Rastegar and V. Scheinman [2] pointed out that the number of the solutions was up to 32 in the inverse displacement analysis of a general 6R serial robot. In 1985, L. W. Tsai and A. P. Morgan [3] simplified the above problem in eight quadratic equations using the high dimensional approximation analysis on the inverse kinematics problem and carried out the numerical solution adopting a polynomial continuous method, and then speculated as to the conclusion that the solution number is up to 16 on a variety of different structures of 6R robot. In 1989, M. Raghavan and B. Roth [4] made use of the nature of the rationale generated by using the separation elimination method and multi-variable equations, and calculated a 16th degree polynomial from the half-angle tangent formula of the joint variables. In 1991, C. Wampler and A. P. Morgan [5] proposed that all the cases involving the inverse displacement problem were only solved using the extension method, but the algorithm based on the extension method ran very slowly. From 1990 to 1992, M. Raghavan and B. Roth [6][7][8] first proposed a method solving the characteristic polynomial of the general 6-DOF manipulator, including all the special circumstances of 6R, 5R1P, 4R2P, 3R3P, and with the aim of solving all of the 6-DOF robot mechanism. In 1991, C. W. Wampler and A. P. Morgan [9] completed the 6R inverse position problem using a generic-case solution methodology with 11 polynomial equations. In 1993, D. Kohli and M. Osvatic [10] used the product of the powers and the elimination method to obtain a set of equations containing 16 16  matrix coefficients, and to directly have 16th degree polynomials of no extraneous roots,since the solution to the problem can be simplified to the eigenvector problem. In the same year, D. Manocha and J. F. Canny [11] made use of the symbol processing and matrix computation to transform this problem into the decomposition problem of the matrix to be calculated, and solved the matrix eigenvalues and eigenvectors to obtain the robot joint variables. However, the algorithm finally computed the 24th-order square matrix to solve 24 solutions, including extraneous roots rather than directly the 16 solutions. In 1999, H. J. Su et al. [12] proposed an algorithm based on algebraic elimination to solve the robot inverse kinematics. The method can get a one-variable equation with one joint variable first of all, which greatly reduces the computation procedure of the real-time iterative. However, the algorithm needs to expand the determinant polynomial to solve 16th degree polynomials. A slower computing speed and may occur and cause problems when calculating the polynomial. Y. Q. Yu [13] solved the inverse kinematics problem of a general 6R serial robot and simulated the robot motion by using VC++ with OpenGL in 2003, but there was a poor consequence upon the real-time reverse problem. How to quickly find all the real solutions is important to the research of the mechanism, but it is also one of the basic problems for the general 6R and 7R robot mechanisms.
The research into chaos is one of the important achievements of the 21st century. How to utilize chaotic characteristics is one of the important works of the modern mechanism of research. I have solved the forward displacement problem of 6-RPS in the real area using the chaotic method in [14]. With this method, it advances that the points of a Julia set, which are generated by the Newton iteration method, will appear in the neighbourhood where the Jacobian matrix of the solving equations is equal to zero. However, this supposition has not been proven, and the process for solving the multivariable Jacobian matrix is very complex. The chaotic sequence method is new, in which the initial point of the Newton iteration is generated using the chaotic and hyper-chaotic system and all the real solutions on the mechanism synthesis can be effectively solved [15][16][17]. When the solutions are not in convergence using Newton method or a quasi-Newton method, the mathematical programming method can be adopted [18]. However, its computational efficiency is very low for the process of solving the inverse kinematics problem of a 6R mechanism by using the mathematics quadratic programming method based on hyper-chaos. With the Newton iteration method, the requirement for the initial value is high. However, the least square method can expand the selected scope of the initial value, and it can sometimes make one initial value convergence while Newton method cannot. For these reasons, combining the least square method with hyper-chaotic sequences and utilizing the initial value that was iterated in the least square method based on hyper-chaotic Hénon mapping, the inverse kinematics problem of a general 6R mechanism was solved in this paper. The example provided shows that the method proposed in this paper is verified as correct and effective.

Hénon hyper-chaotic system
The Lyapunov exponent is one of the effective methods depicting the chaos-specific property of nonlinear systems. If one of the Lyapunov exponents is positive, the system is chaotic, and if a system has two or more positive Lyapunov exponents, the system is hyperchaotic. The greater the number of the positive Lyapunov exponents, the higher the degree of instability in the system [19]. In general, if the systematic state variable number is higher, it probably appears that the unsteady level is also higher.
A general Hénon mapping was designed [20] as follows: where,  expresses the dimension of the system, k is the discrete time, and a and b are adjustable parameters. When i=2, the above mapping is the famous Hénon mapping. When fixed parameters a=1.76 and b=0.1, and the dimensions vary from 2 to 10, after computing, it was found that by increasing 1 n , the simple relation of the number n of the positive Lyapunov exponents with the system dimension 1 n is 1 1 n n   in [20] -namely, when a system dimension is the larger of two, the system is hyperchaotic. For n>10, a simulation study was conducted [18] which also obtained the same result.

The least squares method in nonlinear equations
The nonlinear equation is expressed as: Its solution is written in , the least squares iterative method can be described as follows, roughly: (1) To select the initial value 0 x (2) To take the iteration according to Eq. (3) Although T k k J J is always symmetric, positive and semidefinite, it seems that usually there exists the inverse matrix is so small that there exists a serious ill-conditioned problem. Many scholars have put forward improved algorithms, and the most well-known of these is the damped least square method, also known as the L-M method. Recently, a Chinese scholar, C. X. Zhan, proposed a new method called the C. X. Zhan method in a paper. With the new method, computational efficiency is better than with the L-M method, and the convergence rate is faster. So far, this method is the best for solving the least squares problems, and it is adopted in this paper. Its basic steps are as follows: Firstly, it is assumed that L is a lower triangular matrix, and k D is a diagonal matrix). Secondly, Eq.
(3) is rewritten as Thirdly, after increasing the damping to k D , the iterative equation based on the C. X. Zhan method is expressed as: where I is the n -order unit matrix, and k  is the damping factor where 0 k   . The selection of the damping factor and the convergence criteria isseen in [21].

The hyper-chaotic least square method in nonlinear equations
Using the least square method based on a hyper-chaotic system, the process for finding all of the solutions of nonlinear equations is as follows: (1) By Eq. (1), to construct the chaos set 0 ( 1, )  , 1 n  is the variable number of hyper-chaotic system, n is the number of the positive Lyapunov exponents and is also the number of variables.
，where N is the length of the chaos set), and obtain 0 ( , ) i j x ; (2) To take the jth chaotic sequence 0 (:, ) j x as the initial value of the least square iterative method, Eq. (3) has been iterated j times to find all of the solutions * x in Eq.(2).

The mathematical model
According to the structural parameters of the roboti.e.the D-H parameters -and the link coordinate system, the general 6R robot kinematics can be described as: where i A is a 4 4  homogeneous transformation matrix from the ith link coordinate system to the ( 1) i th  coordinate system; A is a homogeneous transformation matrix from the coordinate system of the robot end to one of the base.

Numerical example
Given the mechanism parameters shown in Tab.1 and the pose of the end, as follows:

Conclusions
Applying the D-H method, a 4 4  transform matrix was obtained and the first type twelve constrained equations were established. Then, using the characteristics of the matrix after transforming, six constraint equations were established. Six supplement equations were also established by increasing six variables and the relation of the sine and cosine functions, and the second type of twelve constrained equations for the position analysis were established. Combining the least square method with hyper-chaotic sequences, a hyper-chaotic least square method based on utilizing a hyper-chaotic discrete system to obtain and locate initial points to find all the real solutions of the nonlinear questions was proposed, and the calculation steps solving the inverse displacement analysis of 6R manipulator containing two types of constrained equations were given. Two types of constraint equations can be solved, but the second type of constraint equation has a high efficiency. This method solved the problem that it is divergent when utilizing a Newton iterative method based on chaos and hyperchaos, the quasi-Newton method, and the hyper-chaotic mathematical programming method. The numerical example shows that this new method is correct and effective. Using this method in the real area, it is more efficient and the result is the same as the homology analysis method. The new method provided in this paper is also suitable for solving the inverse displacement analysis of 7R manipulator.

Acknowledgments
This research is supported by the National Natural Science Foundation of P.R. China (No:51075144), the grant of the 12th Five-Year Plan for the construction program of the key discipline (Mechanical Design and Theory) in Hunan province.