You are on page 1of 4

Force Sensorless Control Applied to a Power

Assisted Revolving Door


Wu-Sung Yao, Jiun-Yih Kuan, and Mi-Ching Tsai
Department of Mechanical Engineering, National Cheng Kung University,
No 1, Ta-Hsueh Road, Tainan 701 Taiwan.

Abstract-- The human-robot interaction embraces wide This paper proposes a power-assisted system applied
range of applications in various environments. A power to a revolving door without force sensors. The
assisted system with force sensors enables a human being to characteristics of the driving torque and human operation
easily handle a heavy load. However, force sensors always are investigated. The proposed control system utilizes
increase the cost and complication of the power assisted Luenbergers observer and state feedback control to
system. In this paper, a power-assisted system applied to a
revolving door without force sensors is proposed. The
stabilize the system and to optimize the response. The
characteristics of the driving torque and human operation multi-observers scheme, which employs only a position
are investigated. The proposed control system utilizes sensor to estimate the load torques, is implemented in
Luenbergers observer and state feedback control to real-time. The proposed control system can reflect a
stabilize the system and to optimize the response. The multi- human operator's intentions and control the assisted
observers scheme that employs only a position sensor actuator to generate the required driving power. Finally,
(encoder) to estimate the load torques is implemented in the experimental results are presented to demonstrate the
real-time. The proposed control system could reflect a effectiveness of the overall control algorithms.
human operator's intentions and control the assisted
actuator to generate the required driving power. The
experimental results demonstrate the effectiveness of the II. SYSTEM DYNAMICS AND LOAD TORQUE OBSERVERS
overall control algorithms. For the power-assisted systems, the most important
technique is how to estimate the load torques by encoders.
Index Terms-- power assisted systemforce sensors In this paper, the human operator's intentions and the
multi-observers schemestate feedback control characteristics of the driving torque are investigated to
generate the required driving power. For the revolving
I. INTRODUCTION doors system, inertia forces and frictional forces cause the
Nowadays, the human-robot interaction embraces main resistive forces where inertia forces are proportional
wide range of applications in various environments. to the angular acceleration, and frictional forces are
Many tools and devices operated with intuition and proportional to angular velocity. Therefore, by the
forced by human to respond to do what they want. These estimated velocities and accelerations, one can easily
dynamic responses include acceleration, velocity, handle a heavy load with suitable power-assisted
displacement and disturbance of the device. In contrast to strategies. Many researches proposed the approach of
operating these devices through the mechanical or using torque observer design with encoder information to
electrical interface, operating these directly is much more a servo control system. The conventional load torque
convenient and easier. A power assisted system with observer [3] shown in Fig. 1 is often employed to reduce
force sensors enables a human to easily handle a heavy the speed ripple caused by the variation of the load torque
load, where a suitable assisted force is often given by an with a low-pass filter.
actuator. Thus, this system not only makes the operator to
feel more convenient, but also reduces the required force
during the operation. In addition, in order to provide
different dynamic responses, this system could be
adjusted to match operating environment, where more
torque sensors are employed in the power-assisted system.
These sensors not only increase the complication of the
power assisted system, but also are not reliable to change
in the temperature. In the recent years, many researches
investigated how to design a torque observer with the
encoder information only [1][2]. However, the technical
Fig. 1. The torque observer with a first-order filter.
literatures lack the general and complete methods with
state feedback control and the concept of the power
A modified load torque observer was proposed [4],
assistance.
which utilizes the inverse dynamic model and the concept
of time delay to design a high order low-pass filter, i.e., Q
The authors are grateful to the National Science Council of the filter as shown in Fig. 2. However, if the accuracy of a
Republic of China for supporting this research under grant NSC 94- virtual system is not fixed, the errors are easily
2815-C-006 -064 E.
accumulated. Moreover, the high-order filter in the 1
control system has a serious phase-lag problem . iK vo Tmotor
s

1 1 1
K vo J s
s

1
bvo J

1 iK ao Tmotor
s
1
1 1
K ao J s s
C
bao

Fig. 2. The torque observer with Q filter.


