Professional Documents
Culture Documents
2104
𝜙 𝜙 𝜙
𝐾𝑃 𝐾 𝐾
TABLE I MAGNETIC SYMBOLS
𝐾𝑃 = [ 𝜃
], 𝐾𝐼 = [ 𝐼𝜃 ], 𝐾𝐷 = [ 𝐷𝜃 ].
𝐾𝑃 𝐾𝐼 𝐾𝐷
Symbol Quantity Matrix 𝐾𝑃 , 𝐾𝐼 and 𝐾𝐷 denote respectively the control
𝜙,𝜃
𝜏𝜙 ,𝜏𝜃 Joint torqueInclination angle, precession angle parameters of proportion, integral and differential for PID
𝑔 Gravity constant controller. Matrix 𝐺̂ estimates the gravitational moment term
𝑙 Center of gravity of the external stent of the new IPS. By adjusting the value of those parameters, a
relative accurate estimation of the gravitational moment
𝑀 Mass of the total IPS
could be achieved, namely 𝐺̂ − 𝐺 = 0 . By substitute
𝑚 Mass of the two gyroscopic rotors together equation (3) into equation (4), it can be simplified as
𝑚𝑡𝑙𝑡 ,𝑚𝑤𝑧𝑗 Mass of the internal stent and the external stent 𝑡
𝐷(𝑞)𝑒̈ + 𝐶(𝑞, 𝑞̇ )𝑒̇ + 𝐾𝑃 𝑒 = −𝐾𝐷 𝑒̇ − 𝐾𝐼 ∫𝑡 𝑒 𝑑𝑡 (5)
Length between the rotor centroid and the σ1 coordinates 0
𝐻
origin
III. EXPERIMENTS AND APPLICATIONS
Length between the σ2 coordinates origin and the σ1
𝐿0
coordinates origin
A. Experimental Control Platform
A 0-1 constant,
𝑘 𝑀𝑔𝑘𝐿0 = 𝑚𝑔𝐿0 + 𝑚𝑡𝑙𝑡 𝑔𝐿0 + 𝑚𝑤𝑧𝑗 𝑔𝑙2
Moment of inertia of the total IPS about X axis of the 𝜎
𝐽0
coordinates, 𝐽0 = 𝑚𝑡𝑙𝑡 𝐿0 2 + 𝑚𝐿0 2 + 𝑚𝑤𝑧𝑗 𝑙2
2105
precession angular velocity 𝜔1 of the gyroscopic rotor. On control effect would be for the PID control algorithm. The
the basis of GPE, the lean angle 𝜙 of the new IPS is adjusted regulating phase represents the fine-tune time of the lean
by the effective torque, which is determined by the precession angle, so as to maintain stable equilibrium preferably. The
angle 𝜃 and the precession angular velocity. When lean angle phenomenon of the non-disturbance balance experiment
𝜙 changes in a small range near zero, the new IPS achieves indicates that the stabilizing device designed on the basis of
stable equilibrium. As expressed by the equation (5), PID GPE through PID control algorithm, is able to realize stable
control algorithm is adopted and control parameters are equilibrium. The experimental data are to be analyzed as
𝜙 𝜙 𝜙
𝐾𝑃 , 𝐾𝐼 , 𝐾𝐷 , 𝐾𝑃𝜃 , 𝐾𝐼𝜃 and 𝐾𝐷𝜃 . The initial values of the control follows.
parameters are determined by the results of simulation. By
constantly adjusting the values of the control parameters in
experiments, the observed curves of the control parameters
are consistent with the target curves commendably. Table III
shows a group of feasible values of the control parameters,
which realize the stable equilibrium of the new IPS
successfully.
(d)
Fig 6. Response curves of non-disturbance balance experiment
2106
Fluctuation of the curve within a small amplitude range while Fig. 7 shows the response curves of the lean angle ϕ, the
it maintains stable equilibrium indicates excellent stability of precession angle θ and their velocities in the disturbance
the control system. The response cure of precession angle is balance experiment. Each oscillation period of the curves
showed at Fig. 6 (c). The maximum oscillation amplitude of 𝜃 means once outside disturbance acts on the new IPS. The time
is 30°and when at equilibrium phase, it turns to 0.5°. Fig.6 (d) needed to regain stable equilibrium depends on the features of
presents the comparison between the given theoretical control disturbance, such as the force, the time and the position. But
curve and the response curve observed of the precession the process still can be divided into the four phases as
angular velocity. By contrast, certain differences of phase and mentioned above. In this experiment, there are five times
amplitude are existed. The phase of the theoretical control disturbances occurred at 3.2s, 4.5s, 10.2s, 17.3s and 20.5s
curve advances about 0.1s than the response curve observed, respectively.
due to the system response delay. Fig. 7 (a) and (b) present the response curves of the lean
angle 𝜙 and its velocity, respectively. The maximum
C. Disturbance Balance Experiment oscillation amplitude of 𝜙 is 3°, which means the disturbance
The disturbance balance experiment presents that the new is bearable for the stabilizing device. It reveals that the
IPS regains stable equilibrium from disequilibrium, after the stabilizing device has an excellent anti-inference ability. In
impact of outside disturbance. Derived from unicycle robot, Fig. 7 (b), the largest value of its velocity is 46.5deg/sec.
the new IPS would encounter inevitably numerous external These two curves respond quickly and achieve convergence
disturbances. So the disturbance balance experiment for the after a short period of oscillation, which costs 0.5s, 1.4s, 1.1s,
new IPS is necessary. The process of the disturbance balance 1.5s and 1.5s respectively. It indicates that the stabilizing
experiment can be also divided into four phases: the initial device has an excellent regulating ability, and the new IPS
phase, the oscillation phase, the conditioning phase and the could regain stable equilibrium in a short time after a
equilibrium phase. disturbance. Fig. 7 (c) and (d) show the response curve of the
precession angle and the contrast between the response curve
observed and the given theoretical control curve of the
precession angular velocity. At Fig. 7 (c), the maximum
oscillation amplitude of θ is 26°. The precession angle
responds quickly and soon converges, but convergence point
varies in a small range and owns a zero drift. As same as the
non-disturbance balance experiment, there exists certain
differences of phase and amplitude between the given
theoretical control curve and the response curve, shown in
Fig.7 (d) . The phase of the theoretical control curve advances
(a) about 0.1s than the response curve observed. In order to get a
better control effect, the values of control parameters should
be adjusted through multitudinous experiments.
Shown from the two experiments, the new IPS can bear
disturbances that can cause a lean angle less than 17°. So, the
stabilizing device based on GPE has a good regulating and
anti-inference ability to keep the new IPS stable equilibrium.
D. Application
(b)
(c)
(d)
Fig 7. Response curves of disturbance balance experiment Fig 8. Process of application to posture stabilization of bicycle vehicle
2107
Fig. 8 shows the application of the new IPS to posture characteristics of quick response, fast convergence, strong
stabilization of bicycle vehicle. During the balance regulation and certain anti-inference ability. Through the
experiments of non-disturbance and disturbance, the new IPS application of the stabilizing device to posture stabilization of
does not move back and forth and thus the application of the bicycle vehicle, the dynamic regulating ability and practical
stabilizing device to posture stabilization of bicycle vehicle is platform applicability of the stabilizing device were
proposed. The structure of bicycle vehicle is composed of the validated.
stabilizing device and a platform with two free wheels. The However, for the sake of promoting and enhancing the
bottom wheel of the original IPS is inoperative and the later side balance control effect of the stabilizing device to adapt it
bicycle vehicle could still swing freely. Without the working to some more complex environments, a lot of works still need
stabilizing device, the bicycle vehicle could not stand to be done.
steadily. The balance experiments are conducted on an
inclined floor platform. REFERENCES
[1] J.A. Jaleel, "Simulated annealing based control of an Inverted
Pendulum System," International Conference on Control
Communication and Computing (ICCC), 2013, pp. 204-209.
[2] Z. Li, "Modeling and simulation optimization of the double inverted
pendulum system in modelica," Conf. on Electronics, Communications
and Control (ICECC), 2011, pp. 4382-4385.
[3] R. Wai, and L. Chang, "Stabilizing and tracking control of nonlinear
dual-axis inverted-pendulum system using fuzzy neural network,"
IEEE Transactions on Fuzzy Systems, vol.14, no.1, pp.145-168, Feb.
2006.
[4] G. Lee, "Control of inverted pendulum system using a neuro-fuzzy
controller for intelligent control education," IEEE Conf. on
Mechatronics and Automation, 2008, pp. 965-970.
[5] K. Mahmud, "Design and analysis of the control of an inverted
(a) pendulum system by Matlab," IEEE Global High Tech Congress on
Electronics (GHTCE), 2013, pp. 207-211.
[6] J. Xu, "Pendulum-balanced autonomous unicycle: Conceptual design
and dynamics model," IEEE Conf. on Robotics, Automation and
Mechatronics (RAM), 2011, pp. 51-56.
[7] L. Canete, "Development of a single controller for the compensation of
several types of disturbances during task execution of a wheeled
inverted pendulum assistant robot," IEEE/RSJ International Conf. On
Intelligent Robots and Systems (IROS), 2014, pp. 2414-2420.
[8] R. Skalak, and M. I. Yarymovych, "Subharmonic oscillations of a
pendulum". Journal of Applied Mechanics, vol. 27, no. 1, pp. 159-164,
1960.
[9] K. Furuta, T. Okutani, and H. Sone, "Computer control of a Double
Inverted Pendulum," Computers & Electrical Engineering, vol. 5, no.
(b) 1, pp. 67-84, 1978.
[10] K. Furuta, T. Ochiai, and N. Ono, "Attitude control of a triple inverted
Fig 9. Response curves of application to posture stabilization of bicycle pendulum," International Journal of Control, vol. 39, pp. 1351–1365,
vehicle 1984.
[11] K. Furuta, M. Yamakita, S. Kobayashi, and M. Nisbimura, "A New
Fig. 9 reveals the data analysis of the application, which Inverted Pendulum Apparatus for Education," Proceedings of the
would not be illustrated in detail in order to avoid tautology. International Federation on Automatic Control (IFAC) Symposium on
In order to simulate the possible behaviors of the bicycle Advances in Control Education, 1994, pp. 191-196.
[12] M. W. Spong, P. Corke, and R. Lozano, "Nonlinear Control of the
vehicle under dynamic environment, three times disturbances Inertia Wheel Pendulum," Automatica, vol. 37, pp. 1845-1851, 1999.
are introduce into the experiments, which cause the three [13] Y. Li, "Attitude Control of the Unicycle Robot Using Fuzzy-Sliding
times oscillations shown in Fig. 9. As a result, the oscillation Mode Control," ICIRA, 2012, pp. 62–72.
amplitudes of lean angle and precession angle are less than 3° [14] J. Zhao, "Dynamics and a convenient control design approach for a
and 23°, respectively. The results validated the high unicycle robot," Conf. on Information and Automation, 2010, pp.
706-711.
efficiency and anti-interference of the new IPS device.
[15] H. Jin, "Dynamic modeling and cooperative control strategy for an
In the application, with the installation of stabilizing autonomous unicycle pendulum," Ph.D. dissertation, Korean Congress
device, the bicycle vehicle can maintain stable equilibrium Library, Korea, 2009.
during traveling commendably which shows the stabilizing [16] H. Jin, J. Hwang, and J. Lee, “A balancing control strategy for a
device possesses good dynamic characteristics and extensive one-wheel pendulum robot based on dynamic model decomposition:
practical application prospects. Simulations and experiments,” IEEE/ASME Trans. Mechatronics, vol.
16, no. 4, pp. 763-768, May 2011.
IV. CONCLUSION [17] J. Lee, S. Han, and J. Lee, “Decoupled dynamic control for pitch and
roll axes of the unicycle robot,” IEEE Trans. Ind. Electron., vol. 60, no.
This paper presents a stabilizing device based on 9, pp. 3814–3822, Sep. 2013.
gyroscopic precession effect and achieves stable equilibrium [18] H. Jin, J. Zhao, J. Fan, and J. Lee, “Gain-scheduling control of a 6-DOF
single-wheeled pendulum robot based on DIT parameterization,” in
of the new inverted pendulum system. The dynamical Proc. IEEE Int. Conf. Robot. Autom., 2011, pp. 3511–3516.
equation and efficient PID control algorithm are proposed.
The balance experimental results of non-disturbance and
disturbance verify that the stabilizing device owns the
2108