Professional Documents
Culture Documents
net/publication/224199139
Conference Paper in Proceedings of the ... IEEE/RSJ International Conference on Intelligent Robots and Systems. IEEE/RSJ International Conference on Intelligent Robots and Systems ·
November 2010
DOI: 10.1109/IROS.2010.5649099 · Source: IEEE Xplore
CITATIONS READS
11 169
4 authors:
Some of the authors of this publication are also working on these related projects:
Autonomous Marine Operations and Systems (CoE NTNU AMOS) View project
All content following this page was uploaded by Pål Liljebäck on 09 May 2015.
Abstract— This paper presents a set of fundamental prop- are very similar. The works in [10]–[12] investigate the
erties of the velocity of a snake robot conducting lateral controllability of various fish-like mechanisms, synthesize
undulation on a planar surface. In particular, the derived gaits for translational and rotational motion based on Lie
properties state that the average forward velocity of the snake
robot 1) is proportional to the squared amplitude of the bracket calculations, and propose controllers for tracking
sinusoidal motion of each joint of the robot, 2) is proportional straight and curved trajectories.
to the angular frequency of the sinusoidal motion of each joint, The contribution of this paper is a set of fundamental
3) is proportional to a particular function of the constant phase properties of the velocity dynamics of a planar snake robot
shift between the joints, and 4) is maximized by the phase shift that are useful from a motion planning perspective. The
between the joints that also maximizes the particular phase shift
function. The paper presents simulation results that support the properties are derived based on a simplified model of a snake
validity of the derived properties. robot proposed by the authors in [13]. The derived properties
state that the average forward velocity of a planar snake robot
I. I NTRODUCTION 1) is proportional to the squared amplitude of the sinusoidal
Inspired by biological snakes, snake robots carry the motion of each joint of the robot, 2) is proportional to the
potential of meeting the growing need for robotic mobil- angular frequency of the sinusoidal motion of each joint, 3)
ity in challenging environments. Snake robots consist of is proportional to a particular function of the constant phase
serially connected modules capable of bending in one or shift between the joints, and 4) is maximized by the phase
more planes. The many degrees of freedom of snake robots shift between the joints that also maximizes the particular
make them difficult to control, but provide traversability phase shift function. To the authors’ best knowledge, these
in irregular environments that surpasses the mobility of fundamental properties of snake locomotion have never be-
the more conventional wheeled, tracked and legged forms fore been derived analytically. The paper presents simulation
of robotic mobility. Research on snake robots has been results that support the theoretical findings.
conducted for several decades. However, our understanding The paper is organized as follows. Section II presents
of snake locomotion so far is for the most part based on a complex model of a snake robot that will be used for
empirical studies of biological snakes and simulation-based simulation purposes. Section III presents a simplified model
synthesis of relationships between parameters of the snake of a snake robot that the theoretical findings are based
robot. upon. Section IV presents a controller for the snake robot.
There are several reported works aimed at analysing Section V derives the fundamental properties of the velocity
and understanding snake locomotion. Gray [1] conducted dynamics of the snake robot. Section VI presents simulation
empirical and analytical studies of snake locomotion already results. Finally, Section VII presents concluding remarks.
in the 1940s. Hirose [2] studied biological snakes and devel-
oped mathematical relationships characterizing their motion, II. A COMPLEX MODEL OF A PLANAR SNAKE ROBOT
such as the serpenoid curve. Saito et al. [3] optimized the This section summarizes a complex model of a planar
parameters of the serpenoid curve based on simulations snake robot previously presented in [9]. We will use this
of a planar snake robot. Hicks [4] investigated general model to simulate the motion of the snake robot in Section
requirements for the propulsion of a three-linked snake robot. VI.
Nilsson [5] employed energy arguments to analyse planar
snake locomotion with isotropic friction. Transeth et al. [6] A. Notation and defined symbols
proved that the velocity of a planar snake robot is bounded. We consider a planar snake robot consisting of links of
Li et al. [7] studied the controllability of the joint motion length interconnected by −1 active joints. The kinematics
of a snake robot. The authors have previously studied the and dynamics of the snake robot are defined in terms of the
stability properties of snake locomotion based on Poincaré symbols illustrated in Fig. 1 and Fig. 2. All links have
maps [8] and investigated the controllability properties of a the same mass and moment of inertia . The total mass
planar snake robot influenced by anisotropic friction [9]. of the snake robot is therefore . The mass of each link
Research on robotic fish and eel-like mechanisms is is uniformly distributed so that the link CM (center of mass)
relevant to research on snake robots since these mechanisms is located at its center point.
Affiliation of Pål Liljebäck is shared between the Department The snake robot moves in the horizontal plane and has
of Engineering Cybernetics at the Norwegian University of Science a total of + 2 degrees of freedom. The position of the
and Technology, NO-7491 Trondheim, Norway, and SINTEF ICT, CM (center of mass) of the snake robot is denoted by p =
Dept. of Applied Cybernetics, N-7465 Trondheim, Norway. E-mail:
Pal.Liljeback@sintef.no ( ) ∈ R2 . The absolute angle of link is expressed
K. Y. Pettersen, Øyvind Stavdahl, and Jan Tommy Gravdahl are with respect to the global axis with counterclockwise
with the Department of Engineering Cybernetics at the Norwegian positive direction. As seen in Fig. 1, the relative angle
University of Science and Technology, NO-7491 Trondheim, Norway.
E-mail: {Kristin.Y.Pettersen, Oyvind.Stavdahl, between link and link + 1 is given by = +1 − .
Tommy.Gravdahl}@itk.ntnu.no The local coordinate system of each link is fixed in the CM
f = Rglobal link
link f
∙ ¸ ³ ´
0
= −Rglobal
link sgn v link
(3)
0
∙ ¸ µ³ ´ ∙ ¸¶
global 0 global ̇
= −Rlink sgn Rlink
0 ̇
where is the gravitational acceleration constant and sgn(·)
is the signum function.
Fig. 1. Kinematic parameters of the snake robot.
C. Equations of motion
It is shown in [9] that the equations of motion of the
snake robot in terms of the joint angles, φ ∈ R−1 , the
absolute angle of the head link, ∈ R, the position of the
CM of the snake robot, ( ) ∈ R2 , and the joint torques,
u ∈ R −1 , can be written as
φ̈ = u
̈ = (φ φ̇ ̇ ̇ ̇ u)
P (4)
̈ = =1
Fig. 2. Forces and torques acting on each link of the snake robot. P
̈ = =1
of the link with (tangential) and (normal) axis oriented where (φ φ̇ ̇ ̇ ̇ u) ∈ R is a complex function
such that they are oriented in the directions of the global of the state vector and the joint torques. The global frame
and axis, respectively, when the link angle is zero. The friction force on each link, represented by and , is
rotation matrix from the global frame to the frame of link either the viscous friction force defined in (2) or the Coulomb
is given by ∙ ¸ friction force defined in (3).
global cos − sin
Rlink = (1) III. A SIMPLIFIED MODEL OF A PLANAR SNAKE ROBOT
sin cos
This section summarizes a model of a planar snake robot
The forces and torques acting on link are visualized in which is described in detail in [13]. The model forms the
Fig. 2. The ground friction force is denoted by and acts on basis of the investigation of the fundamental locomotion
the CM of the link. The joint constraint forces from link +1 properties in Section V.
and link − 1 are denoted by and −−1 , respectively.
The actuator torque applied at joint is denoted by . A. Overview of the model
B. Friction model We consider a planar snake robot with links intercon-
nected by active revolute joints. The surface beneath the
We will consider two ground friction models in this
robot is flat and horizontal, and each link is subjected to
study, i.e. a viscous and a Coulomb friction model. Both
a viscous ground friction force. The body shape changes of
models assume that the links have anisotropic ground friction
the robot induce friction forces on the links that produce the
properties, which is essential for efficient snake locomotion
translational and rotational motion of the robot. A simplified
on planar surfaces.
model that captures only the most essential part of the snake
The viscous ground friction is characterized by the two
robot dynamics is proposed in [13]. The idea behind this
friction coefficients and describing the friction force in
model is illustrated in Fig. 3 and motivated by an analysis
the tangential (along link axis) and normal (along link
presented in [13], which shows that:
axis) direction of a link, respectively. Using (1), the viscous
friction force on link in the global frame as a function of • The forward motion of a planar snake robot is produced
the global link velocities, ̇ and ̇ , is defined as by the link velocity components that are normal to the
∙ ¸ forward direction.
global link global 0 • The change in body shape during forward locomotion
f = Rlink f = −Rlink v link
0 primarily consists of relative displacements of the CM
∙ ¸³ ´ ∙ ¸ (2) of the links normal to the forward direction of motion.
global 0 global ̇
= −Rlink Rlink Based on these two properties, the simplified model
0 ̇
describes the body shape changes of a snake robot as linear
where f link
and v link
are, respectively, the friction force displacements of the links with respect to each other instead
and the link velocity expressed in the local link frame. of rotational displacements. The linear displacements occur
The Coulomb ground friction force is defined in a similar normal to the forward direction of motion and produce
way by the two friction coefficients and describing friction forces that propel the robot forward. This essentially
the friction force in the tangential and normal direction of means that the revolute joints of the snake robot are modelled
a link, respectively. The Coulomb friction force on link in as prismatic (translational) joints and that the rotational mo-
the global frame is defined as tion of the links during body shape changes is disregarded.
The snake robot moves in the horizontal plane and has
+ 2 degrees of freedom. The motion is defined with
respect to the two coordinate frames illustrated in Fig. 4.
The - frame is the fixed global frame. The - frame is
always aligned with the snake robot, i.e. the and axis
always point in the tangential and normal direction of the
robot, respectively. The origin of both frames are fixed and
coincide.
As seen in Fig. 4 and Fig. 5, the global frame position
of the CM (center of mass) of the snake robot is denoted by
( ) ∈ R2 , while the - frame position is denoted by
( ) ∈ R2 . The global frame orientation is denoted by
Fig. 3. The revolute joints of the snake robot are modelled as prismatic ∈ R and is expressed with respect to the global axis with
joints that displace the CM of each link transversal to the direction of
motion. counterclockwise positive direction. The angle between the
global axis and the axis is also since the - frame
is always aligned with the snake robot. The relationship
between the - frame and the global frame position is given
by
be given by
v̇ = Av + b (23)
where
⎡ 2( −1)
⎤
− 1 2 0
Fig. 6. The optimal phase shift that maximizes the forward velocity of
A = A( ) = ⎣ 2( −1)
− 1 0 ⎦ (24)
2 a planar snake robot as a function of the number of links .
4 0 −3
⎡ 2
⎤
2 of the controller parameters , , , and . We can for
b = b( ) = ⎣ 0 ⎦ (25) example immediately see that the steady state velocity of
0 the snake robot when it conducts lateral undulation with zero
2
joint offset ( = 0) is given by = 2 , = 0,
and where the constant ∈ R is defined as 1
and = 0. In the following, we will use this result to
X X
−1 −1
deduce some fundamental relationships between the forward
= sin (( − ) ) (26)
velocity and the controller parameters of the snake robot.
=1 =1
The forward velocity is seen from (28a) to be proportional
We see that the averaged model of the velocity dynamics is to the controller parameter = 2 , i.e. the forward
a linear system characterized by the parameters of the joint velocity is proportional to the square of the amplitude of
reference coordinates, i.e. by , , , and . the joint motion, 2 , and also proportional to the angular
frequency, , of the joint motion. This information is useful
C. Analysis of the velocity dynamics
from a motion planning perspective since it tells us that an
The averaged model (23) has a single equilibrium point at increase/decrease of the forward velocity by a certain factor
v = −A−1 b. By inspecting the eigenvalues of A, it is shown can be achieved by increasing/decreasing by the same
in [16] that this equilibrium point is globally exponentially factor or by increasing/decreasing by the square root of
stable as long as the joint coordinate offset is below a this factor.
certain threshold. This means that the average velocity of the It is also seen from (28a) that the forward velocity of
snake robot will converge exponentially to the steady state the snake robot is proportional to the function defined in
velocity (26). Since is a function of the phase shift between the
£ ¤
v = −A−1 b = (27) joints, this means that the phase shift that will maximize the
forward velocity can be determined analytically as the that
which is given analytically by maximizes . This is particularly interesting since we are
1 2 now able to analytically determine the optimal phase shift
= ¡ 2 2 ¢ (28a) that maximizes the forward velocity of a planar snake robot
2 1 − (4 2 − 8 + 4) 22 2
with an arbitrary number of links . Fig. 6 presents a plot of
( − 1) 22 the maximum value of as a function of the number of links
= 2 2 (28b)
1 − (4 2 − 8 + 4) 22 2 . For each , the maximum value of was found using
1 2 4 the mathematical computer software Matlab. The optimal
= ¡ ¢ (28c) phase shift is e.g. = 90◦ for = 3 links, = 504◦ for
23 1 − (4 2 − 8 + 4) 22 2
2 2
= 5 links, = 241◦ for = 10 links, and = 115◦
The work in [16] provides more details regarding the cor- for = 20 links.
respondence between the average and the exact velocity of The above results can be summarized as follows:
the snake robot. The main result in [16] is basically that, Proposition 1: Consider a planar snake robot with
for sufficiently large , the average velocity of the snake links modelled by (7) and controlled in exact accordance
robot given by (23) will approximate the exact velocity given with (9) and (10). The average forward velocity of the snake
by (15) for all time, and the error of this approximation is robot given by (23) will converge exponentially to a value
bounded. which is proportional to:
Eq. (27) represents an interesting result since it gives an - the squared amplitude of the sinusoidal joint motion, 2 .
analytical expression for the steady state velocity of a snake - the angular frequency of the sinusoidal joint motion, .
robot with an arbitrary number of links as a function - the function of the constant phase shift, , between the
joints given by forward velocity. The simulation results with viscous and
−1
X X−1
Coulomb ground friction, respectively, are shown in Fig. 7.
= sin (( − ) ) (29) The number of links and the corresponding values of
=1 =1 and are shown at the top of each plot. The range of
values is shorter for large compared to for small since
where denotes element of the matrix . Moreover,
a large angle amplitude will cause a collision between the
for a given and , the phase shift, , that maximizes the
head and the tail of the snake when is large. The plots
average forward velocity is given by the that maximizes
clearly show an exponential increase in the forward speed
.
as the amplitude increases. This is in accordance with
VI. S IMULATION RESULTS Proposition 1.
Note that the amplitude of the joint motion cannot be
Proposition 1 was derived from the simplified model of
increased indefinitely. For sufficiently large , the relative
snake locomotion given by (7). The authors have verified by
link velocity components that are tangential to the forward
simulations that the velocity of the snake robot from the sim-
direction will no longer be negligible, which is assumed in
plified model complies very well with the properties stated
the simplified model of the snake robot. It is reasonable to
in Proposition 1. These simulation results are, however, not
expect that the increase in the forward velocity starts to decay
included in this paper due to space restrictions. Instead, the
for large . This decay can be seen in the plots with viscous
purpose of this section is to strengthen the significance of
friction in Fig. 7, which shows that the velocity increase has
Proposition 1 by illustrating that these properties also apply
a more linear character when becomes large.
to the velocity from the complex model of snake locomotion
given by (4). C. Relationship between the forward velocity and
A. Simulation parameters Proposition 1 states that the average forward velocity
of a planar snake robot is proportional to the angular fre-
The model of the snake robot (4) was implemented and quency, , of the joint motion. This result was investigated
simulated in Matlab R2008b on a laptop running Windows by simulating the snake robot with different values of
XP. The dynamics was calculated using the ode45 solver in and calculating the resulting average forward velocity. The
Matlab with a relative and absolute error tolerance of 10−3 . simulation results with viscous and Coulomb ground friction,
We considered snake robots with = 3, = 5, = 10, respectively, are shown in Fig. 8. The number of links and
and = 20 links of length = 014 m, mass = 1 the corresponding values of and are shown at the top
kg, and moment of inertia = 0.0016 kgm2 . Both viscous of each plot. With viscous friction, the plots show a clear
and Coulomb ground friction were considered. The friction linear increase in the forward speed as the frequency
coefficients of the viscous friction model defined in (2) were increases. This is in accordance with Proposition 1. With
set to = 05 and = 3, while the friction coefficients Coulomb friction, the forward speed increases linearly for
of the Coulomb friction model defined in (3) were set to = 3 links. However, for = 5, = 10, and = 20
= 01 and = 04. links, the forward speed seems to increase linearly up to a
The joints of the snake robot were controlled according certain frequency, after which the forward speed decreases.
to (12) with controller gains set to = 20 and = 5. This suggests that the Coulomb friction model (3) introduces
The joint reference coordinates were calculated according nonlinear couplings between the controller parameters , ,
to the motion pattern lateral undulation defined in (9) and that are not present when the viscous friction model
with zero joint angle offset ( = 0). The values of the (2) is used. To illustrate this nonlinear coupling further,
controller parameters , , and are presented with each the simulation of the snake robot with = 20 links was
simulation result. The initial state of the snake
³ ´ robot was repeated with the phase shift increased from = 115◦ to
= 0 = 0 = 0 ̇ = 0 ̇ = 0 ̇ = 0 . = 20◦ as shown in Fig. 9. In the Coulomb friction case,
The simulation results below present the average forward the forward speed now has a linear character over a much
speed of the snake robot, denoted by , for different sets of wider range of frequencies.
controller parameters. This average speed was calculated at In summary, the simulation results agree very well with
the end of each run of a simulation as the linear distance Proposition 1 for the case of viscous ground friction. With
travelled by the CM of the snake robot divided by the Coulomb ground friction, however, the linear increase of
simulation time, which was chosen to be sim = 10 s. The the forward speed as a function of is present only up
average speed was, in other words, calculated as to a certain frequency, which seems to depend on the other
controller parameters.
q
( (10) − (0))2 + ( (10) − (0))2 D. Relationship between the forward velocity and
= (30) The final result stated in Proposition 1 is that the average
10
forward velocity is maximized by the phase shift that
B. Relationship between the forward velocity and maximizes the function . To investigate the validity of this
Proposition 1 states that the average forward velocity of a result, we simulated the snake robot with different values
planar snake robot is proportional to the squared amplitude of to identify the phase shift that produced the highest
of the sinusoidal joint motion, 2 . We investigated the forward velocity. The simulation results with viscous and
validity of this result by simulating the snake robot with Coulomb ground friction, respectively, are shown in Fig. 10.
different values of and calculating the resulting average The number of links and the corresponding values of
Fig. 7. The average forward velocity of the snake robot for different values Fig. 8. The average forward velocity of the snake robot for different values
of . The number of links and the corresponding values of and are of . The number of links and the corresponding values of and are
shown at the top of each plot. shown at the top of each plot.
results showed that the phase shift between the joints that
maximizes the forward velocity of the snake is given by the
phase shift that maximizes the particular phase shift function.
The paper has presented simulation results that support the
validity of the derived properties. In future work, the authors
will employ the theoretical findings in this paper in order to
develop and analyse motion planning strategies for snake
robots.
R EFERENCES
[1] J. Gray, “The mechanism of locomotion in snakes,” J. Exp. Biol.,
vol. 23, no. 2, pp. 101–120, 1946.
[2] S. Hirose, Biologically Inspired Robots: Snake-Like Locomotors and
Manipulators. Oxford: Oxford University Press, 1993.
[3] M. Saito, M. Fukaya, and T. Iwasaki, “Serpentine locomotion with
robotic snakes,” IEEE Contr. Syst. Mag., vol. 22, no. 1, pp. 64–81,
February 2002.
[4] G. P. Hicks, “Modeling and control of a snake-like serial-link struc-
ture,” Ph.D. dissertation, North Carolina State University, 2003.
[5] M. Nilsson, “Serpentine locomotion on surfaces with uniform friction,”
in Proc. IEEE/RSJ Int. Conf. Intelligent Robots and Systems, 2004, pp.
1751–1755.
[6] A. A. Transeth, N. van de Wouw, A. Pavlov, J. P. Hespanha, and
K. Y. Pettersen, “Tracking control for snake robot joints,” in Proc.
IEEE/RSJ Int. Conf. Intelligent Robots and Systems, San Diego, CA, Fig. 10. The average forward velocity of the snake robot for different
USA, Oct-Nov 2007, pp. 3539–3546. values of . The number of links and the corresponding values of and
[7] J. Li and J. Shan, “Passivity control of underactuated snake-like are shown at the top of each plot.
robots,” in Proc. 7th World Congress on Intelligent Control and
Automation, June 2008, pp. 485–490.
[8] P. Liljebäck, K. Y. Pettersen, Ø. Stavdahl, and J. T. Gravdahl, “Stability [13] P. Liljebäck, K. Y. Pettersen, Ø. Stavdahl, and J. T. Gravdahl, “A
analysis of snake robot locomotion based on poincaré maps,” in Proc. simplified model of planar snake robot locomotion,” in Proc. IEEE/RSJ
IEEE/RSJ Int. Conf. Intelligent Robots and Systems, 2009, pp. 3623– Int. Conf. Intelligent Robots and Systems, 2010, accepted.
3630. [14] H. K. Khalil, Nonlinear Systems, 3rd ed. Prentice Hall, 2002.
[9] ——, “Controllability analysis of planar snake robots influenced by [15] J. A. Sanders, F. Verhulst, and J. Murdock, Averaging Methods in
viscous ground friction,” in Proc. IEEE/RSJ Int. Conf. Intelligent Nonlinear Dynamical Systems, 2nd ed., ser. Applied Mathematical
Robots and Systems, 2009, pp. 3615–3622. Sciences. Springer, 2007, vol. 59.
[10] P. A. Vela, K. A. Morgansen, and J. W. Burdick, “Underwater [16] P. Liljebäck, K. Y. Pettersen, Ø. Stavdahl, and J. T. Gravdahl, “Stability
locomotion from oscillatory shape deformations,” in Proc. IEEE Conf. analysis of snake robot locomotion based on averaging theory,” in
Decision and Control, vol. 2, Dec. 2002, pp. 2074–2080 vol.2. Proc. IEEE Int. Conf. Decision and Control, 2010, submitted.
[11] K. McIsaac and J. Ostrowski, “Motion planning for anguilliform
locomotion,” IEEE Trans. Robot. Autom., vol. 19, no. 4, pp. 637–625,
August 2003.
[12] K. Morgansen, B. Triplett, and D. Klein, “Geometric methods for mod-
eling and control of free-swimming fin-actuated underwater vehicles,”
IEEE Transactions on Robotics, vol. 23, no. 6, pp. 1184–1199, Dec
2007.