Professional Documents
Culture Documents
Wac 12
Wac 12
Abstract—This work discusses the regulation of the system has two degree of freedom and our research group
ball and plate system , the problem is to design a control already obtains very good results [15]. In this work was
laws which generates a voltage u for the servomotors made the prototype [16] to illustrate the effectiveness of
to move the ball from the actual position to a desired
one. The controllers are constructed by introducing our algorithms, then we analyze the stability of this PD
nonlinear compensation terms into the traditional PD regulation with the whole nonlinear model of the ball and
controller. In this paper, a complete physical system plate system.
and controller design is explored from conception to
modeling to testing and implementation. The stability II. Related work
of the control is presented. Experiment results are
obtained via our prototype of the ball and plate system. In [17], a new kind of Lyapunov function is proposed
which can be exploited to construct a stabilizing switching
control scheme. They have introduced the new concepts
I. Introduction of switching-driving Lyapunov function and switching-
Numerous researchers have investigated the regulation driven stability. They have implemented tools to find a
problem on a ball-and-plate system. The ball and plate locally asymptotically stabilizing switching control scheme
system is one of the most popular and important labo- for the ball and plate system. In [?], this work they
ratory models for teaching. The Ball and plate system presents the sliding mode control of the ball on a beam
is a multi-variable plant, which is the extension of the system. The authors designed a static and a dynamic
traditional ball and beam problems [1]-[5]. The ball and sliding model of the system. They first use a simplified
beam system is a two degree of freedom system consisting model of the ball-and-beam system to design a static and
of a ball that can roll on a rigid beam. On the another a dynamic sliding-mode controllers for the system, then
hand, the ball and plate system is a four degree of free- the authors use the full model to design the controllers.
dom system consisting of a ball that can roll freely on In [18], the control goal is to place the robot end-effector
a rigid plate. This system has not attracted too much over a desired static target by using a vision system
attention; the main drawback is the difficulty of building equipped with a fixed camera to see the robot end-effector
this mechanism. However, considering that this system and target. They have presented theoretical aspects in
has enormous potential as a test bed for different kind fixed-camera visual servoing of planar robots. This study
of control strategies like neural network control [6], fuzzy includes besides a Lyapunov stability analysis. In this
control [7], conventional control [8], stability analysis [9] work we includes a similar Lyapunov stability analysis,
and [10], Nonlinear control [11], sliding mode control we transform the whole ball and plate system into a robot
[12],[13] and [14], etc. The goal of this research is to develop dynamics structure. They design the controller based on
a PD regulation with compensation to control a ball and the linear model, a simple PID controller is adequate to
plate system, capable of controlling the position of ball on obtain a very high response speed. They developed their
a plate for both axes (x, y). The initially horizontal plate prototype using the real time control prototyping tool
will be tilted along each of two horizontal axes in order dSpace. In [14] the authors presented a visual servoing
to control the position of the ball. Each tilting axis will control for a ball-and-plate system to track its desired
be operated on by a servomotor. The position of the ball trajectory. A sliding mode controller is designed to cope
on the plate will be sensed through a camera. In previous with the changes in the material of the plate and the
studies we work with a small and famous version of this material and the size of the ball as well as another model
kind of dynamic system: the ball and beam system, this uncertainty. Many authors prefer the fuzzy control like
1
[20], they proposed a hierarchical fuzzy control scheme
and then they proposed a genetic algorithm to adjust
Icdm
the output membership functions of the fuzzy planning M + 2 ẍ − M xθ̇x2 − M y θ̇x θ̇y − M G sin θx = 0 (4)
R
controller to optimize the ball’s moving trajectory. In [21]
and [9], the authors used a PD control with nonlinear
Icdm + M x2 θ̈x + 2M xẋθ̇x + M xy θ̈y + (M xẏ + M ẋy)θ̇y +
exact compensation for the cross-cupling synchronization
... + M Gx cos θx = τx
of two ball and beam systems, then a radial basis function (5)
neural network is applied to approximate the nonlinear
compensator. In this work the synchronization control can
Icdm
be in parallel and serial forms and they discussed the M + 2 ÿ − M y θ̇y2 − M xθ̇x θ̇y − M G sin θy = 0 (6)
stability of the synchronization scheme. R
2
As we consider the entire ball and plate system coupled, PD Controller axis y:
the gravity matrix is:
uy = kpy (y ∗ − y) + kdy (y˙∗ − ẏ) (17)
M G sin θx
As ẏ y ẏ ∗ = 0, so
M Gx cos θx uy = −kpy y − kdy ẏ (18)
G(q) = (12)
The close-loop system is obtained by substituting the
M G sin θy
control voltage ux and uy from the control law (16) y
M Gy cos θy (18) respectively, into the whole ball and plate system
(4),(5),(6) and (7).
then the matrix B, is:
kpx 0 0 0 Icdm
M + 2 ẍ − M xθ̇x2 − M y θ̇x θ̇y − M G sin θx = 0 (19)
R
0 0 0 0
B= (13)
˙ y+
0 0 kpy
0 Icdm + M x2 θ̈x + 2M xẋθ̇x + M xy θ̈y + (M xẏ + M ẋy)theta
... + M Gx cos θx = ux
(20)
0 0 0 0
and the compensators are:
Icdm
M+ 2 ÿ − M y θ̇y2 − M xθ̇x θ̇y − M G sin θy = 0 (21)
R
πx
0
˙ x+
Icdm + M y 2 θ̈y + 2M y ẏ θ̇y + M xy θ̈x + (M xẏ + M ẋy)theta
D=
(14) ... + M Gy cos θy = uy
πy
(22)
The stability of the closed loop system is presented in
0 the following theorem:
IV. Control design Theorem 4.1: Consider system (4-7) with the control
law (16) and (18) with two compensators:
A proportional derivative controller is adequate basic ( 1
term to obtain the desired response. With the propose of ((M G sin θx ) + 2M xθ̇x2 ) + 2M y θ̇y θ̇x
guarantee the stability of the closed loop system an exact πx = ẋ (23)
nonlinear compensator is included, Fig. 2 a diagram of this +(M Gx cos θx )θ̇x − 2M xθ̇x2 − 2M xθ̇y θ̇x
controller. and
1 ((M G sin θ ) + 2M y θ̇2 ) + 2M xθ̇ θ̇
y y x y
πy = ẏ (24)
+(M Gy cos θ )θ̇ − 2M y θ̇2 − 2M y θ̇ θ̇
y y y x y
3
Substituting equation (27) in (28):
1
1 ((M G sin θy ) + 2M y θ̇y2 ) + 2M xθ̇x θ̇y
dV = q̇ [B q̄ + Dπ − C(q, q̇)q̇ − G(q)]+ q̇ T Ṁ (q) q̇−q̇ T B q̄
T
ẏ
2 πy =
(28)
+(M Gy cos θy )θ̇y − 2M y θ̇y2 − 2M y θ̇x θ̇y
if ẏ 6= 0
0 if ẏ = 0
1 (38)
= q̇ T B q̄+q̇ T Dπ−q̇ T C(q, q̇)q̇−q̇ T G(q)+ q̇ T Ṁ (q) q̇−q̇ T B q̄ can guarantee asymptotic stability of the ball and plate
2
(29) system (19-22).
Then we have:
V. Simulations
1 h i
= q̇ T [B q̄ + Dπ − G(q) − B q̄] + q̇ T Ṁ (q)q̇ − 2C(q, q̇) q̇ A. Simulation Phase: Mathematical modeling
2
(30) Before the control laws are applied to the real system,
Substituting (12) in −q̇ T G(q), we have: computer simulations was made. For this simulation
the model of the ball and plate system described by
−q̇ T G(q) = −[(M G sin θx )ẋ + (M Gx cos θx )θ̇x + (4-7) are used. These equations are necessary only for the
(31)
... + (M G sin θy )ẏ + (M Gy cos θy )θ̇y ] simulation results. For the real application aren’t required.
Substituting (14) in q̇ T Dπ, we obtain: Consider that the movement of the ball is slow and do
T
q̇ Dπ = ẋπx + ẏπy (32) not show tendency to slip (smooth bearing), due to the
slow speed and acceleration of the plate, the interaction
Finally, we obtain that: of the movements of the plate are uncoupled, Two PD
controllers are applied one for each axis.
V̇ = ẋπx + ẏπy − kdx ẋ2 − kdy ẏ 2 − (M G sin θx )ẋ− B. Simulation: Results
... − (M Gx cos θx )θ̇x − (M G sin θy )ẏ − (M Gy cos θy )θ̇y − Simulink is used to test the model (4-7), consider M =
... − 2M xẋθ̇x2 + 2M xθ̇x2 + 2M xθ̇y θ̇x − 2M y ẋθ̇y θ̇x − 0.11kg, R = 1.27cm and G = 9.81m/s2 . The results are in
... − 2M y ẏ θ̇y2 + 2M y θ̇y2 + 2M y θ̇x θ̇y − 2M xẏ θ̇x θ̇y Figs. 3 and 4 show a good behavior of our control system.
(33) Now, the controller is ready to be implement on the real
If we choose the compensator πx prototype.
( 1
((M G sin θx ) + 2M xθ̇x2 ) + 2M y θ̇y θ̇x
πx = ẋ (34)
+(M Gx cos θx )θ̇x − 2M xθ̇x2 − 2M xθ̇y θ̇x
and the compensator πy
so
4
data are digital.
D. Implementation phase: Results
The results presented in this section are only valid for
the configuration of the prototype presented in Fig. 1.
More details of the performance of our ball and plate
system are show in Figs. 7-10, where the position error,
the velocity and the control signal are presented. Figs. 7-
8 comes from the PD regulation without compensation
controller and Figs. 9-10 is for the PD regulation controller
with nonlinear exact compensation.
Fig. 4. Simulations results; Velocity and displacement for y-axis 0.3
Position error and Velocity in axis X
0.25 ex [m]
0.2 Vx [m/s]
0.15
0.1
0.05
0
−0.05
−0.1
−0.15
−0.2
−0.25
−0.3
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5 5.5 6 6.5 7 7.5 8
T ime [s]
Control signal in axis X
0.05
0.04
0.03
0.02
θ x [rad]
0.01
0
−0.01
−0.02
−0.03
−0.04
−0.05
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5 5.5 6 6.5 7 7.5 8
T ime [s]
Fig. 5. Block Diagram of our ball and plate system controlled via
PD regulation controller Fig. 7. Implementation results: Behavior of the error, velocity
and control signal in X-axis using PD regulation controller without
compensation
0.05
second. The PD controller component includes the new 0
−0.05
−0.1
−0.15
component that generates the PWM signals for the motors T ime [s]
Control signal in axis Y
0.05
0.01
0
−0.01
−0.02
For the mechanism of the ball and plate it was selected −0.03
−0.04
−0.05
servomotor as an actuator for its high torque and stability. 0 0.5 1 1.5 2 2.5 3 3.5 4
T ime [s]
4.5 5 5.5 6 6.5 7 7.5 8
5
Position error and Velocity in axis Y
0.3
0.25
0.2
0.15
ey [m]
Vy [m/s]
[2] J. Hauser, S. Sastry, P. Kokotovic, Nonlinear control via approx-
0.1
0.05
0
imate input-output linearization: the ball and beam example,
−0.05
−0.1
−0.15
IEEE transactions on Automatic control,Vol. 37(3), pp 392-398,
−0.2
−0.25
−0.3
1992.
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5 5.5 6 6.5 7 7.5 8
T ime [s] [3] B.C. Chang, H. Kwatry, S. S. Hu, An application of robust feed-
Control signal in axis Y
0.05
0.04
back linearization to a ball and beam control problem, Proceed-
0.03
0.02 ings of the IEEE International Conference on control application
θ y [rad]
0.01
0
−0.01
, pp 694-698, 1998.
−0.02
−0.03 [4] F. Andreev, D. Auckly, S. Gosavi, L. Kapitanski, A. Kelkar, W.
−0.04
−0.05
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5 5.5 6 6.5 7 7.5 8 White, Matching linear systems, and the ball and beam, Journal
T ime [s]
Elsevier Automatica ,Vol. 38, pp 2147-2152, 2002.
[5] Sung-Kwun Oh, Hang-Jong Jang, wiltod Pedrycz, The design of
Fig. 10. Implementation results: Behavior of the error, velocity a fuzzy cascade controller for ball and beam system: A study in
and control signal in Y-axis using PD regulation controller with optimization with the use of parallel genetic algorithms, Journal
compensation Elsevier on Engineering Applications of Artificial Intelligence
,Vol. 22, pp 261-271, 2009.
[6] Wei Wei, Peng Xue, A research on control methods of ball and
beam system based on adaptive neural network, Proceedings
system, the initial position of the ball must be placed on of the 2010 International Conference on Computational and
the edge of the plane, so we get the maximum displacement information sciences , 2010.
distance. Finally, the maximum time it takes to stabilize [7] Nima Mohajerin, Mohammad B. Menhaj and Ali Doustmoham-
madi , A reinforcement Learning Fuzzy Controller for the ball
the ball is 4.65 s, and the minimum is 2.7 s. and plate system, Proceedings IEEE , 2010.
[8] Andrej Knuplez, Amor Chowdhury, Rajko Svecko, Modeling and
TABLE I control design for the ball and plate system, IEEE Proceedings ,
Experiment results 2003.
[9] Wen Yu , Nonlinear PD regulation for ball and beam system,
International Journal of Electrical Engineering Education , 46/1
pp. 59-73.
Initial position (m) Final Position (m) Time (s) Error (m) [10] De-hu Yuan, Nonlinear PD regulation for ball and beam system,
(0.041504,0.45508) (0.25,0.25) 3.15 (0,0) Proceedings IEEE Electronics Manufacturing Technology Sympo-
(0.25732,0.47705) (0.25,0.25) 3.2 (0,0) sium , 1999.
(0.4707,0.47021) (0.25,0.25) 3.15 (0,0) [11] Kwang-Kyu Lee, Georg Batz, and Dirk Wolherr, Basket robot:
(0.01855,0.25049) (0.25,0.25) 3.4 (0,0) ball on plate with pure haptic information, IEEE International
(0.23926,0.24707) (0.125,0.125) 2.7 (0,0) Conference on Robotics an Automation, 2008.
(0.041016,0.46045) (0.125,0.125) 3.85 (0,0) [12] Naif B. Almutairi, Mohamed Zribi , On the sliding mode control
(0.27441,0.02588) (0.125,0.125) 2.7 (0,0) of a ball on a beam system, Springer Science Business Media
(0.47217,0.23584) (0.125,0.125) 3.15 (0,0) B.V. 2009, Vol. 59, pp. 221-238.
(0.29053,0.0625) (0.4375,0.4375) 4.4 (0,0) [13] Jong Hyeon Park and Young Jong Lee , Robust visual servoing
(0.25244,0.1084) (0.4375,0.4375) 4.1 (0,0) for motion control of the ball on a plate, Journal Elsevier Science,
(0.049316,0.0625) (0.4375,0.4375) 4.5 (0,0) 2003, Vol.13 pp. 723-738.
(0.025879,0.24805) (0.4375,0.4375) 4.65 (0,0) [14] Hongwei Liu, Yanyang Liang, Trajectory tracking sliding mode
(0.25391,0.48535) (0.4375,0.4375) 3.25 (0,0) control of ball and plate system, Proceedings of the 2nd Inter-
national Asia Conference on Informatics in control, Automation
and Robotics, 2010.
[15] Wen Yu, Floriberto Ortiz, Stability analysis of PD regulation
VI. Acknowledgment for ball and beam system, IEEE Conference on control applica-
tions,CCA’05, Toronto, Canada 517-522, 2005.
We thank the support of Mexican Government (SNI, [16] C.A. Perez Olvera, Control visual difuso de un sistema no-lineal,
,Master thesis, CIC IPN, Mexico 2009.
SIP-IPN, COFAA-IPN, PIFI-IPN and CONACYT) and to [17] D. Casagrande, A. Astolfi, and T. Parisini, Switching-Driving
Altera Coorporation and Victor Maruri for the dontation Lyapunov Function and the stabilization of the ball and plate,
of equipment and Quartus II academic licenses. IEEE Transactions automatic control, Vol. 54, No. 8. August
2009, pp. 1881-1886.
[18] Rafael Kelly , Robust Asymptotically stable visual servoing of
VII. Conclusion planar robots, IEEE Transactions on robotics and automation,
Vol. 12, No. 5. October 1996, pp. 759-766.
In this paper, a new PD regulation with nonlinear exact [19] Shorya Awtar, C. Bernard, N. Boklund, A. Master, D. Ueda,
compensation is presented, these new scheme guarantees Kevin Craig , Mechatronic design of a ball on plate balancing
the stability of the closed loop system. To check this system, Journal Elsevier Science, 2002, Vol.12 pp. 217-218.
[20] Xingzhe Fan, Naiyao Zhang and Shujie Teng , Trajectory plan-
proposal first a simulation experiments was made, then ning and tracking of ball and plate system using hierarchical fuzzy
was tested in a real implementation of the ball and plate control scheme, fuzzy Sets and System, 2003, Vol.144 pp. 297-312.
system. The results show a good performance of the [21] Xiaou Li and Wen Yu , Syncronization of ball and beam Sys-
tems with neural Compesation, International Journal of Control,
system. As a future work, a PD regulation with a Neural Automation and systems, 2010, Vol.8(3) pp. 491-496.
Network compensator will be developed. [22] R. M. Murray, Z. Li and S.S. Sastry, A mathematical Introduc-
tion to Robotic Manipulation (CRC Press, Boca Raton, 1994).
References
[1] Sung-Kwun, Han-Jong Jang, Witold Pedrycz, Optimized Fuzzy
PD cascade controller: A comparative analysis and design, Jour-
nal Simulation Modeling Practice and theory ,Vol. 19, pp 181-195,
2011.