Professional Documents
Culture Documents
where an orthogonal rotation matrix R(θ) is defined to The relationships between the robot’s traction forces and
map the world frame into the robot frame, and vice versa: the wheel’s traction forces are,
cos(θ) sin(θ) 0
" #
R(θ) = −sin(θ) cos(θ) 0 (2) Fv (t) = cos(δ)(f2 (t) − f3 (t)) (7)
0 0 1
Fvn (t) = −f1 (t) + sen(δ)f2 (t) + sen(δ)f3 (t) (8)
The robot pose is fully described by the vector: ξ =
[xr yr θ]T , where xr and yr is the localization of the Γ(t) = (f1 (t) + f2 (t) + f3 (t))b. (9)
point P in the world frame, and θ the angular difference
between the world and robot frames. ξ˙r = [v vn w]T is the The wheel’s traction force on each wheel i (for i = 1, ..., 3)
velocity vector at the robot frame and describes the linear is
velocity of the robot at the point P , represented by the Ti (t)
orthogonal components v and vn , and the angular velocity fi (t) = . (10)
ri
of the robot’s body, represented by w.
with Ti the rotation torque of the wheels.
The relationships between robot velocities (v, vn and w)
and wheel’s angular velocities (wmi , for i = 1, ..., 3) are The dynamics of each DC motor i (for i = 1, ..., 3) can be
given by: described using the following equations,
√ √
0
r2 3 −r3 3 diai (t)
3 3
ui (t) = Lai + Rai iai (t) + Kvi wmi (t), (11)
dt
" # "w #
v
2r m1
r2 r3
vn =
3
1 wm2 , (3) Ti (t) = li Kti iai (t), 0 ≤ iai (t) ≤ imax (12)
3 3
w wm3
where Lai are the motor’s armature inductance, Rai are
r1 r2 r3
3b 3b 3b the motor’s armature resistance, li are the motor’s gear
with b the distance between the point P and robot’s ratio reduction, and wmi the angular velocity of the wheels.
wheels, ri the radius of each wheel i, and the angle δ equal The armature current is limited to save battery, where
to 30 degrees. imax (A) is a design parameter. The armature voltage is
u(t), with input signal constraints: −6(V olts) ≤ u(t) ≤
2.2 Dynamics of the robot 6(V olts) for t ≥ 0. In SI unit system, the values
of Kt (motor’s torque constant) and Kv (motor’s elec-
tromotive force constant) are identical, see Kuo (1995):
The omnidirectional mobile robot model is developed
Kt (N.m/A) = Kv (V olts/(rad/sec)).
based on the dynamics, kinematics and dynamics of DC
motors of the robot. By Newton’s law of motion and the
robot’s body frame, in Figure 1(a), the dynamic model is 2.3 State Space Representation
described by
In this subsection, the robot model in the state-variable
dv(t) form is presented. By combining previously mentioned
Fv (t) − Bv v(t) − Cv sgn(v(t)) = M , (4) equations, it is possible to show that model equations can
dt
dvn (t) be rearranged into a variation of the state space that can
Fvn (t) − Bvn vn (t) − Cvn sgn(vn (t)) = M , (5) be described as
dt
dw(t)
Γ(t) − Bw w(t) − Cw sgn(w(t)) = In , (6) ẋ(t) = Ax(t) + Bu(t) + Ksgn(x(t)) (13)
dt
where,
y(t) = Cx(t) (14)
1, α > 0,
(
T
sgn(α) = 0, α = 0, where the vector u(t) = [u1 (t) u2 (t) u3 (t)] is the input
−1, α < 0. and the vectors y(t) = x(t) = [v(t) vn (t) w(t)]T are the
output and the state-variables of the system. Considering
F = [Fv Fvn Γ]T represents the vector force (Fv and l = l1...3 , r = r1...3 , Ra = Ra1...3 and Kt = Kt1...3 ,
Fvn ) in the robot frame and the moment (Γ) around the the simplified state-variable-form matrices defining this
center of gravity for the mobile robot (point P ). The system are
robot mass is M and the robot inertia moment is In . The 3l2 Kt2 Bv
viscous frictions (Bv v(t), Bvn vn (t) and Bw w(t)) represent − − 0 0
2M Ra r 2 M
a retarding force, which is a linear relationship between 3l2 Kt2 Bvn
A = 0 − − 0 ,
the applied force and the velocity. The coulomb frictions 2M Ra r 2 M
(Cv sgn(v(t)), Cvn sgn(vn (t)) and Cw sgn(w(t))) represent 3b2 l2 Kt2 Bw
0 0 − −
a retarding force that has constant amplitude with respect JRa r 2 In
cos(δ) cos(δ)
to the change of velocity, but the sign changes with the 0 −
reversal of the direction of velocity, (Kuo, 1995). Bv , Bvn M M
lKt −1 sen(δ) sen(δ)
and Bw are the viscous friction coefficients related to v, B=
,
Ra r
M M M
vn and w respectivelly, and Cv , Cvn and Cw the coulomb
b b b
friction coefficients. In In In
8
IFAC SYROCO 2012
September 5-7, 2012. Dubrovnik, Croatia
(a) Geometric parameters and reference frames. (b) Omnidirectional mobile robot.
9
IFAC SYROCO 2012
September 5-7, 2012. Dubrovnik, Croatia
(a) u = (0, 3, −3). (b) u = (−4, 2, 2). (c) u = (1.5, 1.5, 1.5).
(d) ia1 , ia2 , ia3 . (e) ia1 , ia2 , ia3 . (f) ia1 , ia2 , ia3 .
4. ANALYSIS OF THE MODEL while applying zero volt in motor 1, 2 volts in motor 2 and
-2 volts in motor 3, the velocity of the robot is in the
This section presents results to verify the behavior of the direction of vector v.
estimated model and compare it with real results of the The results of simulation and the robot velocities are
robot. The model has the voltage of the motors as inputs shown in Figure 4. The model gives a good representation
and velocity of the robot’s center of mass as outputs. of the robot state. For cases in which the robot has
Experiments were carried out by applying voltages on velocities v and vn , the presence of noise is bigger when
motors and in the model, as shown in Table 4. For example,
10
IFAC SYROCO 2012
September 5-7, 2012. Dubrovnik, Croatia
compared with the velocities w. This is easily explained An example of control application can be seen in Araújo
by the geometry of the robot, which to generate velocities et al. (2011), where a methodology for state feedback
in the v direction only two of the three motors are active, MPC (Model Predictive Control) synthesis applied to the
in addition the wheels have an angle of 30 degrees related trajectory tracking control problem was proposed. In the
to velocity vector v (see Figure 1(b)). In the case of w, referred work, the model used in this work was used to
the three motors are active simultaneously in the same predict the future robot positions and orientations and
direction and with the same input voltage, making less takes into account elements such as saturation and friction.
noise. It is important to say that, in open loop experiments,
any undulation in the floor would cause a small difference ACKNOWLEDGEMENTS
in the transient and steady state responses.
The model considers the effect of static friction and there- The authors would like to acknowledge the financial sup-
fore the open loop response should represent the dead port of the Brazilian National Research Council - CNPq.
zone. To verify this effect, experiments were performed
as shown in Figure 5. For the velocities v, Figure 5(a), REFERENCES
the model represented accurately the effect of dead zone Astrom, K. J. (1998). Control of systems with friction,
compared with the robot. For velocities w, Figure 5(b), Proceedings of the Fourth International Conference on
the model also achieved a good performance. For v and Motion and Vibration Control, pp. 25–32.
vn the necessary voltages for the robot start to move are Baril, C. (1993). Control od Mechanical Systems Affected
bigger (around 1 volt) due to the presence of a larger static by Friction and Other Nondifferentiable Nonlinearities,
friction caused by the geometry of the mobile base. To Phd thesis, Israel Institute of Techonology, Switzerland.
overcome this inertia in w, the necessary voltage is around Barreto, J. C., Conceição, A. S. and Dorea, C. E. T.
0.3 volts. (2010). Predictive control of an omnidirectional mo-
Velocity v
bile robot with friction compensation, Latin American
Motor 1 Motor 2 Motor 3 Robotics Symposium and Intelligent Robotics Meeting -
u1 (volts) u2 (volts) u3 (volts) LARS2010, pp. 30–35.
0 2 -2 Canudas de Wit, C., Olsson, H., Astrom, K. and Lischin-
0 3 -3 sky, P. (1995). A new model for control of systems
0 4 -4
with friction, IEEE Transactions on Automatic Control
Velocity vn
Motor 1 Motor 2 Motor 3
40(3): 419 –425.
u1 (volts) u2 (volts) u3 (volts) C.C. de Wit, B. S. and Bastin, G. (1997). Theory of Robot
-2 1 1 Control, Springer-Verlag Ltd.
-3 1.5 1.5 Conceicao, A., Moreira, A. and Costa, P. (2009). Practical
-4 2 2 approach of modeling and parameters estimation for om-
Velocity w nidirectional mobile robots, IEEE/ASME Transactions
Motor 1 Motor 2 Motor 3
u1 (volts) u2 (volts) u3 (volts)
on Mechatronics 14(3): 377 –381.
2 2 2 Dahl, P. R. (1976). Solid friction damping of mechanical
3 3 3 vibrations, AIAA Journal pp. 1675–1682.
4 4 4 Friedland, B. and Park, Y. J. (1992) On adaptive friction
Table 4. Applied voltages. compensation, IEEE Transactions on Automatic Con-
trol 37(10): 1609 –1612.
Hess, D. P. and Soom, A. (1990). Friction at a lubricated
line contact operating at oscillating sliding velocities,
5. CONCLUSION Journal of Tribology 112(1): 147–152.
Karnopp, D. (1985). Computer simulation of stick-slip
In this paper, a mobile robot modeling including coulomb friction in mechanical dynamic systems, Journal of Dy-
and viscous friction in the composition of the robot forces namic Systems, Measurement, and Control 107(1): 100–
has been proposed. This is a simplified friction model when 103.
compared to existing models in the literature (for example, Kuo, B. C. (1995). Automatic Control Systems, John
Lugre and Dahl). The model showed a good agreement Wiley & Sons Ltd.
with real data and with the mapping of the dead zone Olsson, H. (1996). Control Systems with Friction, Phd
effects. We can see an acceptable difference between the thesis, Lund Institute of Technology, University of Lund,
estimated values, taking into account that the measured Lund.
values of currents and velocities have a considerable noise, Araújo, H. X., Conceicao, A. G. S., Oliveira, G. H.
and any irregularity in the floor can cause alterations in C., Pitanga, J. R. (2011). Model Predictive Control
parameters of the robot. A practical approach to estimate Based on LMIs Applied to an Omni-Directional Mobile
the coefficients of friction was used, based on sensory infor- Robot, Proceedings of the 18th IFAC World Congress,
mation from the motor current and the robot speed, easily 18(1): 8171–8176.
applicable in any configuration of vehicle which provides
these logs. Finally, a model that represents non-linear
elements are essential to controllers design, especially when
the robot is subjected to different operating conditions
such as uneven terrain or the transportation of different
loads, which require maximum forces of the actuators.
11
IFAC SYROCO 2012
September 5-7, 2012. Dubrovnik, Croatia
(a) Inputs u: (0; 2;-2), (0; 3; -3) e (0;4; -4). (b) Inputs u: (-2;1;1), (-3;1.5;1.5) e (-4;2;2).
12