Fig. 4. The load torque observer with the dual scheme.

In Fig. 3, Wu [5] developed a load torque observer,


which combines the LAE and the command feedforward,
utilizes closed loop control to compensate the
acceleration. However, the phase lag is also found with
the LAE scheme. Schimdt and Lorenz [6] exploited a
dual scheme including velocity and acceleration
observers as shown in Fig. 4. The major feature of this
dual scheme is without any numerical differentiation and
the velocity and acceleration observers can be adjusted
individually. The estimated velocity in the velocity
observer can be utilized in the acceleration observer to
estimate acceleration of the control system. However the
Fig. 5. The proposed Luenberger observer.
technical literatures lack the general and complete
methods with state feedback control and the concept of The proposed multi-observer system is illustrated in
the power assistance. In this paper, the control system Fig. 6, which combines a dual scheme of velocity and
utilizes the Luenberger observer and state feedback acceleration observers, the Luenberger observer with
control, as shown in Fig. 5, to stabilize the system and to predictor-corrector. Seven designed parameters are given
optimize the response. With only an encoder, the multi- in the multi-observers scheme to make the power-
observers scheme is implemented in real-time to assisted system more flexible. To design these parameters
estimate the load torques. of this multi-observers scheme, the system is divided
into three parts, i.e., velocity observer, acceleration
observer, and load torque observer. By utilizing the third-
order Butterworth filter, the designed parameters can be
simplified as two designed parameters.

1 iK vo Tmotor
s

1 1 1
K vo
J s s

Fig. 3. The torque observer with the LAE and commend feedforward. bvo 1
J

1 iK ao
s
Tmotor
1
1 1
K ao
J s s

bao

T load 1
B
1+ p s

Fig. 6. The proposed multi-observer system.


III. THE CONTROL STRATEGIES
In general, the control strategies of the traditional
power-assisted systems often depend on the measured
force by a force sensor. It reflects the operator's intentions
to generate the required driving power with a assisted
actuator, where the system dynamics can be described by
a second order ordinary differential equation, i.e.,
Jx + C x + K x = f ( t ) + f p ( t ) (1)
where x , J , C , and K are the displacement, inertia,
viscous friction coefficient, and stiffness respectively.
f ( t ) and f p ( t ) are denoted as the external force and the
assisted force imposed to the system respectively. In the
following, two kinds of the assisted forces are given to
show the performances of the power-assisted system.
First, the assisted force is expressed as
f p ( x, x, x ) = J x + C x + K x (2)
Following from (1) and (2), the dynamics equation of the
power-assisted system becomes
(J J ) x+(CC ) x+(KK ) x = f ( t) (3)
Fig. 7. The complete controlled scheme for the power-assisted revolving
Equation (3) illustrates that the control state of the door.
original system is reduced by a subtraction with the
assisted force feedback.
Second, assume that the assisted force f p is a function of
the external force, that is
f p = K a f (t ) (4)
where K a is defined as a assisted ratio. Then the system
characteristic is given as
J C K
x+ x+ x = f (t ) (5)
1 + Ka 1+ Ka 1+ Ka
(a) (b)
Observing Equation (5), the control state of the original Fig. 8. The acceleration responses of the power assisted system with the
system is proportional to the assisted ratio K a . differential assisted ratio (a) K a = 0.5 and (b) K a = 1 .
Equations (3) and (5) reveal that the assisted force can
be regarded as a control state which is used to improve IV. EXPERIMENT RESULTS AND DISCUSSION
the dynamic characteristic of the system. However, only Experiments are carried out with the proposed power-
using Equations (3) or (5), the control system will easily assisted strategy and multi-observers scheme, where the
become unstable with the assisted force feedback. Thus, control algorithm is implemented by a DSP motion
the useful assisted force combining the assisted strategies control card PMC32-600/6000. Figure 9 shows a minified
of Equations (3) and (5) is represented by revolving door, which is used to demonstrate the real
f p = K a ( x , x , x ) f (t ) (6) performs of this power assisted system, with a Panasonic
Therefore, the proposed power-assisted system is AC servo motor and a driver. Table 1 gives the
depicted by Fig. 7, which includes of the power-assisted corresponding specifications of the motor.
strategy (5) and multi-observers scheme (Fig. 6). In
order to demonstrate the effectiveness and stability of this
proposed power-assisted system, computer simulations
are carried out with the different assisted ratios K a . The
designed bandwidths of the velocity observer, the
acceleration observer, and low-pass filter are 15 rad/sec,
50 rad/sec, and 50 rad/sec, respectively. Figure 8 shows
the simulated results with the differential assisted ratio,
i.e, K a = 0.5 and K a = 1 . Under the low frequency load
torque, the proportion of the acceleration approaches the
designed assisted ratio. Due to the designed bandwidth of
the observer, the proportion of the acceleration is smaller
than the assisted ratio with the high frequency load torque.
Fig. 9. A minified revolving door.
TABLE 1
THE SPECIFICATIONS OF A PANASONIC SERVO MOTOR

