Abstract
In this paper the kinematic analysis of a six-legged robot, hereafter named
1. Introduction
Legged robots have better performance in rough terrain than robots with wheels, thanks to the possibility of coordinated movements that provide greater flexibility and adaptability.
Legged robots can be classified as: bipeds, quadrupeds, hexapods and octopods. Most climbing robots are hexapods or quadrupeds - the former providing better static stability than the latter. They can perform static gaits by supporting the robot's body on five legs at any time, while quadrupeds can only walk steadily on a minimum of three legs. This feature makes hexapods much more stable than quadrupeds, since they can use a bigger support polygon. Notice that stability is a fundamental issue for mobile robots and speed is an important factor for robot locomotion - a quadruped robot is three times slower than a hexapod. In terms of reliability, the hexapod can continue walking even when one of its legs fails [1].
To obtain a dynamic model and to design a control algorithm of legged robots, it is important to model the kinematic behaviour of the complex multi-legged robotic mechanism.
In [2], the inverse position problem for each end-effector (EE) of the legs of the quadruped robot CLIBO is solved by homogeneous transformation matrices. The same approach is presented in [3] for a hexapod robot assuming forward motion at a constant velocity (
A legged robot can be considered a partially parallel mechanism where the thorax is the mobile platform. In [5], the direct and inverse kinematics of the mobile platform of the quadruped robot Kamambaré, are solved by modelling it as a parallel robot. The analysis is performed using the D-H parameterization, starting at the surface and advancing towards the platform.
The work presented in [6] solves the kinematics of a four-legged robot composed by GZ-I modules, using kinematics graph theory to obtain robot posture. Two homogeneous transformation matrices describe the position of the robot, matrix R of rods and matrix J of joints. The joints are classified into horizontal and vertical joints depending on their axis of rotation.
The position problem of the tip leg has been studied for quadruped and hexapod robots [2–6], however, the problem of the thorax pose has received little attention [5–6]. Furthermore, the infinitesimal kinematics of legged robots have been omitted.
One of the most important things in the study of legged robots is showing stability when walking. [7] conducted a study of impulse response and stability of a fractional oscillator, which determine the conditions for the fractional oscillator is strictly stable, unstable and marginally stable. Which determine the conditions to make it strictly stable, unstable and marginally stable.
In this paper, an analysis of the direct and inverse position of the hexapod robot called Hex-piderix is carried out, in addition, the infinitesimal kinematics are solved by using screw theory.
2. Description of the Hex-piderix robot
The basic configuration proposed for the robot Hex-piderix is shown in Fig. 1. The frame {

Robot configuration.
3. Position analysis
The symmetry of the mechanism simplifies the position analysis. The inverse and direct kinematics are solved from geometrical analysis of the mechanism.
3.1 Forward position analysis
The aim of this analysis is to find the robot pose at the thorax level {
To determine the pose of the robot it is assumed that there are three legs touching the ground,
To ensure the stability of the robot, the projection of the centre of gravity must fall within the polygon formed by the tips of the limbs.

Triangle formed by coxa links.
The unitary vectors corresponding to {Q} were calculated as follows:
where,
The rotation matrix of the centroid is obtained with the unitary vectors, Eq. (4).
Then, the pose of the triangle is described by the homogeneous transformation matrix 4 × 4
The rest of the analysis is performed with the D-H method for a leg. In Fig. 3 the joint variables of the mechanism leg,

D-H parameters of i-leg.
The limbs described above are similar to 3 DOF serial manipulators. From this, the homogeneous transformation matrices between frames are obtained, taking into account the D-H parameters shown in Table 1, which are: link length (
D-H parameters for legs.
The homogeneous transformation matrices of the links are presented below in Eqs. (7), (8) and (9).
Hence, the pose of the coxa frame {
Then, the frame attach to thorax {
where,
where, [
3.2 Inverse analysis position
This analysis consists of determining the joints angles, q
The problem is solved for each leg separately, in a geometric way considering three restrictions: 1) all joints permit only rotation about an axis; 2) the femur and tibia always rotate around parallel axes, and 3) the physical constraints of each joint, which give a specific angular range for each active joint.
The coxa angle, Fig. 4, can be found by projecting the i-leg on the plane XY, Eq. (12).

Projection of the i-leg on plane XY.
From Fig. 5 and Eq. (12),

Configuration of i-leg.
Where,
4. Infinitesimal kinematics
The velocity and acceleration analysis of the robot are solved using screw theory. As an approach to the study of the dynamics of the robot, the manipulator is assumed as a parallel mechanism. Its limbs are modelled as shown in Fig. 6.

Note that the active revolute joints are associated with the screws 3$4
On the other hand, the suction cup is modelled as a UP linkage, and its corresponding screws are 1$1
4.1 Preliminary concepts of screw theory
An infinitesimal screw $, or twist, is a vector in $ ∈ ℝ6 that consists of a primal part,
where
Moreover, the following operations are defined [8]. Let $1=(ŝ1,sO1),$2=(ŝ2,sO2),$3=(ŝ3,sO3) be three screws, and λ ∈ ℝ.
Addition:
Multiplying by scalar:
Lie product
Killing form
Klein form
4.2 Velocity analysis
The forward velocity analysis consists of finding the velocity state of the thorax,
where ω and
where
A useful concept to simplify this analysis is reciprocity. Two screws, $1 and $2 are reciprocal if the Klein form between them is zero, {$1; $2} = 0. With this definition, one can demonstrate that the screw 1$2
On the other hand, let $
Eqs. (22) and (23) can be written as a lineal system as follows:
where
Thus the state of velocity
Moreover, the inverse velocity analysis consists of finding the ratios of manipulator velocities for a given velocity state. To achieve this, it is necessary to isolate Ω
4.3 Acceleration analysis
Brand in 1947 introduced the concept of reduced acceleration state,
where
where
In the same manner as the velocity analysis, the Klein form is applied to Eq. (26) and screws 0$1
where,
Finally, to solve the inverse analysis, it is necessary to isolated in Eq. (26).
5. Numerical example
In this section a numerical example is provided with the purpose of showing how to deal with the kinematics of this model. Hereafter the units used are millimetres, unless otherwise stated. In this case, the dimensions of the geometrical parameters of the moving triangular prism are
The coordinates of the suction cups are:
Links length, coxa, femur and tibia are given by:
Fig. 7 shows the joints angle of the legs

Position of the joints angle.
Firstly, the direct position equations were programmed to calculate the thorax pose, taking into account the initial and final positions, as well as geometric parameters. Fig. 8 shows the robot moving from the initial to the final position.

Hex-piderix position.
Fig. 9 shows the thorax position, where the components

Thorax position.
With the above data, both angular and linear velocities of the numerical example are calculated. The resulting time history of the linear velocity components of the centre of thorax using the screw theory is shown in Fig. 10. Angular velocity is shown in Fig. 11.

Linear velocity of the Hex-piderix robot.

Angular velocity of the Hex-piderix robot.
As is shown in Figs. 8 and 9, the components of the position vector of thorax are not constants due to suction cup deformations; hence the angular velocity is different to zero.
6. Conclusion
It was developed a method to determine the rotation matrix of the thorax of a legged robot with respect to the global frame, without having to use trigonometric functions, since these could lead to ambiguous values for the orientation. Although, this method is usually applied in the study of parallel robots, it can be successfully employed in the analysis of legged robots.
The velocity and acceleration states of the thorax with respect to the fixed platform are written in screw form through each one of the three limbs of the robot. The equations obtained are linear, simple and compact through the use of the Klein form of Lie algebra. In addition, it is not necessary to know the velocities and accelerations of passive joints to solve forward velocity and acceleration analysis, respectively.
This kinematics study provides the basis for generating control strategies that allow the robot to recover from perturbations during locomotion, as well as keeping the thorax in a constant orientation.
It would be helpful to consider the suction cup attached to each tip of the tibia when modelling the kinematics of a legged robot, as this can introduce an error.
Footnotes
7. Acknowledgments
The authors acknowledge to the SIP-IPN for funding the research project 20121376
