Professional Documents
Culture Documents
due to the system’s interaction with the environment. which indicates that the estimation error will exponentially
decay, and the low pass corner frequency can be considered
B. Disturbance estimation as the observer gain. In other words, changing the observer
Equation.1 represents the mechanical dynamics of the ac- gain controls the speed of the estimation convergence.
tuator without considering its parameters variation, that are
given as follows [6]- [7] t −→ ∞ =⇒ d −→ 0
d −→ 0 =⇒ d −→ d
Jm = Jmo + Jm (3)
kt = kto + kt The direct differentiation of the velocity signal can be avoided
by using the following observer configuration to keep the noise
Where kt is the actuator’s torque constant, Jmo and kto are amplification level as low as possible [8]- [9].
the nominal actuator’s inertia and torque constant while Jm gdist
and kt are the variation between the actual and nominal d = [Jmo θ̇m + kto im ] − gdist Jmo θ̇m (13)
s + gdist
actuator’s inertia and torque constant. Rewriting eq.1
C. Reflected Torque Wave Decoupling
(Jmo + Jm )θ̈m = (kto + kt )im − τref (4)
Disturbance estimate obtained using eq.6, can be written as
re-arranging the terms follows
τref = −d − Jm θ̈m + kt im (14)
Jmo θ̈m = kto im − τref − Jm θ̈m + kt im (5)
Where, Jm θ̈m and kt im are the actuator’s varied self- which indicates that in order to decouple the reflected wave out
inertia torque and actuator’s torque ripple. Therefore, the of the estimated disturbance, the self varied-inertia torque and
disturbance on the actuator side is actuator’s torque ripple have to be determined first. Keeping in
mind that variation between the actual and nominal actuator’s
d = −τref − Jm θ̈m + kt im (6) parameters are inherent properties of the actuator. In other
words, they are independent to the plant connected with the
which indicates that the disturbance on the actuator side is
actuator. Therefore, they can be estimated from the unloaded
composed of two components. The last two terms of the right
actuator and in this case the reflected torque wave is eliminated
hand side of eq.6 represents the first disturbance component
from equations of motion eq.1.
that is related to the actuator parameters’s variations. While
the second disturbance component τref is due to the attached (Jmo + Jm )θ̈m + B θ̇m = (kto + kt )im (15)
system with this actuator. Therefore, disturbance d has to be
Jmo θ̈m = kto im + dpar (16)
estimated then reflected torque wave has to be decoupled out
of it. From eq.5 the disturbance d can be computed as follows where dpar is the Actuator’s parameters variation disturbance
2
d θm dpar = kt im − Jm θ̈m − B θ̇m (17)
d = Jmo − kto im (7)
dt2
or estimated through a low pass with a corner frequency gdist that can be estimated using the actuator’s current and velocity
through a low pass filter as follows
gdist
d = [Jmo θ̈m − im kto ] (8) gdist
s + gdist dpar = [Jmo θ̇m + im kto ] − gdist Jmo θ̇m (18)
s + gdist
Therefore, the estimation error is
eq.17 becomes
d = d − d (9)
dpar = −B θ̇ m + kto im − Jm θ̈ m (19)
introducing eq.7 and eq.8 into eq.9
gdist where,
dpar is the estimated parameters’s disturbance vector
d = [Jmo θ̈m − im kto ] − Jm θ̈m + im kt (10) data point, while θ̇m , θ̈m and im are data points vectors of
s + gdist
where α
β
B
θ̇o +
αB k θo −
τref
θ1 (t) is the position estimate of the first mass and eq.33 is valid
through the entire system’s frequency range regardless to the fre-
quency content of the forcing function.
Recalling the first flexible system’s equation of motion and replac-
ing the first mass position with its estimate we obtain
B k θ2 = J1
θ̇2 + θ̇o −
θ̈1 − B( θ̇1 ) −
k(θo − θ1 ) + B θ̇ 1 +
k θ1 (34) Fig. 3. External applied torque estimation
solving for θ2 (t) we obtain the plant. The sensorless torque estimation process is illustrated
t k in Fig.3. Indeed, the word ’Sensorless’ is not precise, since one
−
kt −Bt
θ2 (t) = e B
τ
dτ + e k c2
ζe B (35) must sense or measure some variable to obtain some information
o
as a basis of estimating the unknown variables. In this context
the word ’sensorless’ refers to the flexible plant that is kept free
where γ from any measurement and only two measurement are required from
ζ the actuators side as shown in Fig.3. Where actuator’s current and
B
velocity are measured and used to estimate the total disturbance,
γ J1 θ̇o −
θ̈1 − B( θ̇1 ) −
k(θo − θ1 ) + B θ̇1 +
k θ1 then the reflected torque wave is decoupled out of this disturbance
and used as an input for a chain of flexible motion observers that
In general, the position estimate of the ith lumped mass is provide eq.37 with the necessary entries to estimate the external
−kt
t k τ
−Bt
torque. The previous procedure requires performing a couple of off-
θi (t) = e B
dτ + e k ci
Ω eB (36) line experiments based on the same actuators parameters current and
o
velocity. The first experiment is performed to estimate the parameters
variation disturbance in order to decouple the reflected torque wave,
where while the second experiment is performed in order to estimate the
Ψ
Ω uniform system’s parameters.
B
IV. E XPERIMENTAL R ESULTS
Ψ g(Ji−1 , θi−1 ,
θ̇i−1 ,
θ̈i−1 ,
k, B)
The experimental setup consists of a multidegree-of-freedom iner-
eq.36 can be considered as a set of position observers that are recur- tial flexible system attached to an actuator that is used as a platform
sively estimating positions of system’s lumped masses. Surprisingly for measurements and estimations. Optical encoders are attached to
enough that if a proper differentiation tool is used, the velocity and each mass of the system in order to verify the performance of the
the accelerations of each mass can be obtained without taking any positions observers. Table.I summarizes the parameters used in the
single measurement from the flexible system’s side. following experiments
gdist glpf
Reconstruced wave using estimated parameters
A−A 0.2
torque (N.m)
torque (N.m)
1
0
0
−0.2
−1
−0.4
This experiment is performed at the system’s low frequency range time (sec) time (sec)
that is achieved by filtering the forcing function to avoid exciting the (a) reflected and reconstructed (b) Magnified plot of a
system’s flexible modes. Fig.4 shows the response of a 3 Dof flexible reflected torque wave
system, where all the amplitude ratios are unity and the masses are
in phase. The results shown in Fig.4 indicates the validity of eq.26 Fig. 5. Parameters estimation experiment
in this frequency range. Where the estimated rigid body position is
following the actual position of the rigid system. The frequency of
average values are
500 l
30.9306
1st mass 200
ki
2nd mass
400
kavg = i=1
= = 1.54653 kN/m (38)
3rd mass A−A
Estimated position
20
300 150
n
l
Position (Degrees)
Position (Degrees)
200
A−A 100
1.6866
100
Bi
0 50
= avg =
= 0.08433 N sec/m
B (39) i=1
−100
0 n 20
−200
−300
0 5 10 15 20 25 30 35 40
−50
12 14 16 18 20 22
The difference between these parameters and the actual ones that are
known before hand is less than 5 percent, that can be acceptable for
time (sec) time (sec)
(a) f1 = 1 rad/sec (b) Mag plot of a certain applications. Fig.5 shows both the original reflected wave and
150
the reconstructed one using the estimated parameters using Eq.27.
1st mass
2nd mass 100 B−B
3rd mass
50
Position (Degrees)
Position (Degrees)
60
40
0
20
0.14
−50 1st mass
0 2nd mass 0.13
0.12 3rd mass
−100 −20
0.12
0.1
−40
Position (radians)
Position (radians)
−150
0 5 10 15 20 25 30 35 40 8 10 12 14 16 18 20 0.11
time (sec) time (sec) 0.08
A−A
0.06 0.1
0.02 A−A
100 0.08
1st mass
2nd mass 0
3rd mass
50 C−C 0 2 4 6 8 10 1.5 2 2.5 3 3.5 4 4.5 5
80 time (sec) time (sec)
Estimated position
40
C−C
60
Position (Degrees)
Position (Degrees)
30
40
20 Fig. 6. Flexible Oscillation of a 3DOF Dynamical System
20 10
0
0
Using the recursive flexible motion observers eq.36, flexible mo-
tion can be estimated regardless to the frequency content of the
−10
−20
0 5 10 15 20 25 30 35 40 10 12 14 16 18 20
time (sec) time (sec)
0.12
A−A
1st mass postion
estimated 1st mass position 0.12 tem’s parameters, dynamics and external forces/torques. In addition,
A−A
0.1 0.115 flexibility is treated as an efficient tool by shaping the control input
to obtain certain behavior of the Multidegree-of-freedom system. In
Position (radians)
Position (radians)
0.08 0.11
0.04
0.02
0.1
coordinates describing flexible system’s motion, that in turn makes
it possible to determine system parameters easier as too many
0.095
0
0.09
−0.02
0 2 4
time (sec)
6 8 10 2.5 3 3.5
time (sec)
4 4.5
unknowns are dropped.
The reflected mechanical waves are decoupled out of the total
(a) 1st Mass and Its Estimate (b) 2nd Mass and Its Estimate disturbance and proved to contain enough information about the
0.16
2nd mass postion
0.135 dynamical system. Then, system is rigidly excited with a pre-filtered
control input and rigid motion is estimated. Moreover, rigid system’s
estimated 2nd mass position 0.13
0.14
B−B
0.125
0.12
0.12
position is used along with reflected torque wave estimate to estimate
Position (radians)
Position (radians)
0.1
0.115
0.08
B−B
0.11 the uniform system’s stiffness and damping with less than 5 percent
0.06 0.105
0.1
error when compared with the actual parameters that are known
0.04
0.02
0.095 before hand. Then, the estimated parameters are used along with the
reflected mechanical waves and actuator parameters to design a chain
0.09
0 0.085
0 2 4 6 8 10 2.5 3 3.5 4 4.5
time (sec) time (sec)
of flexible motion observers that are recursively estimating flexible
(c) 3rd Mass and Its Estimate (d) Magnified Plot A-A motion of each lumped mass of the system. Proper differentiation
0.14
of the position estimates makes all the system’s dynamics available.
0.12
3rd mass postion
estimated 3rd mass position
0.106
Eventually, the estimated dynamics along with the reflected torque
0.1
0.104 C−C
waves are used to estimate the externally applied torque. Experimen-
0.102
tal results show the validity of the algorithm that can be used in order
Position (radians)
Position (radians)
0.08
0.06
C−C
0.1
to accomplish a sensorless force control assignments.
0.098
0.04
0.02 0.096
ACKNOWLEDGMENT
The authors gratefully acknowledge the financial assistance pro-
0
0 2 4 6 8 10 6 6.5 7 7.5 8 8.5
time (sec) time (sec)
A−A
[2] H. Huang, D. Sun, J. K. Mills, and W. J. Li, “ Visual-based impedence
force control of three-dimentional cell injection system,” in Proc. IEEE
2
1
Torque (N.mm)
Torque (N.mm)
0
0
International Conference on Robotics and Automation’07, Roma, Italy,
−1 −1
Apr. 2007, pp. 4196– 4201.
−2
−3
−2
[3] W. Iida and K. Ohnishi, “ Sensorless force control with force error
−4
0 5 10 15 20
−3
2 3 4 5 6 7 8 9
observer,” in ICIT’03”. Maribor, Slovenia: IEEE, 2003, pp. 157– 162.
Time (sec) Time (sec)
[4] W.J.O’Connar, “ Wave-based analysis and control of lump-modeled
(a) Estimated and external (b) Magnified plot of A-A flexible robots,” in Proc. IEEE Transaction on robotics’07, vol. 23, Apr.
torque-τext |f =2rad/sec 2007, pp. 342– 352.
[5] I. S. M. Khalil and A. Sabanovic, “ Sensorless wave based control of
6
Estimated external torque
flexible structures using actuator as a signle platform for estimation and
control,” IREACO, vol. 2, no. 1, pp. 83– 90, Jan 2009.
External torque 3
4
2
Torque (N.mm)
0
0
−1
vol. 1, Mar. 1996, pp. 56– 67.
[7] T. Murakami and K. Ohnishi, “ Robust and adaptive control strategies,” in
−2 −2
−3
−4
A−A
−4 Proc. IFAC International Control for Intelligent Automation’92, vol. 1,
A−A
−6
0 5 10
Time (sec)
15 20 4 5 6 7
Time (sec)
8 9 10 11 Italy, Oct. 1992, pp. 367– 372.
[8] — — , “ Observer-based motion control-application to robust control and
(c) Estimated and external (d) Magnified Plot A-A parameters identification,” in Proc. IEEE ’93, vol. 1, Jun. 1993, pp. 1– 6.
torque-τext |f =4rad/sec [9] T. Murakami, F. Yu, and K. Ohnishi, “ Torque sensorless control in
multidegreeo-of-freedom manipulator,” in Proc. IEEE Transaction On
Fig. 8. External torque estimation Industrial Electronics’07, vol. 40, Apr. 1993, pp. 259– 265.
[10] T. Tsuji, M. Mizuochi, H. Nishi, and K. Ohnisi, “ A velocity measurement
method for acceleration control,” in Proc. IEEE ’05, vol. 1, Mar. 2005,
pp. 1943– 1947.
shows the estimated and actual torque of 2 rad/sec frequency, while
Fig.8-c shows the same result when the external torque’s frequency
is 4 rad/sec.
V. C ONCLUSION
This paper introduces an algorithm for estimating the externally
applied disturbance due to flexible system’s interaction with the
environment. The proposed algorithm is treating the disturbances
and system’s flexibility differently. Disturbance is not only used as
a step toward the accomplishment of robust motion control system
but treated as coupled signal that contains information about sys-