Static Stability Analysisof Hexagonal Hexapod Robot
Static Stability Analysisof Hexagonal Hexapod Robot
net/publication/301564194
Static Stability Analysis of Hexagonal Hexapod Robot for the Periodic Gaits
CITATIONS READS
4 2,107
2 authors:
All content following this page was uploaded by Hind Zuhair Khaleel on 22 April 2016.
_____________________________________________________________________________________
Received: 26/05/2014
Accepted: 11/09/2014
Abstract – H exagonal hexapod robot is a flexible mechanical robot with six legs. It
has the ability to walk over terrain. The hexapod robot likes insect so it has the same
periodic gaits. These gaits are tripod, wave and ripple gaits. Hexapod robot needs to
stay statically stable at all the times during each gait in order not to fall with three or
more legs continuously contacts with the ground. The safety static stability walking can
be indicated by the stability margin. In this paper we based on the forward, inverse
kinematics for each hexapod’s leg to simulate the hexapod robot model walking for all
periodic gaits and the geometry in order to derive the equations of the sub-constraint
workspaces for each hexapod’s leg. They are defined as the sub-constraint workspaces
volumes when the legs are moving without collision with each other and they are useful
to keep the legs stable from falling during each gait. A smooth gait was analyzed and
enhanced for each hexapod’s leg in two phases, stance phase and swing phase. The
equations of the stability margins are derived and computed for each gait. The
simulation results of our enhanced path planning of the hexapod robot approach whish’s
include all the gaits are statically stable and we are compared between all stability
margins for each gait. In addition, our results show clearly that the tripod gait is the
fastest gait while the wave and the ripple gaits are more stable than the tripod gait but
the last one has less peaks of stability margins than others.
† This paper has been presented in ECCCM-2 Conference and accredited for publication according to
IJCCCE rules.
10
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr.Firas A. Raheem and Hind Z. Khaleel.
11
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
chosen for each leg mechanism in order to 4. Rotate α about xi-1 axis.
imitate the leg structure as shown in Fig. The overall transformation is obtained as
2. A direct geometrical model for each leg a product between three transformation
mechanism is formulated between the matrixes:
moving frame oi(xi, yi, zi) of the leg base,
where i=1…6, and the fixed frame o (xo, T =T T (2)
yo, zo) [10].
Considering Fig. 2 and using (2) the
coordinates of the leg tip are:
R
legbase
2
L
x = cosθ ∗ (L + L ∗ cosθ + L ∗ cos(θ − θ )),
1 R y = sinθ ∗ (L + L ∗ cosθ + L ∗ cos(θ − θ )),
d1
z1 x1
z = d + L ∗ sinθ + L ∗ sin(θ − θ ). (3)
L
x0 x2
leg links.
L
yo
z3
xc 2.2. Inverse kinematics
x3
zo The geometrical model described
Figure 2. Model and coordinates frame for leg above establishes a link between the joint
kinematics. variable and the position and orientation
of the end frame. The inverse kinematics
In this paper the BH3-R hexapod robot problem consists of formative the joint
is taken as a case study of hexagonal angles from a given position and
hexapod robot. The lengths of the orientation of the end frame. The solution
hexapod’s leg are: L1 = (2.9 cm), L2 = of this problem is significant in order to
(5.7 cm), L3 = (10.8 cm) [11]. The robot transform the motion assigned to the end
leg frame starts with link (0) which is the frame into the joint angle motions
point on the robot body where the leg is matching to the desired end frame motion.
jointed to; link (1) is the coxa, link (2) is The goal is to find the three joint variables
the femur and link (3) is the tibia. Legs θ1, θ2, and θ3 corresponding to the desired
are distributed symmetrically around the end frame position. The end frames
axis in the direction of motion (x in this orientation is not a matter, since only
case). The general form for the paying attention in its position [10].
transformation matrix from link (i) to link
(i-1) using Denavit Hartenberg parameters
are given in (1) [10, 12]: x1,y1 Tibia joint
θ
y L2
cos θ − sin θ cos α sin θ sin α a cos θ
y
sin θ cos θ cos α −cos θ sin α a sin θ Leg tip
T = (1) Femur joint φ L3
0 sin α cos α d
0 0 0 1 φ x
x
φ
The transformation matrix is a series of Coxa joint
a
transformations: A x3,y3
B
1. Translate di along zi-1 axis.
2. Rotate θ about zi-1 axis. Figure 3 Illustrations for solving inverse
kinematics.
3. Translate α about xi-1 axis.
12
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
Next the femur angle can be found from: These joint variable limits, then,
separate the reachable area from the
θ = acos
∗
+ atan2(y , x ) (10) unreachable area. Reachable areas move
with the body. The region included within
Again, applying the law of cosines to find the reachable area is known as the
the angle: unconstrained working volume (UWV).
13
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
The constrained working volume (CWV) were lack extent to its fullest, (θ = 1350)
is defined as a subset of the original the y-plane would equal (14.7cm) while
working volume, for each leg, that the z-plane equal (9 cm).
ensures static stability.
Therefore, the (CWV) sets soft limits 3.1.2. Constrained Workspace
for each leg so as to exclude points from The CWV used in this paper results
the working volume that may lead to from six basic constraints:
instability. In our case, the working the height (z = plane) from the ground
volume is also constrained to prevent leg to the CB (center body of robot) = (10.8
collisions. An excluded area for hexapod's cm) is fixed for minimum, maximum
legs, then, is that part of the reachable reach, the vertical maximum reach equal
area where, if a foot were placed there, (24.25 cm) if θ = 800 and minimum
instability or leg collision might result. reach equal (21 cm) if θ = 97o,
the suitable posture of robot = (22.35
cm) if θ = 90o,
The terrain is flat,
The legs are not allowed to collide or
overlap, and
The horizontal workspace of hexapod
leg is The reachable areas include the
sections in the xy plane around the
individual coxas, y-plane = 24.25 cm and
within the mechanical joint limits but in
Figure 4.Flowchart Workspace of hexapod’s leg
this case limit joint (in proposed method,
Figure 4 shows that the flowchart of the half range of coxa angle is taken in
workspace. The workspace of robot leg is order not to the legs collide) soothe range
computed from kinematics and geometry is (−45 < θ < 45) degree. Another
as follow: approach is derived for Constrained
Workspace more details in [13], [14]. For
3.1.1. Unconstrained Workspace the hexagonal model the mathematically
The unconstrained horizontal (13) for the radius of the annulus is :
workspace of hexapod leg is the reachable
areas include the sections in the xy plane r = (r + Q) + ∗P (13)
around the individual coxas and within
the mechanical joint limits, the y plane Where: r ,r , Q, P defined by Fig. 5.
equal (33.15 cm). The unconstrained
vertical workspace, or z-plane reachable
area, depends on the height of the
hexapod’s center-of-body above the
terrain is (5.5 cm). To define the
maximum unconstrained vertical
workspace, If a leg were extended to its
fullest, the added lengths of radius body
(13.75 cm), coxa (2.9 cm), femur (5.7
cm), and tibia (10.8 cm) y-plane would
Figure 5.The relationship between the reachable
equal (33.15 cm). The minimum area and annuls.
unconstrained vertical workspace, If a leg
14
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
15
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
In the wave gait only one leg in the air, Leg 1 L5 Leg 5
while the others are on the ground so the
support pattern is divided into five areas L1 S5 L4
S4
(S1, S2, S3, S4, S5) and the stability margin S1 Leg 6
CB
is evaluated for all the cases of wave gait S3
Leg 2 S2
as shown below: L3
L2 Leg 3
Figure 10. Case 3 representation where the support Figure 14. Case 1 representation where the support
pattern (legs (1,2,6,5,4) on ground ) of the wave pattern (legs (2,3,6,5) on ground) of the ripple
gait. gait.
16
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
17
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
18
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
19
IJCCCE Vol.14, No.3, 2014 Static Stability Analysis of Hexagonal Hexapod
Robot for the Periodic Gaits
Dr. Firas A. Raheem and Hind Z. Khaleel.
[7] Christian Ridderstrom, “Stability of statically [13] R. B. McGhee and G. I. Iswandhi, “Adaptive
balanced stances for legged robots with locomotion of a multilegged robot over rough
compliance,” Proceedings of the 2002 IEEE terrain,” IEEE Trans. Syst., Man, Cybern.,
lntemational Conference on Robotics 8 vol. SMC-9, no. 4, pp. 176–182, 1979.
Automation Washington, DC May 2002. [14] Stanley Kwok-Kei Chu and Grantham Kwok-
[8] Krzysztof W., Dominik B. and Andrzej K., Hung Pang, “Comparison between Different
“Control and environment sensing system for Model of Hexapod Robot in Fault-Tolerant
a six-legged robot,”, Journal of Automation, Gait,” IEEE Trans. Syst. Man Cybern,—
Mobile Robotics & Intelligent Systems, Vol. PART A: Systemand Humans, VOL. 32, NO.
2, No. 3, 2008. 6, November 2002.
[9] J. Barreto, A. Trigo, P. Menezes, Dias J., [15] Charles Andrew Schue, “Simulation of
“Kinematic and dynamic modeling of a six Tripod gaits for a Hexapod underwater
legged robot,” citeseer, 2004. walking machine,” Master’s Thesis, Naval
[10] Mănoiu-OlaruSorin, NiţulescuMircea, Postgraduate School Monterey, California,
“Matlab Simulator for Gravitational Stability June 1993.
Analysis of a Hexapod Robot,” The [16] Sigurd Villumsen, “Modeling and Control of
Romanian Review PrecisionMechanics, a six legged mobile robot,” Master Thesis; 1.
Optics & Mechatronics, 158 2011, No. 39 September 2009 - 23 of June 2010.
Mechanics, Optics & Mechatronics, 2011. [17] Mohammad ali Shahriari, Kambiz Ghaemi
[11] http://www.lynxmotion.com/c-100-bh3- Osguie, Amir Ali Akbar Khayyat, “Modular
r.aspx, Accessed on 17/11/2013. Framework Kinematic and Fuzzy Reward
[12] Schilling R. J., “Fundamentals of robotics: Reinforcement Learning Analysis of a
analysis and control”, ISBN: 0-13-344433-3, Radially Symmetric Six-Legged Robot,” Life
Prentice Hall, New Jersey, USA, 1990. Science Journal 2013.
20