Beruflich Dokumente
Kultur Dokumente
net/publication/256089847
CITATION READS
1 3,413
4 authors:
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Helder P. Oliveira on 15 May 2014.
Abstract: Omni-directional robots are becoming more and more common in recent robotic applications. They offer
improved ease of maneuverability and effectiveness at the expense of increased complexity. Frequent appli-
cations include but are not limited to robotic competitions and service robotics. The goal of this work is to
find a precise dynamical model in order to predict the robot behavior. Models were found for two real world
omni-directional robot configurations and their parameters estimated using a prototype that can have 3 or 4
wheels. Simulations and experimental runs are presented in order to validate the presented work.
1 INTRODUCTION
Omni-directional robots are becoming a much sought
solution to mobile robotic applications. This kind of
holonomic robots are interesting because they allow
greater maneuverability and efficiency at the expense
of some extra complexity. One of the most frequent
solutions is to use some of Mecanum wheels (Diegel
et al., 2002) and (Salih et al., 2006). A robot with 3
or more motorized wheels of this kind can have al- (a) Three wheeled robot. (b) Four wheeled robot.
most independent tangential, normal and angular ve-
locities. Dynamical models for this kind of robots are Figure 1: Omni-directional robot.
not very common due to the difficulty in modeling
the several internal frictions inside the wheels, mak- wheel configuration, see figure 1.
ing the model somewhat specific to the type of wheel Data from experimental runs is taken from over-
being used (Williams et al., 2002). head camera. The setup is taken from the heritage
Frequent mechanical configurations for omni- of the system described in (Costa et al., 2000) that
directional robots are based on three and four wheels. currently features 25 fps, one centimeter accuracy in
Three wheeled systems are mechanically simpler but position(XX and YY axis) and about 3 sexagesimal
robots with four wheels have more acceleration with degrees of accuracy in the heading of the robot.
the same kind of motors. Four wheeled robots are In order to increase the performance of robots,
expected to have better effective floor traction, that there were some efforts on the studying their dy-
is, less wheel slippage – assuming that all wheels namical models (Campion et al., 1996)(Conceição
are pressed against the floor equally. Of course four et al., 2006)(Khosla, 1989)(Tahmasebi et al.,
wheeled robots also have a higher costs in equipment, 2005)(Williams et al., 2002) and kinematic models
increased energy consumption and may require some (Campion et al., 1996) (Leow et al., 2002)(Loh et al.,
kind of suspension to distribute forces equally among 2003)(Muir and Neuman, 1987)(Xu et al., 2005).
the wheels. Models are based on linear and non linear dynami-
In order to study and compare the models of the cal systems and the estimation of parameters has been
3 and 4 wheeled robots, a single prototype was built the subject of continuing research (Conceição et al.,
that can have both configurations, that is, the same 2006)(Olsen and Petersen, 2001). Once the dynam-
mechanical platform can be used with 3 wheels and ical model is found, its parameters have to be esti-
then it can be disassembled and reassembled with a 4 mated. The most common method for identification
189
ICINCO 2008 - International Conference on Informatics in Control, Automation and Robotics
190
DYNAMICAL MODELS FOR OMNI-DIRECTIONAL ROBOTS WITH 3 AND 4 WHEELS
The relationship between the wheels speed v0 , v1 , v2 The relationship between the traction forces and rota-
and v3 , with the robot speeds v, vn and ω is described tion torque of the robot with the traction forces on the
wheels is described by the following equations:
by equation 6.
⎡ ⎤ ⎡ ⎤ ⎡ ⎤ ∑ Fv (t) = ( f2 (t) − f0 (t)) · sin(π/3) (13)
v0 (t) 0 1 d
⎢ 1
v (t) ⎥ ⎢ −1 0 d ⎥
v(t) ∑ Fvn (t) = − f1 (t) + ( f2 (t) + f0 (t)) · cos(π/3)(14)
⎣ v (t) ⎦ = ⎣ 0 −1 d ⎦ · ⎣ vn(t) ⎦ (6)
2
ω(t)
∑ T (t) = ( f0 (t) + f1 (t) + f2 (t)) · d (15)
v3 (t) 1 0 d The traction force on each wheel is estimated by trac-
It is possible to obtain the equations that determine the tion torque, which can be determined using the motor
robot speeds related with wheels speed but the matrix current, as described in the following equations:
associated with equation 6 is not square. This is be- f j (t) = T j (t)/r (16)
cause the system is redundant. It can be found that:
T j (t) = l · Kt · i j (t) (17)
v(t) = (1/2) · (v3 (t) − v1 (t)) (7)
vn(t) = (1/2) · (v0 (t) − v2 (t)) (8)
• l - Gearbox reduction;
ω(t) = (v0 (t) + v1 (t) + v2 (t) + v3 (t))/(4 · d) (9)
• r [m] - Wheel radius;
• Kt [N · m/A] - Motor torque constant;
• i j [A] - Motor current (j=motor number).
3.2 Dynamic
3.2.2 Four Wheeled Robot
The dynamical equations relative to the accelerations
can be described in the following relations: The relationship between the traction forces and rota-
tion torque of the robot with the traction forces on the
dv(t) wheels, is described by the following equations:
M· = ∑ Fv (t) − FBv (t) − FCv (t) (10)
dt
dvn(t)
∑ Fv (t) = f3 (t) − f1 (t) (18)
M·
dt
= ∑ Fvn (t) − FBvn (t) − FCvn (t) (11) ∑ Fvn (t) = f0 (t) − f2 (t) (19)
J·
dω(t)
= ∑ T (t) − TBω (t) − TCω (t) (12) ∑ T (t) = ( f0 (t) + f1 (t) + f2 (t) + f3 (t)) · d (20)
dt
As above, the traction force in each wheel is esti-
where the following parameters relate to the robot as mated using the wheels traction torque, which is de-
follows: termined by the motor current, using equations 16 and
• M [kg] - mass; 17, where j=0,1,2,3.
• J [kg · m2 ] - inertia moment;
3.3 Motor
• FBv , FBvn [N] - viscous friction forces along v and vn;
• TBω [N · m] - viscous friction torque with respect to the The prototype uses brushless motors for the locomo-
robot’s rotation axis; tion of the robot. The model for brushless motors is
the similar to the common DC motors, based on (Pil-
• FCv , FCvn [N] - Coulomb frictions forces along v and vn; lay and Krishnan, 1989).
• TCω [N · m] - Coulomb friction torque with respect to
di j (t)
robot’s rotation axis. u j (t) = L· + R · i j (t) + Kv · ωm j (t) (21)
dt
Viscous friction forces are proportional to robot’s Tm j (t) = Kt · i j (t) (22)
speed and as such FBv (t) = Bv · v(t), FBvn (t) = Bvn · vn(t)
and TBω (t) = Bω · ω(t), where Bv, Bvn [N/(m/s)] are the
viscous friction coefficients for directions v and vn • L [H] - Motor inductance;
and Bω [N · m/(rad/s)] is the viscous friction coeffi- • R [Ω] - Motor resistor;
cient to ω. • Kv [V /(rad/s)] - EMF motor constant;
The Coulomb friction forces are constant in am-
• u j [V ] - Motor voltage (j=motor number);
plitude FCv (t) = Cv · sign(v(t)), FCvn (t) = Cvn · sign(vn(t))
and TCω (t) = Cω · sign ω(t), where Cv,Cvn [N] are • ωm j [rad/s] - Motor angular velocity (j=motor num-
ber);
Coulomb friction coefficient for directions v e vn and
Cω [N · m] is the Coulomb friction coefficient for ω. • Tm j [N · m] - Motor torque (j=motor number).
191
ICINCO 2008 - International Conference on Informatics in Control, Automation and Robotics
192
DYNAMICAL MODELS FOR OMNI-DIRECTIONAL ROBOTS WITH 3 AND 4 WHEELS
⎡ √ √ ⎤
l · Kt ⎣ − 3/(2 · M) 0 3/(2 · M)
B= · 1/(2 · M) 1/M 1/(2 · M) ⎦ (33)
r·R d/J d/J d/J
⎡ ⎤
−Cv /M 0 0
K = ⎣ 0 −Cvn /M 0 ⎦ (34)
0 0 −Cw /J
193
ICINCO 2008 - International Conference on Informatics in Control, Automation and Robotics
1. Matrix A, robot moving along v direction; Estimated parameters can be skewed and for this rea-
• Three wheeled robot: son instrumental variables are used to minimize the
error, with vector of states defined as
3 · Kt2 · l 2 Ka1
= = 3.3110 z = [x1 (1) . . . x1 (n) x2 (1) . . . x2 (n) x3 (1) . . . x3 (n)]T (41)
2 · r2 · R · M R
(Bv /M) = Ka2 · Bv = 0.3245 The parameters θ are now calculated by:
−1
• Four wheeled robot: θ = zT · x · zT · y (42)
2 · Kt2 · l 2 Ka1 Three experiments were made for each configuration
= = 3.6676
r2 · R · M R of 3 and 4 wheels, along v, vn and ω. For the v and
(Bv /M) = Ka2 · Bv = 0.2041 vn experiments values Cv and Cvn are kept from pre-
2. Matrices B and K, robot moving along v direction with vious analysis. For the ω experiment, the value of
constant voltage motor equal to 6V ; the R parameter used is the already improved version
• Three wheeled robot: from previous v and vn experimental runs of the cur-
√ rent section.
3 · l · Kt K The numerical value of R for each motor was
· 12 = b · 12 = 5.7570
2·r·R·M R estimated for each motor and then averaged to find
(Cv /M) = Kk ·Cv = 0.8728 R=4.3111 Ω. The results are present on followings ta-
bles. Table 2 shows values estimated by the experi-
• Four wheeled robot: ment mentioned in this section.
l · Kt K
· 12 = b · 12 = 5.5227
r·R·M R Table 2: Parameters estimated using the method 3.
(Cv /M) = Kk ·Cv = 0.7879 Parameters 3 wheels 4 wheels
The same kind of analysis could be taken further by J(kg · m2 ) 0.0187 0.0288
Bv (N/(m/s)) 0.5134 0.5181
analyzing other velocities (vn and ω). Conclusions
Bvn (N/(m/s)) 0.4571 0.7518
reaffirm that motor parameters have more influence Bω N · m/(rad/s) 0.0150 0.0165
in the dynamics than friction coefficients. This means Cω (N · m) 0.0812 0.1411
that it is very important to have an accurate estima-
tion of the motor parameters. Some additional ex-
periences were designed to improve accuracy. The The final values for friction and inertial coeffi-
method used previously does not offer sufficient ac- cients are averaged with results from all 3 experimen-
curacy to the estimation of R. This parameter R is tal methods and the numerical values found are pre-
not a physical parameter and includes a portion of the sented in Table 3.
non-linearity of the H bridge powering the circuit that,
Table 3: Parameters of dynamical models.
in turn, feeds 3 rapidly switching phases of the brush-
less motors used. In conclusion, additional accuracy Parameters 3 wheels 4 wheels
in estimating R is needed. d(m) 0.089
r (m) 0.0325
5.5 Experience 3 - Parameter l 5
Kv (V /(rad/s)) 0.0259
Estimation Improvement R (Ω) 4.3111
M(kg) 1.944 2.34
The parameter improving experience was made using J (kg · m2 ) 0.0169 0.0228
a step voltage with an initial acceleration ramp. Bv (N/(m/s)) 0.5082 0.4978
As seen in 5.1 the model was defined by the equa- Bvn (N/(m/s)) 0.4870 0.6763
tion 30 and we can improve the quality of the estima- Bω (N · m/(rad/s)) 0.0130 0.0141
tion by using the Least Squares method. The system Cv (N) 1.9068 1.8738
model equation can be rewritten as: Cvn (N) 2.0423 2.2198
y = θ1 · x1 + θ2 · x2 + θ3 · x3 (38) Cω (N · m) 0.0971 0.1385
194
DYNAMICAL MODELS FOR OMNI-DIRECTIONAL ROBOTS WITH 3 AND 4 WHEELS
195
ICINCO 2008 - International Conference on Informatics in Control, Automation and Robotics
196