Professional Documents
Culture Documents
Main
Main
net/publication/339342177
CITATIONS READS
35 5,278
4 authors, including:
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Fu Zhang on 20 March 2020.
R = Rz (η)Ry (θ)Rx (ϕ) (8b) body-Z axis force Td . The attitude controller will calculate
the desired moment τdB based on the desired attitude. And
where m, I and J B stand for the mass, the identity matrix finally, the mixer will calculate the motor thrust commands
in R3×3 and inertia matrix, ω B is the angular velocity and servo angle commands based on the τdB and Td .
vector represented in the body frame while ω b B is the skew- 1) Postition Controller:
B I
symmetric cross product matrix of ω , v is the velocity
T The position controller of Gemini is a cascaded controller
vector represented in the inertial frame, fg = 0 0 mg with proportional gain K p . It calculates the desired velocity
stands for the gravity in the inertial frame, R is the rotation vdI as follows:
matrix from the inertial frame to the body frame following
vdI = K p · pIe = Kp · pId − pI
the Z-Y-X Tait-Bryan order where η, θ, and ϕ stand for (9)
B
the
yaw, pitch, T and roll Euler angle, respectively, τ = where pIe , pId and pI are the position error, desired position
τx τy τz is the moment vector produced by rotors
in body frame, where τx , τy , τz are detailed in Fig.7, the and current position, respectively. The inner velocity loop
T will calculate the desired acceleration aId through a PID
force vector is fTB = 0 0 T , where T = T1 cos δ1 +
controller:
T2 cos δ2 .
veI = vdI − v I (10a)
It should be noted that there are three simplifications Z
in the above modeling process. (1) The reactive torque
aId = Kpv · veI + Kiv · veI + Kdv · v̇eI (10b)
of servomotor, which comes from the angular acceleration
of its rotor, is not modeled because the rotor inertia is
where veI and v I are the velocity error and current velocity,
quite small when compared to the whole aircraft. (2) The
respectively, Kpv , Kiv and Kdv are the gains of PID terms.
propeller torque is also ignored in τ B as it is usually small T
The desired attitude Rd and force fTBd = 0 0 Td can
when compared to the torque caused by thrusts. (3) In the
calculation for the force vector fTB , the thrust projected to be uniquely solved from the below equation following the
the y-axis of the body frame during the tilt of the two method in [33]:
servomotors is neglected. This force is only present in the maId = fg + Rd fTBd (11)
transient response of roll rotation and is zero when the roll
angle converges to the desired value. The neglected torque 2) Attitude Controller:
and force will bring additional dynamics to the UAV rotation The attitude controller is also a cascaded controller. The
and translation and require careful modeling [17]. In this outer loop (i.e., angular loop) is a proportional controller to
paper, we focus on designing the baseline controller that aims track the desired attitude Rd . The quaternion (q = [η, ])
to stabilize the overall system. For this purpose, the three is used to represent the attitude, where and η denotes
simplifications are valid, as shown in the actual experiments. the vector and scalar part of the quaternion, respectively.
With the quaternion representation, the attitude error qe and
B. Control System desired angular velocity ωdB are calculated based on the
The whole control structure of Gemini is shown in Fig. “Quaternion linear” method in [34]:
8. The navigation module produces the target position pd T
qe = qd ∗ ⊗ q = ηe Te
(12a)
and yaw angle ψd for position controller to track. The
position controller will generate the desired attitude Rd and ϕ = 2 · atan2 (ke k , ηe ) (12b)
1 Throughout the text the superscript I B ϕ
and will be used to denote the ωdB = K a · ξeB = K a · sign (ηe ) (12c)
inertial and body frame, respectively. sin( ϕ2 )
Position Loop Velocity Loop
20.0
Voltage (V )
17.5
Current (A)
25.0
22.5
PID 20.0
- - 17.5
300 325 350 375 400 425 450 475 500
400
Power (W )
Fig. 10. The structure of attitude controller 350
gain from attitude error ξeB to desired angular velocity ωdB . 250
300 325 350 375 400 425 450 475 500
The inner loop (i.e., angular rate loop) is a PID controller Time (s)
(13) to track the desired angular velocity ωdB : Fig. 11. The voltage, current, and power consumption during the hovering
flight
ωeB = ωZdB − ω B (13a)
τdB = Kpr · ωeB + Kir · ωeB + Kdr · ω̇eB (13b)
where ωeB and ω B are the angular velocity error and
current angular velocity, respectively. Kpr , Kir and Kdr are
the gains of PID terms. The output of the inner loop is the
T
desired moment τdB = τxd τyd τzd .
3) Mixer:
As shown in Fig.7, the relationship between moments (τx ,
τy , τz ), body-Z force T and actuator output (δ1 , δ2 , T1 , T2 )
is as below:
0 1 0 1 T1 sin δ1 T
D 0 D Fig. 12. The position and attitude during the hovering flight
0 T1 cos δ1 τx
0 L 0 −L T2 sin δ2 = τy (14) capabilities, the optimization of which is beyond the scope
Roll (◦)
−2.5 Desired 20 Desired
−3.0 0 [17] A. Sanchez, J. Escareno, O. Garcia, and R. Lozano, “Autonomous
−3.5
−4.0 −20
hovering of a noncyclic tiltrotor UAV: Modeling, control and imple-
121 122 123 124 125 126 127 128 121 122 123 124 125 126 127 128 mentation,” IFAC Proceedings Volumes, vol. 41, no. 2, pp. 803–808,
1.5 40
2008.
Position Y (m)
Actual Actual
1.0
Pitch (◦)
0.0
Actual −20 Actual [19] L. Hrečko, J. Slačka, and M. Halás, “Bicopter stabilization based
Yaw (◦)
Desired Desired
−0.5 −40 on imu sensors,” in 2015 20th International Conference on Process
−60
−1.0
−80
Control (PC). IEEE, 2015, pp. 192–197.
−1.5
121 122 123 124 125 126 127 128 121 122 123 124 125 126 127 128
[20] Q. Zhang, Z. Liu, J. Zhao, and S. Zhang, “Modeling and attitude
Time (s) Time (s) control of bi-copter,” in 2016 IEEE International Conference on
Fig. 14. The position and attitude when crossing the gap Aircraft Utility Systems (AUS). IEEE, 2016, pp. 172–176.
[21] F. Gonçalves, J. Bodanese, R. Donadel, G. Raffo, J. Normey-Rico,
design which can be improved upon. Immediately noticeable and L. Becker, “Small scale UAV with birotor configuration,” in 2013
is the jerky yaw and roll control which is undoubtedly a result International Conference on Unmanned Aircraft Systems (ICUAS).
of a tandem-rotor bi-copter design. Also, the two additional IEEE, 2013, pp. 761–768.
[22] C. Blouin and E. Lanteigne, “Pitch control of an oblique active tilting
dynamics as pointed out in the main texts need to be carefully bi-rotor,” in 2014 International Conference on Unmanned Aircraft
modeled and compensated to achieve accurate and robust Systems (ICUAS). IEEE, 2014, pp. 791–799.
control of such a bi-copter UAV. [23] K. Siddhardha, “A novel bi-rotor configuration and its control,” IFAC-
PapersOnLine, vol. 51, no. 1, pp. 456–461, 2018.
[24] J. Leishman, “Principles of helicopter aerodynamics. cambridge uni-
R EFERENCES versity press, 2006,” 2006.
[1] Y. Khosiawan and I. Nielsen, “A system of uav application in indoor [25] E. Davis, J. Spollard, and P. Pounds, “Passive height stability and
environment,” Production & Manufacturing Research, vol. 4, no. 1, trajectory repeatability of a quadrotor maneuvering in ground effect
pp. 2–22, 2016. with regulated voltage bus,” in Australasian conference on robotics
[2] F. Nex and F. Remondino, “UAV for 3D mapping applications: a and automation (ACRA 2015), 2015.
review,” Applied geomatics, vol. 6, no. 1, pp. 1–15, 2014. [26] “APC propeller performance data,” 2019. [Online]. Available:
https://www.apcprop.com/technical-information/performance-data/
[3] V. Baiocchi, D. Dominici, and M. Mormile, “UAV application in post-
[27] B. Theys, G. Dimitriadis, P. Hendrick, and J. De Schutter, “Influence
seismic environment,” International Archives of the Photogrammetry,
of propeller configuration on propulsion system efficiency of multi-
Remote Sensing and Spatial Information Sciences, vol. 1, p. W2, 2013.
rotor unmanned aerial vehicles,” in 2016 international conference on
[4] J. Senthilnath, M. Kandukuri, A. Dokania, and K. Ramesh, “Appli-
unmanned aircraft systems (ICUAS). IEEE, 2016, pp. 195–201.
cation of UAV imaging platform for vegetation analysis based on
[28] S. Salazar, H. Romero, R. Lozano, and P. Castillo, “Modeling and
spectral-spatial methods,” Computers and Electronics in Agriculture,
real-time stabilization of an aircraft having eight rotors,” in Unmanned
vol. 140, pp. 8–24, 2017.
Aircraft Systems. Springer, 2008, pp. 455–470.
[5] “DJI Matrice 100 user manual,” 2016. [Online]. Available: On-line:
[29] S. Driessens and P. Pounds, “The triangular quadrotor: a more efficient
https://dl.djicdn.com/downloads/m100/M100 User Manual EN.pdf
quadrotor configuration,” IEEE Transactions on Robotics, vol. 31,
[6] W. Giernacki, M. Skwierczyński, W. Witwicki, P. Wroński, and
no. 6, pp. 1517–1526, 2015.
P. Kozierski, “Crazyflie 2.0 quadrotor as a platform for research
[30] E. Davis, W. McKay-Lowndes, D. Gonano, S. Hansen, and P. Pounds,
and education in robotics and control engineering,” in 2017 22nd
“Towards the stackrotor: Aerodynamics, construction, dynamics and
International Conference on Methods and Models in Automation and
control of a vertical stacked-rotor configuration for indoor heavy-
Robotics (MMAR). IEEE, 2017, pp. 37–42.
lift helicopter robots,” in Australasian Conference on Robotics and
[7] J. Lin, L. Wang, F. Gao, S. Shen, and F. Zhang, “Flying through a
Automation, ACRA, vol. 2016. Australasian Robotics and Automation
narrow gap using neural network: an end-to-end planning and control
Association, 2016, pp. 81–88.
approach,” arXiv preprint arXiv:1903.09088, 2019.
[31] M. Zhao, T. Anzai, F. Shi, X. Chen, K. Okada, and M. Inaba,
[8] D. Falanga, E. Mueggler, M. Faessler, and D. Scaramuzza, “Aggres- “Design, modeling, and control of an aerial robot dragon: A dual-rotor-
sive quadrotor flight through narrow gaps with onboard sensing and embedded multilink robot with the ability of multi-degree-of-freedom
computing using active vision,” in 2017 IEEE international conference aerial transformation,” IEEE Robotics and Automation Letters, vol. 3,
on robotics and automation (ICRA). IEEE, 2017, pp. 5774–5781. no. 2, pp. 1176–1183, 2018.
[9] D. Falanga, K. Kleber, S. Mintchev, D. Floreano, and D. Scaramuzza, [32] “Snail racing drone propulsion system - DJI.” [Online]. Available:
“The foldable drone: A morphing quadrotor that can squeeze and fly,” https://www.dji.com/hk-en/snail
IEEE Robotics and Automation Letters, vol. 4, no. 2, pp. 209–216, [33] D. Mellinger and V. Kumar, “Minimum snap trajectory generation
2018. and control for quadrotors,” in 2011 IEEE International Conference
[10] V. Riviere, A. Manecy, and S. Viollet, “Agile robotic fliers: A on Robotics and Automation (ICRA). IEEE, 2011, pp. 2520–2525.
morphing-based approach,” Soft robotics, vol. 5, no. 5, pp. 541–553, [34] X. Lyu, H. Gu, J. Zhou, Z. Li, S. Shen, and F. Zhang, “A hierarchical
2018. control approach for a quadrotor tail-sitter VTOL UAV and experi-
[11] N. Bucki and M. W. Mueller, “Design and control of a passively mental verification,” in 2017 IEEE/RSJ International Conference on
morphing quadcopter,” in 2019 International Conference on Robotics Intelligent Robots and Systems (IROS). IEEE, 2017, pp. 5135–5141.
and Automation (ICRA). IEEE, 2019, pp. 9116–9122.
[12] R. Bulaga and T. Worley, “UAV with control and stability system,”
Nov. 15 2007, US Patent App. 11/746,628.