You are on page 1of 6

Sensorless Torque Estimation in

Multidegree-of-Freedom Flexible Systems


Islam S. M. Khalil, E. D. Kunt, Asif Sabanovic
Faculty of Engineering and Natural Science-Mechatronics Engineering
Sabanci University
Orhanli-Tuzla, 34956, Istanbul, Turkey
Email: kahalil,edkunt@su.sabanciuniv.edu, asif@sabanciuniv.edu

Abstract— This paper presents a sensorless torque estimation


algorithm for multidegree-of-freedom flexible systems. The pro-
posed algorithm makes it possible to estimate externally applied
torques due to flexible system’s interaction with the environment
without taking any measurement from the system. The algorithm
is based on modifying the disturbance observer in order to
decouple the reflected torque waves out of the total disturbance Fig. 1. Lumped flexible inertial system
on the actuator. Then Reflected torque waves are used along with
the actuator’s current and velocity to estimate flexible system
parameters, dynamics and the external torques or disturbances. plant, such as the reflected systems load and the externally ap-
Several experimental results are included in order to confirm the
validity of the proposed torque estimation algorithm. plied torques or forces. Therefore, in this work the disturbance
observer’s structure is modified in order to decouple these
information out of the estimated total disturbance. In addition,
I. I NTRODUCTION
the reflected load from the plant is proved to contain plant’s
Torque and force control have been used in wide vari- parameters, dynamics and externally applied disturbances.
ety of applications such as machining tasks, assembly and A sensorless force estimation algorithm is then introduced
grasping. And typically these applications requires using a based on two actuator measurements (current and velocity),
force sensor to provide the controller with a force feed back considering the reflected mechanical load that can be estimated
signal. However, force sensor has certain disadvantages and by the actuator’s parameters as a natural feedback from the
prevent realization of precise force control. Especially, sensor plant [4].
noise that causes degradation of control performance [1]. This paper is organized as follows. In section 2, reflected
Therefore, sensorless force estimation plays an important role mechanical waves are investigated and proved to contain
in the success of the force control process. Interaction force enough information about the plant. Such as plant’s param-
between the end effector and flexible objects is estimated eters, dynamics and disturbances. In addition, disturbance
using visual feedback instead of using force sensor [2]. By observer is modified in order to decouple the reflected me-
making a relationship between the end effector force and the chanical waves out of the total disturbance. In section 3, the
deformation of the flexible object that can be visually detected. sensorless force estimation algorithm is introduced. Section
A comparison between the sensorless force control systems 4 includes the experimental results. Finally, remarks and
and force control system is performed in [1]. Where the conclusion are included in section 5.
reaction force is estimated by assuming that the internal force
II. M ECHANICAL WAVES E STIMATION
and other terms of the disturbance are identified precisely.
Force is estimated and force error observer is designed in A. Mechanical Waves Analysis
[3] using the velocity information without using the actual For a Multidegree-of-freedom flexible system with n
force sensor signal. Therefore, the associated strain gage lumped masses connected to an actuator as shown in Fig.1.
problems are avoided, such as the narrow band width due to the equations of motion are [5]
the natural frequency of the sensor. In this paper, actuator is
used to estimate the externally applied forces or torques on a Jm θ̈m + B(θ̇m − θ̇1 ) + k(θm − θ1 ) = τm
flexible multidegree-of-freedom system. Where the actuator’s ..
current and velocity are measured and disturbance is estimated. . (1)
Surprisingly enough that disturbance which can be estimated Jn θ̈n − B(θ̇n−1 − θ̇n ) − k(θn−1 − θn ) = τextn
from the actuator side contains two types of information. The
first coupled information is related to the actuator’s parameters where, Jm and Ji are the actuator inertia and the inertia of the
such as the self varied-inertia torque and the actuator’s torque ith lumped mass. k and B are the uniform system’s stiffness
ripple. The other coupled set of information is related to the and damping coefficients. θm and θi are the actuator angular

© IEEE 2009 2374 Preprint of IECON 2009 Proceedings


position and the ith lumped mass’s position. τm and τexti are multiplying eq.10 by (s + gdist ) and making the following
actuator’s torque and the external torque applied on the ith definition
lumped mass, respectively. Putting the equations of motion
ξ  gdist J θ̈m − sJm θ̈m + gkt im + sim kt
together and solving for B(θ̇m − θ̇1 ) + k(θm − θ1 ) we obtain

n 
n we obtain the following differential equation
τref  Ji θ̈i − τexti (2) d 
i=1 i=1 d + gdist d = ξ (11)
dt
 B(θ̇m − θ̇1 ) + k(θm − θ1 )
which describes the estimation error dynamics and has the
where τref is the reflected torque wave from the dynamical following solution
system on the actuator. The previous equation shows that the t
reflected torque wave τref carries enough information about  = e−gdist t
d(t) egdist τ ξ(τ ) dτ + ce−gdist t (12)
the system’s dynamics, parameters and external disturbances o

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