Specification of motor Specification

Rated Output 1.0 kW

Rated Speed 2000 r/min

Max. Speed 3000 r/min


(a) (b)
Rated Torque 4.8 N.m Fig. 12. The acceleration responses of the power assisted system with
the differential assisted ratio (a) K a = 0.25 and (b) K a = 0.5 .
Max. Torque 14.4 N.m

Rotor inertia 2610 kg^-4.m^2 V. CONCLUSIONS


In this paper, a power-assisted system applied to a
Weight 8.9 kg
revolving door without force sensors has been proposed.
The characteristics of the driving torque and human
A. Load torque observing operation were investigated. The proposed control system
utilizes Luenbergers observer and state feedback control
Figure 11 shows that the responses of the torque
to stabilize the system and to optimize the response. The
observing are less phase lag and the magnitudes of the
multi-observers scheme that employs only a position
estimated torques are close to the commands. However,
sensor to estimate the load torques was implemented in
due to the effect of the Gibbs phenomena, the estimated
real-time. The proposed control system could reflect a
errors are found in zero load torque command. With the
human operator's intentions and control the assisted
nonlinear viscous force, the unwanted estimated torque is
actuator to generate the required driving power. The
small comparing to the real load torque of a human
experimental results demonstrated the effectiveness of the
beings operation.
overall control algorithms.

REFERENCES
[1] S.H. Lee and J.B. Song, Acceleration estimator for low-
velocity and low-acceleration regions based on encoder
position data, IEEE/ASME Transactions on Mechatronics,
vol. 6, pp.58-64, 2001
[2] G. Ellis, Observers in control systems, ACADEMIC
PRESS, 2002.
[3] H. Seki, M. Iso, and Y. Hori, How to design force
sensorless power assist robot considering environmental
(a) (b)
Fig. 11. The responses of the torque observing with the differential characteristics - position control based or force control
commands (a)1.5 Nm and (b)2.0 Nm. based, Proceeding of IEEE 2002 28th Annual Conference,
pp.2255- 2260, 2002.
[4] K. Hong and K. Nam, A Load Torque Compensation
B. System with power assisted and without power Scheme Under the Speed Measurement Delay, IEEE
assisted Transactions on Industrial Electronics, vol. 45, pp. 283-
290, 1998.
Figure 12 shows the results with the differential [5] K.S. Wu, Design and realization of differential and
assisted ratio, i.e, K a = 0.25 and K a = 0.5 . Under the power-assisted control for power chairs, Master Thesis of
low frequency load torque, the proportion of the Department of Mechanical Engineering, NCKU, Taiwan,
acceleration is close to the designed assisted ratio. Due to 2005.
the designed bandwidth of the observer, the proportion of [6] P.B. Schmidt and R.D. Lorenz, Design principles and
the acceleration is smaller than the assisted ratio with the implementation of acceleration feedback to improve
performance of dc drives, IEEE Transactions on Industry
high frequency load torque. Applications, vol. 28, pp. 594-599, 1992.
[7] V. K. Ingle and J. G. Proakis, Digital Signal Processing
using MATLAB, Brooks/Cole, 2000.

You might also like