Professional Documents
Culture Documents
2D05-2
2014年11月10日ー12日 群馬伊香保 ホテル天坊
Abstract- In many mechanical control systems, the addition of acceleration feedback to the controller is an
effective approach to improve system’s dynamics irrespective to disturbances on them. The servo accel-
erometers are commonly used to measure acceleration accurately in a low frequency range; however, a
conventional servo accelerometer attached to a system to measure acceleration makes the system rather
costlier. The use of low-cost Micro-Electromechanical System (MEMS) accelerometers to measure accel-
eration can overcome this difficulty; however, the acceleration signals measured by a MEMS accelerome-
ter typically contain noise. In this study, the Kalman filter technique is applied to reduce such noise as well
as to make the MEMS accelerometers suitable to use in an active system. The Kalman filter technique
used in this study estimates acceleration by minimizing the mean-square error of a series of measurements
conducted by MEMS accelerometer over time, containing noise (random variations) and other inaccura-
cies. It is observed that the estimated accelerations by using the Kalman filter tend more precise than those
based on measurement.
Key Words: Zero-power control, Zero-compliance, Negative stiffness, Voice coil motor
( )
where x, A, B, C are state variables, state transition, control
input and measurement matrixes, respectively. The symbols ( )
where X and X̂ are the predicted value and esti-
u, q and r denote input variable vector, process noise vector mated value of ( X ) , respectively. Symbols K and P indi-
and measurement noise vector, respectively. The discrete cate the Kalman gain and estimation error, respectively.
formats of Eqs. (1) and (2) are used in the KF algorithm 3 Simulation and Experiment
with sampling time ∆t and are given as follows:
The influence of KF on the performance of a control sys-
X T = ϕX T −1 + φu + γ , (3) tem (PD) is analyzed theoretically by using the numerical
y = CX T + R , (4) simulation results shown in Fig. 3. The parameters regard-
ing the KF and system, which are used for numerical simu-
where ϕ = A∆t + I , φ = B∆t and γ = Q∆t . The subscript lation, are given in Table 1. To initialize the states predic-
T denotes the time step. The respective discrete KF algo- tion process in simulation, the state variable, state transition,
rithm is given as follows: input and measurement matrixes regarding a PD control
Time update system are considered as follows:
x 0 1 0
X T −1 = ϕXˆ T −1 + Bu ,
, B = ki , C = [1 1]
(5)
X = , A=
x& 0 0
PT −1 = ϕPˆT −1ϕ '+Q . (6) m
It is assumed that the control system is subjected to a
Measurement update white Gaussian noise. Figure 3 shows the simulated posi-
tion and velocity of a PD controlled system at steady-state,
Xˆ T = X T −1 + K T ( yT − CX T −1 ) , (7)
where displacement is assumed as the feedback quantity. It
is observed that the KF can appropriately estimate the dis-
placement and velocity signals which contain sufficiently
low levels of noise. Moreover, it is observed that the feed-
back control based on the KF estimated displacement signal
provides a system with sufficiently low dynamic control
deviation.
With regard of the same reference input in experiment,
the output signals of the MEMS accelerometer are meas-
ured and the corresponding signals are estimated by the KF;
these measured and estimated signals are shown together in
Fig. 4. The acceleration and velocity signals are investigat-
ed for both zero and sinusoidal references. The velocity
Fig 3: Effect of KF on performance of a control system: Fig. 4: Measured signal and KF-estimated signal:
(a) displacement signal, (b) velocity signal (a) zero reference, (b) sinusoidal reference
1277
Table 1 Parameters used in simulations
Mass (m) 30 kg
System Actuator co-
45 N/A
efficient (ki)
1278