© IEEE 2009 2375 Preprint of IECON 2009 Proceedings


actuator’s velocity, acceleration and current. Putting eq.19 in
the following matrix form


im

kt −B −Jm θ̇m = dpar (20)
θ̈m 3×m

where m is the number of data points of each vector.



im
H θ̇m
θ̈m 3×m

Matrix H can be obtained from the actuator side by measuring it’s


current, velocity and acceleration. Indeed, obtaining the acceleration
signal will result in high amplification of the noise level. Therefore,
an appropriate differentiation techniques have to be used in this level
[10].
Equation 20 represents an over-determined system, and it’s solu-
tion has to minimize the norm square of errors.


−1


kt 
−B 
−Jm = HT H HT dpar
or



kt 
−B 
−Jm = H† dpar (21) Fig. 2. Reflected torque observer’s structure

where H † is the pseudo-inverse of H.   kt and −J m are the


estimated actuator’s torque ripple and varied self-inertia torque, are not excited, a single generalized-coordinate is enough to describe
respectively. the motion of the flexible system that is no longer flexible instead of
Rewriting eq.14 and replacing the actual parameter variations with n generalized-coordinate. Therefore, we can write
the estimated ones, we get the estimated reflected torque wave as
follows θ1 (t) = θ2 (t) = θ3 (t) = . . . = θn (t) = θ(t) (25)
 t im − J
τref = k  m θ̈m − d
 (22)
this equality is valid if and only if the control input is filtered such
The direct differentiation of the velocity signal can be avoided by that it contains zero energy at the system’s resonance frequencies.
using the following observer’s structure Or Fourier synthesized to guarantee that its frequency content at the
system’s resonances is zero. Moreover, shaping the input by this way
 t − d+ gref J
τref = G(s)[im k  
m θ̇m ] − gref Jm θ̇m (23) makes it possible to estimate the rigid motion of the flexible system
gref by the following equation
G(s) = t
s + gref t
1
where gref is reflected torque observer’s constant gain. The block θ(t) = n 
τref dτ dτ + c1 t + c2 (26)
i=1
Ji o o
diagram implementation of the reflected torque observer is shown in
Fig.2. where θ(t) is the rigid motion position estimate. And eq.26 is only
valid through a narrow region of the flexible system’s frequency
III. S ENSORLESS T ORQUE E STIMATION range. Therefore, within this frequency range the parameters esti-
As the reflected torque wave is estimated, eq.2 can be used to mation process has to be performed.
determine the external torques if the inertial mass’s accelerations are Rewriting eq.24 and using θ(t) instead of θ1 (t)
available that requires taking measurement from each lumped mass of
the flexible system. Instead, we propose an algorithm to estimate the τref = B(θ̇m − 
 θ̇) + k(θm − θ) (27)
flexible motion of each lumped mass of the flexible system. Then the
estimated system’s dynamics is used in eq.2 to estimate the external and defining the velocity and position differences as follows
torques.
ξ  (θm − θ)
A. Uniform System’s Parameters Estimation
Since the system’s stiffness and damping are inherent properties η  (θ̇m − 
θ̇)
of the system. In other words, they are independent of the external where ξ and η are vectors of data points, Similarly,  τ ref is the
applied torques. We assume that flexible system is free from external estimated reflected torque data point vector, rewriting eq.27 in the
torques. Therefore, eq.2 can be written as following matrix form

n  




τref = Ji θ̈i = B(θ̇m − θ̇1 ) + k(θm − θ1 ) (24) ξ η
k
= 
τ ref (28)
n×2 B n×1
i=1 2×1

This assumption is just made to determine the system parameters



G ξ η
through an off-line experiment. Then, the estimated parameters along
with the estimated dynamics will be used in order to estimate the solving eq.28 for the system parameters vector we obtain
external torque. However, determination of the system’s uniform  
parameters k and B from eq.24 requires measuring the first mass’s 
k
−1

= GT G GT 
τ ref (29)
position. Surprisingly enough that if the flexible modes of the system 
B

© IEEE 2009 2376 Preprint of IECON 2009 Proceedings


 

k

= G† 
τ ref (30) C. External Torque Estimation

B Since the flexible system’s dynamics can be observed and the
uniform parameters can be estimated, eq.2 can be used in order
Where G† is the pseudo inverse of G,  k and B  are the estimates
to estimate the external torques or disturbance due to the system’s
of the system’s uniform stiffness and damping coefficients. The
interaction with the environment.
previous procedure is considered as an off-line parameters estimation
experiment that is performed in a certain system’s frequency range 
n

to estimate flexible system’s uniform stiffness and damping. τext = Ji


