Professional Documents
Culture Documents
Drone
Drone
Ján Galdun*,**, Rony Ghostine***, Jean-Marc Thiriet*, Ján Liguš**, Ján Sarnovský**
Sensors:
- Three magnetometers – measure the intensity of
the local magnetic field, Fig 1. Mini-helicopter real model
- three gyrometers – measure angular speed of the
helicopter, The next section of the paper proposes a short
- three accelerometers – acceleration measuring, description of the mini-helicopter mathematical
- sensors for measuring the angular velocity of model.
each rotor,
- six ultrasonic sensors – used to measure the
distance from any obstacle and define the position of 3.1 Mathematical model.
the helicopter.
In this part of the paper we briefly present the
Actuators: mathematic model proposed by Castillo, Dzul and
- Four motors. Lozano (Castillo, et al., 2005) and adapted by
(Guerrero Castellanos, et al. 2005). To obtain a
mathematical model was used a Lagrangian
approach. The generalized coordinates for the With defining generalized moments τ on the η
rotorcraft are: variables
q = (x, y, z,ψ ,θ , φ ) , ⎛τ ψ ⎞
⎜ ⎟
τ ≅ ⎜τ θ ⎟,
where x, y and z denote the position of the centre of
⎜τ ⎟
mass of the rotorcraft and angles ψ, θ and φ ⎝ φ ⎠
represent Euler angles (yaw, pitch and roll angles)
which denote the orientation of the rotorcraft. These the Coriolis-Centripetal vector
coordinates are divided into translational and
rotational coordinates:
ξ = ( x, y, z ) , η = (ψ ,θ , φ ) .
⎛
V (η ,η& ) = ⎜⎜ J& −
1 ∂ T
(
2 ∂η
η& J )⎞⎟⎟η& = −C (η ,η& )η& ,
⎝ ⎠
The translational kinetic energy of the rotorcraft is:
and with other mathematical modifications was
m
Ttrans ≅ ξ& T ξ& , obtained this model:
2 ⎛ − sin θ ⎞ ⎛ 0 ⎞
⎜ ⎟ ⎜ ⎟
mξ&& = u ⎜ cos θ sin φ ⎟ + ⎜ 0 ⎟
where m denotes the mass of the rotorcraft. The ⎜ cos θ cos φ ⎟ ⎜ − mg ⎟
rotational kinetic energy is: ⎝ ⎠ ⎝ ⎠
1
Trot ≅ η& T Jη& , J η&& = −C (η ,η& )η& + τ
2
where matrix J represents the inertia matrix. And 3.2 TrueTime toolbox application
potential energy is given by:
U = mgz . The replacement of the classic control structure by a
networked control structure is a first step to add
Thus the Lagrangian is: network interface into the Matlab / Simulink
.
simulation (Anderson, et al., 2005; Cervin, et al.,
L(q, q ) = Ttrans + Trot − U
. 2003). Both parts of the system, helicopter and base,
m 1 are modelled by using classical Simulink blocks
= ξ& T Jξ& + η& T Jη& − mgz
2 2 whereas the TrueTime library provides specific
blocks for the network interface modelling. This
The model of the rotorcraft dynamics is obtained library is developed in C++ language. All the
from the Euler-Lagrange equations with external developed files are compiled in Matlab by using an
generalized force: external C++ compiler.
d ∂L ∂L
− =F, The controller (static base) communicates via
dt ∂ q.
∂q network with sensors and actuators which are placed
on the moveable part of the whole system – mini-
helicopter. Controller receives 9 signals from the
where F = (Fξ, τ) and Fξ is the translational force
helicopter sensors which are used by the control
applied to rotorcraft due to the control inputs. Small
algorithm to compute actuating value for each one
body forces are ignored and thus:
propeller drive (actuator). Structure of the described
⎛0⎞ system modelled by TrueTime is shown in the figure
⎜ ⎟ 2.
Fˆ = ⎜ 0 ⎟ ,
⎜u ⎟ TrueTime provide few types of networks which can
⎝ ⎠
be used for simulation of the NCS. These networks
are divided into two categories – wire and wireless
where control input u = f1 + f2 + f3 + f4 and f1 = kiωi
networks. Provided wire network by TrueTime are:
where ki > 0 is constant and ωi is the angular speed
- Ethernet (CSMA / CD)
of the i-th motor. Then
- CAN (CSMA / AMP)
Fξ = RFˆ , - Round Robin (Token Bus)
where R is the transformation matrix representing the - TDMA (Time Division Multiple Access)
orientation of the helicopter (for cos was used c and - FDMA (Frequency Division Multiple Access)
for sin was used s). - Switched Ethernet
q2 0.03
0.4
0.02
0.2 0.01
0
0
-0.01
-0.2 -0.02
0 1 2 3 4 5 0.8 1 1.2 1.4 1.6 1.8 2
time [s] time [s]
Fig. 3. System behaviour without network. Fig. 5. Comparison of the curves q2.
1.005 1
q0
0.8
1 q1
0.6 q2
0.995 q3
Without network 0.4
CAN 1Mb/s
0.2
0.99 Eth 10Mb/s
0
q
0.985
q0
-0.2
0.98 -0.4
-0.6
0.975
-0.8
0.97
-1
0 1 2 3 4 5
time [s]
0.965
0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
time [s] Fig. 6. Ethernet network with a data rate of 1 Mbit/s.
Fig. 4. Comparison of the curves q0. As we can see, the simulation result of the Ethernet
network (shown in figure 6) was insufficient when
the network data rate was 1 Mbit/s. A solution of this
5. RESULTS problem was found when data rate was increased up
Provided simulations show that differences among to 10 Mbit/s. The reason for the insufficient result
system output obtained by simulation without with 1 Mbit/s network data rate can found in the
network, with 1 Mbit/s CAN network and with 10 medium access method (arbitrary system) too. The
Mbit/s Ethernet network are very small (figure 4 and occurrence of the collisions on the network depends
5). Thus, in the case of both networks with on some characteristics of the NCS such as the
mentioned data rates were obtained results which do number of nodes connected to the network, on the
not disturb the required quality of the control (in network data rate, on the synchronisation among the
comparison with simulation results without network). nodes, on the sampling period, etc (Balogh et al.,
2001). The probability of collisions increases if the
above characteristics are not correctly tuned. When ACKNOWLEDGEMENTS
the mentioned aspects such as data rate, number of The authors wish to thank colleagues and students
nodes, sample period are not optimally tuned the from Grenoble: Małgorzata Sztokfisz, Aneel Kumar
system can be destabilised (Lian, et al., 2002) as in Tanwani, Guillermo Fermi, Sylviane Gentil, Suzanne
the figure 6. We can see that a low bit rate in Lesecq.
combination with a small sampling period for each
node represents a NCS with none optimally tuned REFERENCES
parameters.
Anderson, M., Henriksson, D., Cervin, A., (2005)
In the model of the presented networked control TrueTime 1.3 – Reference Manual, Lung Institute of
Technology.
system we suppose that all connected nodes are Balogh, R., Bélai, I., Dorner,J., Drahoš, P., (2001)
synchronized. This synchronisation increases the Priemyselné komunikácie, STU Bratislava, ISBN 80-
probability of the collisions because each node send 227-1600-6
sampled or computed data with the same sample Castillo, P., Dzul, A., Lozano, R., (2004). Real-Time
period in the same time. Thus, when the system is Stabilisation and Tracking of a Four Rotor Mini-
synchronized and the sample period of each node is Rotorcraft, IEEE Transaction on control systems
0.01s, as in mini-helicopter simulation, then the technology, Vol 12, No. 4, p. 510 – 516.
probability of collisions as well as the delays is Cervin, A., Henriksson, D., Lincoln, B., Eker, J., Arzen,
rapidly increasing. In the case of the simulation with K.,E., (2003) How Does Control Timing Affect
Performance? Analysis and Simulation of Timing
Ethernet network with 1 Mbit/s data rate all of Using Jitterbug and TrueTime, IEEE Control Systems
mentioned conditions (low bit rate, a lot of nodes, Magazine, Vol 23, No. 3, p. 16 – 30.
small sample period, etc.) is occurred hence the Cheong SO, J.K (2003). Delay Modelling And Controller
system was destabilized. The simulation result show design for networked Control systems. Master of
that Ethernet network is more suitable for application applied thesis. Department of Electrical and Computer
where they are not sent a lot of data in the short time Engineering University of Toronto.
intervals. Hence conditions which are required by Guenard, N., Hamel, T., Moreau, V., (2005) Dynamic
networked control systems are not suitable for its modeling and intuitive control strategy for an “X4-
application. flyer”, International Conference on Control and
Automation, 26-29 June 2005, Vol 1, p.141 - 146.
Guerrero Castellanos J.F, S. Lesecq, N. Marchand, and
On the basis of obtained results we can suppose that J.Delamare (2005) A low-cost air data attitude
sending a lot of data in short time intervals via heading reference system for the tourism airplane
network with insufficient data rate, can cause applications. IEEE Sensors.
network delays which can make the system unstable. Kumar P.R., (2001) New Technological Vistas for Systems
Hence it is necessary to take care of the network type and Control: The Example of Wireless Networks,
determined for application in the conditions of the IEEE Control System Magazine.
networked control systems. Lian, F., L., Moyne, J., R., Tilbury, D., M., (2002)
Network design consideration for distributed control
systems, IEEE Trans. on Control Systems Technology,
Vol. 10, no. 2, pp. 297–307, 2002.Barger, P., J.M.
6. CONCLUSIONS Thiriet, M. Robert (2003). Safety analysis and
reliability estimation of a networked control system
The aim of this work is to study Networked Control In: SAFEPROCESS 2003, Washington, D.C, USA.
Systems, and more precisely to see on performance
Ligušova J., Thiriet J.M., Liguš J., Barger P, Effect of
parameters of the control network. We are Elements Initialization in Synchronous Networked
particularly interested in the influence of these control System to Control Quality, RAMS/IEEE
parameters to stability and reliability of the system. conference 2004 (Annual Reliability and
This approach with using provided simulations is Maintainability Symposium), Los Angeles, January
necessary for realization the real networked control 2004.
structure of the mini-helicopter model. Lozano, R., Castillo, P., Garcia, P., Dzul, A., (2004)
Robust prediction-based control for unstable delay
This paper is a contribution to the study of the systems: Application to the yaw control of a mini-
helicopter, Automatica, Vol. 40, p. 603 - 612.
influence of the network parameters to stability and
Pekhteryev, G. Sahinoglu, Z. Orlik, P. Bhatti, G.,
quality of the control realized for networked control (2005) Image Transmission over IEEE 802.15.4 and
system. Results show difference between using the ZigBee, Networks Circuits and Systems. IEEE
network developed especially for control and the International Symposium, Vol 4, p. 3539 - 3542
network determined for widely use in common Rufino, J. and P. Verissimo (1995), A study on the
distributed systems where short time delays are inaccessibility characteristics of the controller area
ignored. We can also see that relation between network, Proceeding of the 2nd International CAN
network rate and quality of the control is very close. Conference .
Simulations show that other parameters have Tanwani, A. K., Galdun, J., Thiriet, J-M., Lesecq, S.,
Gentil, S. Modelling of an experimental networked
influence to performance characteristic of the drone with consideration of faults, submitted to
networked control systems too. ECC’07.
Tayebi, A., McGilvray, S., (2006) Attitude Stabilization of
a VTOL Quadrotor Aircraft, IEEE Transactions on
control systems technology, Vol. 14, No. 3, p. 562 -
571