The closed-loop kinematics modeling and numerical calculation of the parallel hexapod robot in space

Transcription

1 Special Issue Article The closed-loop kinematics modeling and numerical calculation of the parallel hexapod robot in space Advances in Mechanical Engineering 017, Vol. 9() 1 15 Ó The Author(s) 017 DOI: / journals.sagepub.com/home/ade Long Bai 1, Zhi-Feng Dong 1 and Xin-Sheng Ge Abstract The Lie group Denavit Hartenberg method and application in the parallel hexapod robot are researched. The hexapod robot and the ground form opened and closed loop alternately; the complete kinematics equation cannot be derived by Denavit Hartenberg method with a trigonometric function type. The complete kinematics model of the hexapod robot is constructed with the improved Denavit Hartenberg method. The numerical solving strategy is schemed. The simulation results provide the positive and athwart kinematics response relation during the lift and forward patterns in space. The research shows that the complete kinematics model can be constructed by the Lie group Denavit Hartenberg method; the numerical calculation method can solve the pose attitude response correctly. Keywords Parallel hexapod robot, kinematical modeling, numerical calculation, Denavit Hartenberg method, Lie group Date received: August 016; accepted: 11 December 016 Academic Editor: Yangmin Li Introduction Wheel, track, and leg are the three moving modes of the mobile robot. The foot-type robot has a higher terrain adaptive capacity because of the discrete contract with the ground. 1 Compared with the biped and quadruped robot, the parallel hexapod robot has a low gravity center and more supporting points, so it has a higher stability and higher bearing capacity, which has a wide application prospect. It is the best choice in a complex working environment such as the industry, mining, and mountain area. Recently, the exploration about the gait planning, control, and stability analysis of the hexapod robot is proceeding vastly, which is significant to the design and the improvement of the hexapod robot. The parallel hexapod robot consists of many rods which are connected together by the joints. It is a complex closedloop kinematics system. The gait leads to the variation in the topological relation of the parallel hexapod robot, so the body, leg, and ground form whole parallel mechanism and portion parallel mechanism continuously. The analysis method of the parallel hexapod robot is similar to the method of the parallel mechanism. 3 The basis for the exploration of the parallel hexapod is the establishment of the coordinate connection of the elements which are interconnected. The coordinate relations can be divided into the local coordinates of the leg and the whole coordinate connection includes the ground, body, and the leg. Based on the local coordinates of the leg, many explorations about the design, 1 School of Mechanical Electronic & Information Engineering, China University of Mining & Technology, Beijing, Beijing, China School of Mechanical & Electrical Engineering, Beijing Information Science & Technology University, Beijing, China Corresponding author: Long Bai, School of Mechanical Electronic & Information Engineering, China University of Mining & Technology, Beijing, Beijing , China. bailong0316jn@16.com Creative Commons CC-BY: This article is distributed under the terms of the Creative Commons Attribution 3.0 License ( which permits any use, reproduction and distribution of the work without further permission provided the original work is attributed as specified on the SAGE and Open Access pages ( open-access-at-sage).

2 Advances in Mechanical Engineering kinematics, dynamics, and stability of the hexapod robot are completed. Y Zhu et al. 4 completed the optimum structural design of the hexapod robot with the model of the leg. Y Rong et al. 5,6 completed the mechanical design, the conformational analysis, and the parameter determination of the leg. Z Deng and Y Liu 7 completed the length proportion exploration of the leg segments. G Chen et al. 8 completed the fixed radius turning gait exploration based on the partial model of the body and the leg. Manoiu-Olaru 9 completed the static stability of the hexapod robot under different displacements and different attitudes of the leg. P Yang and F Gao 10 obtained the forward kinematics model of the hexapod robot, and the load performance is analyzed. M Ghayour and A Zareei 11,1 analyzed the forward and inverse kinematics problems of the hexapod robot with the geometry method. L Vladareanu and A Curaj 13 explored the forward and inverse kinematics problem of the leg with 6 degrees of freedom. Except the local coordinates, the global coordination connection of the whole machine is important for exploration of the hexapod robot. For example, the harmonize gait planning and the stability. Most of the modeling methods are based on the trigonometric function; the complex expression and the calculation process lead to the difficulty for the construction of the whole coordinated relation of the hexapod robot with the complex space motion. So the exploration for a new modeling method which can solve this problem is the key for the construction of the whole coordinate connection of the hexapod robot. Recently, with the development of the computation geometry mechanics, the Lie group theory which is used in the problems of the dynamic analysis, the kinematic analysis of the space rigid body had gained great achievement. The Lie group theory is also used in the optimal control calculation which means that the Lie group modeling method can make the calculation more accurate. T Lee 14 and T Lee et al. 15 combined the Lie group theory and the discrete variational integrator together and obtained the Lie group discrete variational integrator; the method was used in the dynamics exploration of the 3D rigid pendulum. N Nordkvist and AK Sanyal 16 used the Lie group discrete variational integrator to solve the optimal control problem of the underwater vehicle. XL Ding and Y Liu 17 used the Lie group and Lie algebra in the dynamics exploration of the flexibility rod robot. With the common Denavit Hartenberg (D H) method, the kinematics model which can be solved for the complex parallel mechanism cannot be obtained. Practically, the D H method in space is a type of homogeneous matrix method, which can also be called as the quaternion matrix method; the rotation elements and the displacement elements are mixed operated; and the orthogonal property of the rotation matrix cannot be used. With the triangle functions as the calculation elements, the triangle and the inverse trigonometric transformations certainly exist during the derivation; the singularity of the triangle functions will make the kinematic model not be solved numerically. Even if the pose and attitude relations are obtained, the following velocity and acceleration derivations are difficult to proceed, and the primary cause is also the complexity which is induced by the repeat triangle function transformations. However, the Lie group D H method uses the orthogonal matrix to express the rotation part in the D H matrix, and the matrix with the special orthogonal character is called the Lie group. This orthogonal matrix has an exponent mapping relation with the rotation angles. So the original quaternion matrix using the orthogonal matrix and the vectors as the elements and the modeling process can be simplified vastly. In this article, the space pose and attitude representation method of the single rigid body is explored first, then the D H method is improved by the Lie group theory, and finally, the method is used in the kinematics modeling of the whole parallel hexapod robot. The numerical calculation method is built, and the calculation results are compared with the simulation results by ADAMS, and the correctness of the model is testified. This exploration offers a common mathematical model and a common numerical solving method for the design and gait planning of the parallel hexapod robot. Lie group D H method First, the space rigid body pose and attitude expression method with the Lie group type are introduced, and then the Lie group D H method which is used to express the space orthogonal motion of the joints is brought out. The pose and attitude of the free rigid body can be expressed as the four-dimensional matrix as given in equation (1) T B = R B p B ð1þ In equation (1), p B is the position vector of the original point of the body coordinate system which is expressed in the inertial coordinate system. R B is the attitude matrix which is an orthogonal matrix called as the Lie group. With the concept of Lie group, the solving calculation with no need to consider the concrete triangle function expression of the attitude matrix. The matrix R B satisfies the character as R T R = I. The single-degree-of-freedom rotation of the robot leg s joints can be seen as a reduced form of the threedimensional (3D) space rotation of the abovementioned rigid body, so the D H method based on the traditional triangle function can be transformed to be a Lie group type. The traditional D H method is

3 Bai et al. 3 Figure 1. The pose and attitude relation of the whole body of the hexapod robot. Figure. The coordinate distribution of the different joints on the leg of the hexapod robot. based on the scalar, and every rotation motion and the displacement motion are accomplished along one axis. This conducted alternatively for the rotation and displacement lead to the complexity of the solution. To solve this problem, the D H method is improved; all the displacements along the three axes boil down to one transformation, and then the rotation transform proceeds. The transform matrixes of the displacement and the rotation are given in equation () i 1 T p i = I p, i 1 T R i = R 0 ðþ In equation (), p is the 3D vector; each element of the vector represents the displacement along the x, y-, and z-axes of the coordinate represented by i 1. R is the rotation matrix along each axis. In the parallel hexapod robot, the main transformation is as follows. First, the i 1 coordinate transforms as a displacement vector p, rotates along the x-axis, and then rotates along the z- axis; the rotation matrixes are R x and R z, respectively. The pose and attitude transform matrix between the two coordinates is obtained in equation (3) i 1 T i = R xr z p ð3þ The pose and attitude connection of the whole body under the inertial coordinate The 3D model of the whole body of the hexapod robot is shown in Figure 1. The hexapod robot can be divided into two types of parts on the structure, the body and the leg. The leg can be divided into the hip, the shank, and the thigh. The connection between the ground and the foot tip of the shank can be expressed as F k, k = 1,..., 6 when the foot contacts with the ground, F k 6¼ 0, when separated, F k = 0. Figure expresses the local pose and attitude relation from the body to the foot tip. From this graph, the pose and attitude connection of the whole body should be constructed as follows. First, the pose and attitude relation of the open-loop mechanism needs to be built up, which includes and along the direction of the trunk, the hip, the thigh, and the shank. Second, the drive constraints connection of each component should be built up by the hinge joints pose of the drive cylinders in the inertial coordinate. There are three constraints in the hexapod robot s leg, the hip, the thigh, and the shank. For example, the constraint of the hip joint, which is decided by the distance of the two hinge joints of the drive cylinder of the hip, one is on the trunk and the other is on the hip. Finally, according to the different gait, the foot tip which is in contact with the ground should be fixed, and then the equation which represents the pose and attitude relation between the trunk and the leg can be obtained. With the numerical calculation method, the forward and inverse solution between the trunk and the actuate joints on the legs can be obtained. The open-loop pose and attitude relation of the whole machine The trunk of the hexapod robot has three types of possible motions as pitching, rolling, and yawing, which rotate along the principle axis of the trunk. The kinematics model of the trunk with 6 degrees of freedom should be built up first. According to Figure 1, the trunk can be seen as a free rigid body with 6 degrees of freedom without consideration of the leg. Based on formula (1), the pose and attitude relation of the body frame relative to the inertial frame can be expressed as formula (4)

4 4 Advances in Mechanical Engineering I T B = I R I B p B ð4þ In formula (4), I p B = ½ x y zš T is the position vector of point O B in frame O I x I y I z I. I R B is the rotation matrix. Suppose the position vectors of the six hinge joints of the legs on the trunk body in frame O B x B y B z B are B b k0, k = 1,..., 6. The rotation matrix from O B x B y B z B to O k0 x k0 y k0 z k0 is B R z k0, so the pose and attitude matrix between the frame O k0 x k0 y k0 z k0 and frame O B x B y B z B can be expressed as formula (5) B T k0 = B b k0 B R z k0 ð5þ So the pose and attitude of the hip rotation center O k0 in space can expressed as formula (6) I T k0 = I T B B T k0 ð6þ After the calculation, the rotation matrix and the displacement of the rotation center in space can be derived as formula (7) R 0 = I R B B R z k0 s 0 = I R B B b k0 + I ð7þ p B Point O k8 is fixed on the hip, which is one of the hinge joint of the thigh drive rod. Suppose that the position vector of point in the body frame of the hip is k0 b x k8, the displacement matrix of point O k8 can be expressed as formula (8) k0 T k8 = I k0 b x k8 ð8þ There is no rotation from O k0 to O k8,so k0 R k8 = I. According to k8 T k0 = I T B B T k0 k0 T k8, the position vector of the point in the inertial frame can be derived as formula (9) I s k8 = I R B ( B R z k0 k0 b x k8 + B b k0 )+ I p B ð9þ Supposing the position vector of O k9 in the frame of O B is B b k9 and the rotation matrix of the push rod O k9 O k8 relative to the frame of O B is B R z k9, the pose and attitude matrix of frame O k9 relative to O B is obtained as formula (10) B T k9 = B R z k9 B b k9 ð10þ Then the pose and attitude matrix of the frame relative to the inertial frame is given as formula (11) I T k8 = I T B B T k9 ð11þ The rotation matrix and displacement vector of the push rod of the hip in the inertial frame is given as formula (1), with formula (11) to be expanded R 1 = I R B B R z k9 s 1 = I R B B b k9 + I ð1þ p B Suppose that the position vector of O k8 in the frame of O k9 is k9 l x k8, and there is no rotation between O k8 and O k9,so k9 R k8 = I. The corresponding pose and attitude matrix is given as formula (13) k9 T k8 = I k9 l x k8 ð13þ The pose and attitude matrix of the push rod O k9 O k8 in frame O I x I y I z I is given as formula (14) I T k8 = I T B B T k9 k9 T k8 ð14þ Then the position vector of O k8 in the space is given as formula (15) according to formula (14) I s k8 = I R B ( B R z k9 k9 l x k8 + B b k9 )+ I p B ð15þ According to the sequence of the displacement as k0 b k4 first and then rotating along x-axis and z-axis, the rotation matrixes are k0 R x k4 and k0 R z k4 ; the pose and attitude transformation matrix from O k0 to O k4 is given as formula (16) k0 T k4 = k0 R x k4 k0 R z k4 k0 b k4 ð16þ The pose and attitude matrix of the point in the space is given as formula (17) I T k4 = I T B B T k0 k0 T k4 ð17þ The rotation attitude and displacement vector of the push rod of the thigh rotate along the point of O k4 in the inertial frame as given in formula (18) R = I R B B R z k0 k0 R x k4 k0 R z k4 s = I R B ( B R z k0 k0 b k4 + B b k0 )+ I ð18þ p B Suppose that the position vector of point O k6 in frame O k4 is k4 l x k6, and there is no rotation, so k4 R k6 = I, and the corresponding pose and attitude matrix is given as formula (19) k4 T k6 = I k4 l x k6 ð19þ Then the pose and attitude matrix of the inertial frame is given as formula (0) I T k6 = I T B B T k0 k0 T k4 k4 T k6 ð0þ

5 Bai et al. 5 The position vector of point O k6 in the inertial frame is given as formula (1) after the calculation of formula (0) I s k6 = I R B B R z k0 (k0 R x k4 k0 R z k4 k4 l x k6 + k0 b k4 )+ B b k0 + I p B ð1þ The conversion process from O k0 to O k1 is as follows. It moves along k0 b k1 first and then rotates as k0 R x k1 and k0 R z k1, and the pose and attitude transformation matrix correspondent to it is given as formula () k0 T k1 = k0 R x k1 k0 R z k1 k0 b k1 ðþ The pose and attitude matrix of the frame in the inertial frame is given as formula (3) I T k1 = I T B B T k0 k0 T k1 ð3þ The rotation matrix and displacement vector of the thigh rotate along the point of O k1 in the inertial frame as given in formula (4) after the calculation of formula (3) R 3 = I R B B R z k0 k0 R x k1 k0 R z k1 s 3 = I R B ( B R z k0 k0 b k1 + B b k0 )+ I ð4þ p B The transformation process from frame O k1 to frame O k is as follows. Moving as k1 b x k first, it then rotates as k1 R z k, and the pose and attitude transformation matrix is given as formula (5) k1 T k = k1 R z k k1 b x k ð5þ Then the pose and attitude matrix of the frame O k in the inertial frame is given as formula (6) I T k = I T B B T k0 k0 T k1 k1 T k ð6þ k1 T k6 = I k1 b k6 ð8þ The pose and attitude transformation matrix of point O k6 in the inertial frame is obtained as formula (9) I T k6 = I T B B T k0 k0 T k1 k1 T k6 ð9þ The displacement vector of point O k6 in the inertial frame is given as formula (30) I s k6 = I R B B R z k0 (k0 R x k1 k0 R z k1 k1 b k6 + k0 b k1 )+ B b k0 + I p B ð30þ Displacing O k1 to O k5 as k1 b k5, then rotating as k1 R z k5, and displacing as k5 l x k7 to reach the point of O k7, the pose and attitude transformation matrix from O k1 to O k5 and from O k5 to O k7 can be expressed as formula (31), respectively k1 T k5 = k1 b k5 k1 R z k5, k5 T k7 = I k5 l x k7 ð31þ The pose and attitude transformation matrix of O k5 in the inertial frame is obtained as formula (3) I T k5 = I T B B T k0 k0 T k1 k1 T k5 ð3þ The rotation matrix and the position vector of O k5 in the inertial frame are given as formula (33), with the calculation result of formula (3) ( R 5 = I R B B R z k0 k0 R x k1 k0 R z k1 k1 R z k5 s 5 = I R B B R z k0 (k0 R x k1 k0 R z k1 k1 b k5 + k0 b k1 )+ B b k0 + I p B ð33þ The pose and attitude transformation matrix of O k7 in the inertial frame is given as formula (34) The rotation matrix of the shank rotates along O k and the position vector of the point O k in the inertial frame is given as formula (7) I T k5 = I T B B T k0 k0 T k1 k1 T k5 k5 T k7 ð34þ The position vector of O k7 in the inertial frame is expressed as formula (35) I s k7 = I R B B R z k0 k0 R x k1 k0 R z k1 (k1 R z k5 k5 l x k7 + k1 b k5 )+ k0 b k1 + B b k0 + I p B ð35þ R 4 = I R B B R z k0 k0 R x k1 k0 R z k1 k1 R z k s 4 = I R B B R z k0 (k0 R x k1 k0 R z k1 k1 b x k + k0 b k1 )+ B b k0 + I p B ð7þ Displacing O k1 to O k6 as k1 b k6, the pose and attitude transformation matrix is expressed as formula (8) Suppose that the pose and attitude transformation matrix of O k7 and O k3 relative to O k is given as formula (36) k T k7 = I k b k7, k T k3 = I k b k3 ð36þ Then the pose and attitude transformation matrix of O k7 in the inertial frame is obtained again as a different type as formula (37)

6 6 Advances in Mechanical Engineering I T k7 = I T B B T k0 k0 T k1 k1 T k k T k7 ð37þ According to formulas (19) and (31), the constraint of the drive of the thigh joint is expressed as formula Then the position vector of O k7 in the inertial frame (45) is expressed as formula (38) I s k7 = I R B B R z k0 k0 R x k1 k0 R z k1 (k1 R z k k b k7 + k1 b x k )+k0 b k1 + B b k0 + I p B ð38þ The pose and attitude matrix of O k3, the tip point of the shank in the inertial frame is as formula (39) I T k7 = I T B B T k0 k0 T k1 k1 T k k T k3 ð39þ I s k6 s = k4 l x k6 ð45þ Then the position vector of O k3 in the inertial frame The concrete expression of formula (45) is given as is given as formula (40) formula (46) I s k3 = I R B B R z k0 k0 R x k1 k0 R z k1 (k1 R z k k b k3 + k1 b x k )+k0 b k1 + B b k0 + I p B ð40þ The pose and attitude constraints Each component of the hexapod robot is drove by the push rod, so the connection between the length of the push rod and the rotation angle of the joint should be built, and the connection between the length of the push rod and the rotation angle of the push rod should also need to be built up. First, the constraint of the push rod of the hip can be built up by the length of the push rod and the coordinate value of the points according to formulas (10) and (13). The result is given as formula (41) I s k8 s 1 = k9 l x k8 ð41þ Expanding formula (41), the concrete expression of formula (41) is obtained as formula (4) ( B b k0 B b k9 ) T B R z k0 k0 b x k8 + C 1 = k9 l x k8 ð4þ C 1 is a constant value given as C 1 = k0 b x k8 + k B b k0 k + k B b k9 k B b T k9 Bb k0. According to formula (33), the rotation matrix of the hip can be obtained with the known length of the push rod. With the equivalence relation between formulas (10) and (16), formula (44) can be obtained which represents the rotation matrix of the push rod of the hip B R z k9 k9 l x k8 = B R z k0 k0 b x k8 + B b k0 B b k9 ð43þ From formula (43), the rotation matrix of the push rod can be derived by the known length of the push rod of the hip and the rotation matrix of the hip. Similarly, the constraint of the thigh can also be derived. According to the equivalence relation between formulas () and (31), formula (45) can be derived which expresses the rotation matrix of the push rod of the thigh ( k0 b k1 k0 b k4 ) T k0 R x k1 k0 R z k1 k1 b k6 + C = k4 l x k6 ð46þ C is a constant value given as C = k0 b k4 + k1 b k6 + k0 b k1 k0 b T k1 k0 b k4. According to the equivalence relation between formulas (36) and (39), the expression of the rotation matrix of the push rod of the shank is obtained as formula (47) k1 R z k5 k5 l x k7 = k1 R z k k b k7 + k1 b x k k1 b k5 ð47þ The push rod of the shank satisfies the following constraint as formula (48) I s k7 s 5 = k5 l x k7 ð48þ The concrete expression of formula (48) is expressed as formula (49) ( k1 b x k k1 b k5 ) T k1 R z k k b k7 + C 3 = k5 l x k7 ð49þ C 3 is a constant value given as C 3 = k b k7 + k1 b x k + k1 b k5 k1 b T k5 k1 b x k. The above derivation gives the relation between the rotation of the joints and the length of the push rod of the hip, the thigh, and the shank; the relation between the rotation and the length of the push rod is also given. For the advance movement of the hexapod robot realized by the alternate contact between the foot tip and the ground, the foot tip has two conditions. The first is the free-state, which means that the foot tip can move in the space according to the drive of the push rod of the joints. The other is the fixed state, which means that when the foot tip contacts with the ground and plays a supporting role, the displacement of the foot tip in space keeps still, which is expressed as formula (50) k0 R z k4 k4 l x k6 = k0 R z k1 k1 b k6 + k0 R xt k4 (k0 b k1 k0 b k4 ) ð44þ I s k3 = C ð50þ

7 Bai et al. 7 C is a column vector, and the elements in it are constant. The numerical solution strategy of the pose and attitude relation in space The wholly pose and attitude solution of the hexapod robot in space has three types. The first one is the open-loop solution of the mechanism, which is used to decide the pose and attitude range of the points on the mechanism. It provides the reference parameters for the structure design. The second is the forward solution, which means solving the rotation angle of the joints under the condition that the pose and attitude of the trunk are known. The forward solution is used to offer references for the gait planning of the hexapod robot. The third is the inverse solution, which means solving the pose and attitude of the body under the condition that the rotation angles of the joints are known. For the complexity of the mechanism of the hexapod robot, the reference function of the inverse solution is lower, which is often used as the verification for the correctness of the forward solution results. Based on formula (41), the open-loop solution of the displacement I s k3 of the foot tip in space has no difficulty on the numerical solution, because the solution is on the conditions that pose I p B and attitude I R B of the body and the rotation matrixes B R z k0, k0 R z k1, k1 R z k of the joints are assigned. The processes of the forward and inverse solution are the main points of the following research. Supposing that the rotation angles of the body along the x-, y-, and z-axes of the inertial coordinate are u, c, f, respectively, the rotation matrix with a triangle type is given as formula (51) a k0, a k1, a k, respectively. The rotation angle of the hip along the x-axis is a constant value, so a constant matrix is given as formula (53) 3 k0 R x k1 = I x = R x u k1 = p = ð53þ 0 When the foot tip and the ground keep still, the trunk of the robot can move and rotate in space, which is under the support of the leg; the trunk and the leg consist a closed-loop mechanism. When there is no redundancy of the freedom, the pose and attitude of the trunk and the rotation angles of the joints of the legs have a one-to-one correspondence connection. After the transposition work of the pose and attitude of the trunk in the model of the whole machine pose and attitude model, the parameters of the trunk and the joints of the legs are at different sides of the equation I R T B (I s k3 I p B ) = B R z k0 I x k0 R z k1 (k1 R z k k b k3 + k1 b x k )+k0 b k1 + B b k0 3 cos u cos c cos f sin c + sin f sin u cos c sin f sin c + cos f sin u cos c I R B = 4 cos u sin c cos f cos c + sin f cos u sin c sin f cos c + cos f sin u sin c 5 ð51þ sin u sin f cos u cos f cos u ð54þ From formula (54), the pose and attitude of the trunk and the attitude of the leg constitute a nonlinear equation system, which is a 3D system. When the pose and attitude of the trunk are known, the left side of the equation system has no variables, and the right side of the equation has three unknown quantities, so the equation system has full rank and can be solved. When the rotation angles of the leg are known, the right side of the equation system is constant, and the left side of the equation system has six unknown quantities. To solve the pose and attitude of the trunk, the To decide the rotation matrix of the joints, the triangle function expressions of the rotation matrix of the joints are needed. The rotation matrix of the rigid body rotating along the z- and x-axes is given as formula (5) 3 cos a sin a R z = 4 sin a cos a 0 5, R x = 4 0 cos b sin b 5 0 sin b cos b ð5þ Supposing that the rotation matrixes of B R z k0, k0 R z k1, k1 R z k are the functions of the angles of rotation angles of the two legs should be known, and the equation system can be solved only if the system has a dimension of six. For the high stability of the hexapod robot, in the practice engineering usage, except the instability condition where the trunk has 6-degree-of-freedom motion in space, the trunk often has degrees of freedoms during the conditions of straight line walking and turning motion. During straight line walking, the trunk does not rotate; the only motion is the displacement motion on the plane surface along the two directions. The attitude matrix of the trunk can be simplified as I R B = I, soformula(54)canbesimplified as formula (55)

8 8 Advances in Mechanical Engineering Table 1. The numerical solving strategy of the pose and attitude response of the hexapod robot. The numerical solving strategy Set the initial values: I R T B, I p B For loop: Solve the nonlinear equations 18 (54) (56) and obtain B R z k0, k0 R z k1, k1 R z k ; According to B R z k0, k0 R z k1, k1 R z k and combing the constraints relation, the pose and attitude responses of the hip shank and thigh can be solved. The displacement response: equations (43), (47), and (50) The pose and attitude response: equations (44), (45), and (48) Set new value to I R T B, I p B End I p B = B R z k0 I x k0 R z k1 (k1 R z k k b k3 + k1 b x k )+k0 b k1 B b k0 + I s k3 ð55þ From formula (55), when the hexapod robot moves along the x-direction with the triangle gait, it can be realized by the synergic movement of the three joints of the leg; the motion of the joints of the shank and the thigh is used to compensate the cross range shrink which is caused by the triangle gait of the hip. During turning motion, the most ideal condition is that the trunk rotates only along one axis, so the trunk has only 1 freedom too. At this condition, the attitude matrix only needs one angle to describe. So equation (54) can be simplified as formula (56) R T Bz (I s k3 I p B ) = B R z k0 I x k0 R z k1 (k1 R z k k b k3 + k1 b x k )+k0 b k1 + B b k0 ð56þ Equations (54) (56) are the pose and attitude equations of the parallel hexapod robot under the three conditions, Simulation result To testify the correctness of the above derivation, the complete machine model of the parallel hexapod robot is built up by the 3D model software. According to the measurement in it, the structure parameters of each part of the hexapod robot are as follows. The common structure parameters of each leg are as follows: k0 b k1 = ½65; 0; 0Š, k1 b x k = ½05; 0; 0Š, k b k3 = ½49; 35; 0Š. The parameters of the drive cylinders hinge joints are as follows: k0 b x k8 = ½90; 0; 0Š, k0 b k4 = ½ 85; 0; 90Š, k1 b k6 = ½15; 35; 0Š, k b k7 = ½80; 0; 0Š, k1 b k5 = ½40; 35; 0Š. The hinge joints positions of the drive cylinders of the hip of the six legs on the trunk are B b 19 = ½105, 15, 67:68Š, B b 9 = ½105, 15, 67:68Š, B b 39 = ½70, 15, 67:68Š, B b 49 =½70, 15,67:68Š, B b 59 =½ 185,15,67:68Š, B b 69 = ½ 185, 15,67:68Š. The position of the mass center of the trunk in the inertial frame is I p B0 =½0;0;0Š. The position vectors of the feet, the hinge joint of the hips, and the initial angles of hips, shanks, and thighs of the six legs are as follows B b 10 = ½35; 105; 67:68Š, I s 13 = ½35:59; 410:09; 181:3Š, a 10 = p, a 11 = 0, a 1 = p B b 0 = ½35; 105; 67:68Š, I s 3 = ½35:59; 410:09; 181:3Š, a 0 = p, a 1 = 0, a = p B b 30 = ½ 100; 105; 67:68Š, I s 33 = ½ 99:4; 410:09; 181:3Š, a 30 = p, a 31 = 0, a 3 = p B b 40 = ½ 100; 105; 67:68Š, I s 43 = ½ 99:4; 410:09; 181:3Š, a 40 = p, a 41 = 0, a 4 = p B b 50 = ½ 355; 105; 67:68Š, I s 53 = ½ 354:4; 410:09; 181:3Š, a 50 = p, a 51 = 0, a 5 = p B b 60 = ½ 355; 105; 67:68Š, I s 63 = ½ 354:4; 410:09; 181:3Š, a 60 = p, a 61 = 0, a 6 = p which are the general state, the straight line state, and the turning state. The straight line state and the turning state are the simplified formal of the general state, so the three equation systems have the same numerical solving strategy. The numerical solving strategy is listed in Table 1. The nonlinear equations of the six legs have the same part as B R z k0 (I x k0 R z k1 (k1 R z k k b k3 + k1 b x k )+k0 b k1 ) for the same structure of them. It can be expanded to be a vector with the elements of three

9 Bai et al. 9 3 c(a k0 ) fc(a k1 ) ½49c(a k ) 35s(a k )+05Š s(a k1 ) ½35c(a k )+49s(a k ) Š+ 65g 4 s(a k0 ) fc(a k1 ) ½49c(a k ) 35s(a k )+05Š s(a k1 ) ½35c(a k )+49s(a k ) Š+ 65g5 ð57þ c(a k1 ) ½35c(a k )+49s(a k ) Š+s(a k1 ) ½49c(a k ) 35s(a k )+05Š The pose attitude variation in the joints on the leg under straight line walking and turning motion is analyzed. During straight line walking, the trunk only has the forward direction displacement which means the velocity is 5 mm/s, the motion time is 0 s, so the displacement of the trunk is 10 cm. The simulation results of the motion of the hips, thighs, and shanks of the six legs and their drive cylinders are given in Figure 3. displacements along the y- and z-axes are 0, as The first column of Figure 3 is the motion curves of I p B = ½x; 0; 0Š. Formula (55) can be written as follows the parts of the hip, the rotation angle of the hip a 0, B R z k0 I x k0 R z k1 (k1 R z k k b k3 + k1 b x the length of the drive cylinder of the hip l hip, and the k )+k0 b k1 rotation angle of the drive cylinder a 9 itself from the ð58þ = I s k3 I p B B b top to the bottom. According to the rotation curves of k0 the hip, the initial rotation angles of the hips of leg 1 3 The left side of the equation is formula (57), and the right side of the equation is as follows for each leg 5 and the hips of leg 46relative to the z-axis of the inertial frame are 90 and 90, respectively. During 3 3 straight line walking with a distance of 10 cm, the rotation angles are 108 and 108, respectively, and the 0:59 x 0:59 x leg 1 = 4 305:09 5, leg = 4 305:09 5, variation amplitude is 18. The variation tendency of the curves of the rotation angle of hips is straight line 48:98 48: approximately. According to the length variation in the 0:6 x 0:59 x cylinders, leg 1 and leg have the same variation leg 3 = 4 305:09 5, leg 4 = 4 305:09 5, curves, the initial length is 19.8 mm, the terminal 48:98 48:98 length is 47.9 mm, the variation amplitude is 8.1 mm, 3 3 and the length variation in the hip drive cylinders of 0:59 x 0:59 x the hips of leg is identical. The initial length is leg 5 = 4 305:09 5, leg 6 = 4 305: mm, the terminal length is 14. mm, the variation 48:98 48:98 amplitude is 8 mm, and the variation tendency of the curve is straight line approximately too. The initial According to the about analysis, the legs numbered rotation angles of the drive cylinders of the hips are 90 as have the same kinematic equation, so as the legs and 90, respectively; the terminal angles are 88. which numbered as 4 6 during straight line walking. and 88., respectively; and the variation amplitude The kinematic equation of the hexapod robot under is turning motion is analyzed as follows. Supposing that The second column of Figure 3 is the motion curves the hexapod robot rotates along the fixed axis which is at the mass center, and I of the main parts of the thigh; the third column is the p B is a constant vector, then curves of the shank. The main kinematics parameters formula (56) can be written as follows of the thigh are the rotation angles of the thigh a 1, the B R z k0 I x k0 R z k1 (k1 R z k k b k3 + k1 b x length of the drive cylinder l k )+k0 b thigh, and the rotation angle k1 = R T Bz (I s k3 I p B ) B of the drive cylinder a 4. During the whole motion process, the initial angle of the thigh is 0, the terminal is b k0 ð59þ The left side of formula (59) is identical to the left side of formula (57), and the right side can be written 0.765, the variation amplitude is 0.765, the initial length of the drive cylinder of the thigh is 30.1 mm, as follows which represents the six legs :6 cos (f)+410 sin (f) 35 35:6 cos (f) 410 sin (f) sin (f) 99:4 cos (f) cos (f) 35:6 sin (f) 105 5, cos (f) 35:6 sin (f) 5, cos (f)+99:4 sin (f) sin (f) 99:4 cos (f) sin (f) 354:4 cos (f) sin (f) 354:4 cos (f) :4 sin (f) 410 cos (f)+105 5, 4 354:4 sin (f)+410 cos (f) 105 5, 4 354:4 sin (f) 410 cos (f) First, the motions of the six legs under straight line walking are calculated. Supposing that the trunk of the hexapod robot moves with a constant speed and the the terminal is 30.3 mm, the variation amplitude of the length is 0. mm, the initial angle of the drive cylinder

10 10 Advances in Mechanical Engineering Figure 3. The kinematic results of the hip thigh and the shank under straight line walking. Table. The list of the initial terminal and the amplitude values of the motion of each joints under straight line walking. Main joint rotation angle ( ) Length of cylinder (mm) Rotation angle of cylinder ( ) Initial End Amplitude Initial End Amplitude Initial End Amplitude Hip Thigh Shank of the thigh is 65.56, the terminal angle is 65.3, and the variation amplitude is The main kinematics parameters of the shank are the rotation angle of the shank a, the length of the drive cylinder l shank, and the rotation angle of the drive cylinder a 5 The initial rotation angle of the shank is 90, the terminal is 85.56, and the variation amplitude is The initial length of the drive cylinder of the thigh is 01.1 mm, the terminal is 06.1 mm, the variation amplitude is 5 mm, the initial rotation angle of the drive cylinder of the shank is 55.13, the terminal is 56.16, and the rotation amplitude is 1.03 (Table ). According to the overall variation tendency of the above curves, the kinematic variation in the parts of the hips tends approximately to be straight line type, and the variation in the thigh and the shank tends to be parabolic. Figure 4 shows the comparison of the motion amplitudes of each joint under straight line walking. The first Figure 4. The comparison of the motion amplitudes of each joint under straight line walking. group is the comparison of the rotation angles of the joints of hip thigh and shank. The second group is the

11 Bai et al. 11 Figure 5. The kinematic results of the hip thigh and the shank under turning motion of leg Figure 6. The kinematic results of the hip thigh and the shank under turning motion of leg 4 6. comparison of the length of the drive cylinders. The third group is the rotation angles of the drive cylinders. According to the three groups comparison, the conclusion can be made that the hip and the shank joints are the main motion joints during straight line walking; the thigh has only a small motion amplitude. So in practical engineering, the thigh joint can keep still during straight line walking to reduce the difficulty of the control. The motions of the six legs under turning motion are simulated. Supposing that the trunk of the hexapod robot rotates 10 in s along the z-axis of the body frame of the trunk, the simulation results of the

12 1 Advances in Mechanical Engineering Table 3. The list of the initial terminal and the amplitude values of the motion of each joints under turning motion. Main joint rotation angle ( ) Length of cylinder (mm) Rotation angle of cylinder ( ) Initial End Amplitude Initial End Amplitude Initial End Amplitude Hip Leg Leg Leg Leg Leg Leg Thigh Leg Leg Leg Leg Leg Leg Shank Leg Leg Leg Leg Leg Leg components of the legs are given in Figures 5 and 6. The initial and terminal values and the variation amplitudes of each kinematics parameters are listed in Table 3. According to the simulation results in Figures 5 and 6, during turning motion, the motion curves of the joints of the robot appear straight line and parabolic type approximately, and there is no fluctuant. According to the results in Table 3, during the setting turning process, the rotation angles of the hips of the six legs are 15.43, 1, 13.06, 13.8, 1.09, and 15.4, respectively; the motion lengths of the drive cylinders of the hips are 3.7, 18.9, 0., 1.6, 18.7, and 4 mm, respectively; and the rotation angles of the drive cylinders of the hips are 0.95, 0.47, 0.7, 1, 0.61, and 1.6, respectively. The rotation angles of the thigh are , 4.4, , , 5.03, and ; the motion lengths of the drive cylinders of the thighs are 0., 1.3, 0.3, 0., 1.4, and 0. mm; and the rotation angles of the drive cylinders of the thighs are as 0., 1.87, 0.4, 0.19,.14, and The rotation angles of the shanks are 1.8, 18.3, 5.49, 3.93, 0.8, and 13.8 ; the motion lengths of the drive cylinders of the shanks are 15.4, 19, 6.1, 4.6, 0.8, and 16.8 mm; and the rotation angles of the drive cylinders of the shanks are 0.39, 4.6, 1.3, 0.87, 5.16, and.8. With the above analysis, the comparison of the motion amplitudes of the rotation angles, the motion lengths of the drive cylinders, and the rotation angles of the drive cylinders is given in Figure 7. According to Figure 7, during turning motion, the hips and the shanks of the legs have a Figure 7. The comparison of the motion amplitudes of each joint under turning motion. significant function, and the motion amplitudes of the joints of the thighs are small comparatively. According to the simulation results of straight line walking and turning motion, the hips and the shanks play the main function, and the motion amplitude of

13 Bai et al. 13 Figure 8. The virtual prototype of the hexapod robot. the thighs is small, which can be used as the standby joints in the obstacle crossing. The virtual prototype To testify the correctness of the kinematic model, the virtual prototype of the hexapod robot is built by the 3D modeling software Pro-E and the virtual prototype software ADAMS. The virtual prototype is given in Figure 8. There are 54 revolute pairs and 18 sliding pairs. The tips of the feet are connected together by the spherical pair which can constitute the closed loop between the hexapod robot and the ground. The legs are numbered 1 6 which are in accordance with the leg order in the above simulation. The simulation results of the motion of each joint under straight line walking and turning motion are given in Figures 9 and 10, respectively. In Figures 9 and 10, the first, second and the third columns are the kinematic parameters of the hips, the thighs, and the shanks, respectively. The parameters include the rotation angles of hips, thighs, and shanks; the displacements of the sliding pairs in the drive cylinders; and the rotation angles of the drive cylinders. The comparisons of the variation amplitudes of the kinematic parameters under straight line walking and turning motion which are calculated by MATLAB and ADAMS are listed in Tables 4 and 5, Table 4. The comparison of the kinematics parameters under straight line walking with MATLAB and ADAMS. Main joint rotation angle ( ) Length of cylinder (mm) Rotation angle of cylinder ( ) MATLAB ADAMS MATLAB ADAMS MATLAB ADAMS Hip Thigh Shank Figure 9. The rotation angles and displacements of the joints of the six legs under straight line walking.

14 14 Advances in Mechanical Engineering Figure 10. The rotation angles and displacements of the joints of the six legs under turning motion. Table 5. The comparison of the kinematics parameters of each joint under turning motion with MATLAB and ADAMS. Main joint rotation angle ( ) Length of cylinder (mm) Rotation angle of cylinder ( ) MATLAB ADAMS MATLAB ADAMS MATLAB ADAMS Hip Leg Leg Leg Leg Leg Leg Thigh Leg Leg Leg Leg Leg Leg Shank Leg Leg Leg Leg Leg Leg respectively. According to Tables 4 and 5, the calculation results which are calculated by MATLAB and ADAMS are identically approximately, which verifies the correctness of the mathematical model which are derived above. The time step is 0.1 s in the MATLAB simulation, so the accuracy of the parameters which is calculated by MATLAB is lower than ADAMS.

15 Bai et al. 15 Conclusion This article explores the advantage and defects of the D H mechanism modeling method and the Lie group multi-body modeling method, and then combines them together to get the Lie D H method. The closed-loop pose attitude equation of the hexapod robot from the body to the foot tip is constructed by the Lie D H method, with the attitude matrixes and the pose vectors of the legs as the modeling elements, the pose-attitude model has a more concise expression type, and the skew character of the attitude matrix is sufficiently used, so a mass of the intermediate variables is eliminated, which avoids the complexity of the calculation. The numerical calculation method is designed; straight line walking and turning motion of the hexapod robot are simulated with MATLAB; and the rotation and displacement response of each joint and their drive cylinders of the legs are obtained. Finally, the 3D model of the pneumatic hexapod robot is constructed with Pro-E, and the virtual prototype analysis is realized by ADAMS. The correctness of the mathematical model is verified by the comparison between the simulation results by MATLAB and ADAMS. This mathematical model offers a theory analysis basis for the mechanism design and gaiting planning of the pneumatic- or hydraulic-derived hexapod robot. Declaration of conflicting interests The author(s) declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article. Funding The author(s) disclosed receipt of the following financial support for the research, authorship, and/or publication of this article: The exploration is supported by the Natural Science Foundation of China ( ). References 1. Zhuang H, Gao H and Deng Z. Method for analyzing articulated rotating speeding of heavy-duty six-legged robot. JMechEng013; 49: Liu Y, Deng Z and Liu Z. Low-impact motion planning method of hydraulically actuated hexapod robot. J Mech Eng 015; 51: Shekhar Roy S and Pratihar DK. Kinematics, dynamics and power consumption analyses for turning motion of a six-legged robot. J Intell Robot Syst 014; 74: Zhu Y, Jin B, Li W, et al. Optimal design of a hexapod robot leg structure based on target workspace. J Zhejiang Univ: Eng Sci 014; 48: Rong Y, Jin Z and Qu M. Design of parallel mechanical leg of six-legged robot. Optic Precis Eng 01; 0: Rong Y, Jin Z and Cui B. Configuration analysis and structure parameter design of six-leg agricultural robot with parallel-leg mechanism. Trans Chin Soc Agric Eng 01; 8: Deng Z and Liu Y. On the segment length ratio of the walking leg of a hydraulically actuated hexapod robot. Robot 014; 36: Chen G, Jin B and Chen Y. Turning gait with constant radius of six-legged walking robot. J Zhejiang Univ: Eng Sci 014; 48: Manoiu-Olaru S. Basic walking simulations and gravitational stability analysis for a hexapod robot using Matlab. Ann Univ Craiova: Autom Comput Electron Mech 011; 8: Yang P and Gao F. Leg kinematic analysis and prototype experiments of walking-operating multifunctional hexapod robot. Proc IMechE, Part C: J Mechanical Engineering Science 014; 8: Ghayour M and Zareei A. Inverse kinematic analysis of a hexapod spider-like mobile robot. Adv Mat Res 01; : Ghayour M and Zareei A. Direct kinematic analysis of a hexapod spider-like mobile robot. Adv Mat Res 01; : Vladareanu L and Curaj A. Complex walking robot kinematics analysis and PLC multi-tasking control. Rev Roum Sci Tech: Se 01; 57: Lee T. Computational geometric mechanics and control of rigid bodies. Ann Arbor, MI: University of Michigan, Lee T, McClamroch NH and Harris N. A Lie group variational integrator for the attitude dynamics of a rigid body with applications to the 3D pendulum. In: Proceedings of the IEEE international conference on control applications, Toronto, ON, Canada, 8 31 August 005, pp New York: IEEE. 16. Nordkvist N and Sanyal AK. A Lie group variational integrator for rigid body motion in SE(3) with applications to underwater vehicle dynamics. In: Proceedings of the 49th IEEE conference on decision and control, Atlanta, GA, December 010, pp New York: IEEE. 17. Ding XL and Liu Y. Dynamic analysis of robot with spatial compliant links using Lie group and Lie algebra. Chin J Mech Eng 007; 43: Ding L and Cheng Q. Numerical computation method. Beijing, China: Higher Education Press, 011, pp