θ̈i − τ
ref (37)
i=1
B. Flexible Motion Estimation
Where τext is the estimate of the external applied forces on
Equation 26 is valid in narrow region of the system’s frequency
range. In addition, it estimates the motion of the flexible system
when its rigidly behaving. Therefore, eq.26 is not enough to estimate
the flexible system’s motion, where the amplitude ratios between the
masses are no longer unity and masses are no longer in phase.
Recalling eq.2 and replacing the actual parameters with the esti-
mated ones
  θ̇m − θ̇1 ) + 
τref = B( k(θm − θ1 ) (31)
re-arranging the terms
θ̇1 + 
B θ̇o + 
k θ1 = B k θo − 
τref (32)
solving the first order differential equation for θ1 (t) that has to be
denoted as θ1 (t) since it depends on observed variable  τref and
estimated parameters such as  k and B.

−Bt
t 
Bτ 
−Bt
θ1 (t) = e 
k βe 
k dτ + e 
k c1 (33)
o

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

© IEEE 2009 2377 Preprint of IECON 2009 Proceedings


TABLE I TABLE II
E XPERIMENTAL PARAMETERS PARAMETERS ESTIMATION RESULTS
Par 1st Exp 2nd 3rd 4th 5th
Parameter Value Parameter Value k KN/m 1.579 1.533 1.645 1.511 1.562
J1 5152.9 gcm2 J3 6192.7 gcm2
J2 5152.9 gcm2 f1 1 rad/sec
 Nsec/m
B 0.088 0.087 0.088 0.089 0.089
f2 2 rad/sec f3 3 rad/sec
f4 4 rad/sec kto 40.6 mNm/A
kb 235 rpm/v Jmo 209 gcm2 3
Actual reflected wave 0.6

gdist glpf
Reconstruced wave using estimated parameters

100 rad/sec 100 rad/sec 2


0.4
A−A

A−A 0.2

torque (N.m)

torque (N.m)
1
0

0
−0.2

−1
−0.4

A. Rigid Body Motion Estimation Experiment −2 −0.6

0 2 4 6 8 10 4.3 4.4 4.5 4.6 4.7 4.8 4.9 5 5.1 5.2

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

C. Flexible Motion Estimation Experiment


100 B−B
Estimated position
80

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

(c) f2 = 2 rad/sec (d) Mag plot of c 0.04


0.09

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)

forcing function. Fig.6 shows the response of the 3 Dof flexible


(e) f3 = 3 rad/sec (f) Mag plot of a system to an arbitrary forcing function that forces the system to
flexibly oscillate. The position estimates of each lumped mass of
Fig. 4. Rigid body motion estimation the system is shown in Fig.7 and compared with the actual optical
encoder measurement. The results show the validity of the proposed
the forcing function is increased gradually in order to determine the algorithm to estimate the motion of the multidegree-of-freedom
frequency region at which eq.26 is valid. It turns out that eq.26 is flexible system.
valid below 3 rad/sec. Therefore, parameters estimation experiment
has to be performed in this frequency range for this particular system D. Torque Estimation Experiment
as its based on eq.26. Estimating the external torque applied on the flexible system using
eq.37 requires estimating the flexible system’s dynamics and the esti-
B. Parameters Estimation Experiment mate of the reflected torque wave1 . Experimentally a sinusoidal torque
disturbance is added to the flexible system and simply measured and
Equation 30 is used to estimate the flexible system’s stiffness compared with the estimated one. The frequency of the externally
and damping. Therefore, estimate of the reflected torque wave is applied sinusoidal torque was varied between 1-5 rad/sec. Fig.8-a
computed along with the data matrix G, which depends on the
actuator’s and rigid system’s position. Table.II shows the experimental 1 Experimentally reflected torque wave is assumed to be equal to the
system’s parameters obtained by Eq.30. In order to obatain more disturbance estimated from the actuator, that cannot be generalized since the
reliable results the experiment was repeated l times and the obtained parameters variation disturbance can effect the results

© IEEE 2009 2378 Preprint of IECON 2009 Proceedings


0.14

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

other words, making it possible to minimize number of generalized-


0.06
0.105

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)

(e) Magnified Plot B-B (f) Magnified Plot C-C


vided by SanTez project number 00183.STZ.2007-2.

Fig. 7. Flexible body motion estimation experimental results


R EFERENCES
[1] A. Kato and K. Ohnishi, “ Robust force sensorless control in motion
5
control system,” in AMC’06”. Istanbul, Turkey: IEEE, 2006, pp. 165–
4
A−A
External torque
Estimated external torque 3 170.
3 2

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

2 1 [6] K. Ohnishi, M. Shibata, and T. Murakami, “ Motion control for advanced


mechatronics,” in Proc. IEEE/ASME Transaction On Mechatronics’96,
Torque (N.mm)

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-

© IEEE 2009 2379 Preprint of IECON 2009 Proceedings

You might also like