Professional Documents
Culture Documents
net/publication/221645155
CITATIONS READS
2 925
2 authors:
Some of the authors of this publication are also working on these related projects:
B-RELIABLE: Boosting reliability and interaction on brain-machine interface systems integrating automatic error-detection View project
All content following this page was uploaded by Urbano J. Nunes on 28 May 2014.
Keywords: Users comfort, sliding-mode control, human head-neck complex model, intelligent wheelchair.
Abstract: This paper analyzes the comfort of wheelchair users when a sliding-mode trajectory-tracking controller is
used. The transmission of the horizontal (fore-and-aft) vibration to the head-neck complex (HNC) in the
seated human body may cause unacceptable discomfort and motion sickness. A double-inverted pendulum
model with two degrees of freedom is considered as a model for the HNC. The user comfort is examined not
only in the time domain (using the fourth power vibration dose value), but also in the frequency domain (using
the cross-spectral density method). For measuring the acceleration of the wheelchair, along the trajectory, an
inertial measurement unit was used.
3 E(0,3,π/2) 0.2
H(6,2,−π/2)
y [m]
2 J(2,2,π/2) 0.1
L(6,2,−π/2)
D(1,2,π)
1 C(2,1,π/2) 0
AB BC CD DE EF FG GH HI IJ JK KL LM MN
0
(Solea et al., 2006) a SM-TT controller for WMRs is
proposed, where trajectory tracking is achieved even
−0.5
in the presence of large initial pose errors and distur-
0 10 20 30 40 50 60
time [s]
bances.
Longitudinal accel. Let us define the sliding surface s = [s1 s2 ]T as
1
Lateral accel.
s1 = ẋe + k1 · xe ,
Acceleration [m/s ]
2
0.5
(5)
s2 = ẏe + k2 · ye + k0 · sgn(ye ) · θe .
0
−0.5
where k0 , k1 , k2 are positive constant parameters, xe ,
ye and θe are the trajectory-tracking errors defined in
−1
0 10 20 30 40 50 60 (3). If s1 converges to zero, trivially xe converges to
time [s]
zero. If s2 converges to zero, in steady-state it be-
comes ẏe = −k2 · ye − k0 · sgn(ye ) · θe . For ye < 0 ⇒
Figure 2: Velocity and acceleration profiles for path de-
picted in Fig. 1 y˙e > 0 if only if k0 < k2 · |ye | / |θe |. For ye > 0 ⇒
y˙e < 0 if only if k0 < k2 · |ye | / |θe |. Finally, it can be
For motion on the x-y plane, awz = 0. The local co- known from s2 that convergence of ye and ẏe leads
ordinate system is chosen so that the x-axis is the lon- to convergence of θe to zero. Using the reaching law
gitudinal trajectory direction, and y-axis is the lateral defined in (Gao and Hung, 1993)
trajectory direction.
ṡ = −Q · s − P · sgn(s) (6)
The ISO 2631-1 standard (ISO-2631, 1997) (Ta-
ble 1) relates comfort with the overall r.m.s. accelera- Q = diag [q1 , q2 ] , qi > 0,
tion, acting on the human body. P = diag [p1 , p2 ] , pi > 0, i = 1, 2
Figure 1 shows the generated path, where the sgn(s) = [sgn(s1 ), sgn(s2 )]T
larger circles represent the used fourteen waypoints
(A, B, ..., N). Each waypoint is defined by a position, together with (5), and after some mathematical ma-
in meters, and an orientation, in radians. The gener- nipulation, we get the commands for trajectory-tra-
ated velocity and acceleration profiles are shown in cking controller:
Fig. 2. As can be observed in Fig.3, the r.m.s overall 1
accelerations, in each path segment, are below the im- v̇c = (−q1 s1 − p1 sgn(s1 ) − k1 ẋe −
cosθe (7)
posed acceleration constraint of aw(i,i+1) < 0.31m/s2 . −ye ω̇d − ẏe ωd + vr θ̇e sinθe + v̇d ).
y [m]
2
START
0
FINISH
−1
−1 0 1 2 3 4 5 6 7
x [m]
0.5
0
0
vd, vc, vr
20
vr
40
time [s] vc
60
vd
Angular Velocity [rad/s]
0.5
−0.5
−1
Figure 7: RobChair hardware architecture. 0
wd, wc, wr
20
wr
time [s] 40
wc
60
wd
All the distributed devices, connected through
CAN, use a base printed circuit board, containing Figure 9: Desired (vd , ωd ), command (vc , ωc ) and real
a microchip micro-controller (µC), as described in (vr , ωr ) linear/angular velocities for SM-TT control under
magnetic-markers navigation (case B).
(Maia, 2004). A custom communication protocol,
based on the time-triggered protocol paradigm, was
designed and implemented. All events are synchro- The inertial sensor RGA300CA-100 (Crossbow)
nized by a message, sent from a Synchronization was used for measuring the wheelchair accelerations
Micro-Controller Unit (Trigger Node, in Fig. 7), that in three orthogonal directions.
synchronizes the other Micro-Controller Units, and Experimental results of the SM-TT controller us-
defines the control loop time reference. ing the planned path presented in Fig 1, are shown
The odometric data provided by the wheel en- in Figs. 8- 10. Figure 9 shows desired, command
coders is fused with the data from magnetic mark- and real linear and angular velocities for SM-TT con-
ers. The extended Kalman filter (EKF) was chosen for trol under magnetic-markers navigation. Corrections
the fusion process (Bento et al., 2005). This naviga- in the pose after each magnetic marker detection pro-
tion technology, based on sensing magnetic markers, vokes an error signal that is efficiently dealt by the
is well suited when high precision navigation and ro- SM-TT controller, and rapidly the tracking errors con-
bustness is required, and it can be used to complement verge to zero (see Fig. 10).
other navigation systems, such as GPS. The analysis of user comfort is made in three dif-
Table 3: EXPERIMENTAL RESULTS.
Case No V DVx V DVx Tr RMS accel. Max. accel RMS accel. Max. accel
RobChair Head RobChair RobChair Head Head
I 2.9219 1.3826 0.4732 0.3287 1.5686 0.1656 0.7286
A II 2.7634 1.3429 0.4859 0.3191 1.4988 0.1589 0.7307
III 2.7177 1.2802 0.4710 0.3187 1.5590 0.1510 0.8210
average 2.8010 1.3352 0.4767 0.3222 1.5421 0.1585 0.7601
I 2.9481 1.4408 0.4887 0.3538 1.2853 0.1797 0.7100
B II 3.2946 1.5707 0.4767 0.3663 1.7635 0.1856 0.7988
III 3.0318 1.4860 0.4901 0.3629 1.4136 0.1828 0.7755
average 3.0915 1.4992 0.4852 0.3610 1.4875 0.1827 0.7614
C - 11.4623 5.4607 0.4764 1.5185 4.1708 0.7039 2.2210
Longitudinal and lateral errors [m] Cross PSD Estimate via Welch
0.25 10
xe C
0.2
ye 0
0.15
Power/frequency (dB/Hz)
0.1
−10
0.05
x , y [m]
e
0 −20
e
−0.05
−30
−0.1
−0.15
−40 A, B
−0.2
−0.25 −50
0 10 20 30 40 50 60 0 2 4 6 8 10
time [s] Frequency (Hz)
Figure 10: Longitudinal and lateral errors for SM-TT con- Figure 11: Cross-spectal density functions for all experi-
trol under magnetic-markers navigation (case B). ments.