Flight and Hover Control System Design for a Mini-quadrotor Based on Multi-sensors

  • Zhongli Ma
  • Huixin LiEmail author
  • Yanming Gu
  • Zuoyong Li
  • Qianqian Li
Regular Papers Robot and Applications


Mini-quadrotor is difficult to control in the air due to its small size and light weight. This paper presents the flight and hover control system for a mini-quadrotor, including design and simulation of calculations and controllers. Firstly, the attitude and position of the mini-quadrotor are obtained by distributed multi-sensors. Since attitude calculation of aircraft needs a number of combined rotations and vectors transformed by rotation, quaternions are applied to express the attitude model. About error compensation of gyroscope and accelerometer, IMU_Updata algorithm of Mahony filter are applied and improved to realize data fusion [1]. In order to realize accurate hovering at certain position, UWB (UltraWideband) are applied to gain positional information of mini-quadrotor and correct the antenna delay caused sensor error by base station positioning. The discrete Kalman filter of original data is used to achieve the optimized estimation of the airborne position. Px4flow optical flow sensor is able to gets velocity information and avoid the noise problem, which is caused by differential of position data. Then, the mathematical model of a mini-quadrotor’s flight and hover control system can be established. Herein, integral items are solved by the integral separation and integral limiting to mitigate the serious overshoot and oscillation of the system caused by the cascade PID. Finally, the simulation of the attitude controller and position controller are applied with the MATLAB Simulink library. The simulation result shows that the designed attitude controller and position controller can enable the mini-quadrotor to fly smoothly, move in all directions and hover.


Calculation controller flight and hover mini-quadrotor multi-sensors 


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. [1]
    S. O. H. Madgwick, “An efficient orientation filter for inertial and inertial/magnetic sensor arrays,” Report x–io and University of Bristol, vol. 25, pp. 113–118, April 2010.Google Scholar
  2. [2]
    Q. Lindsey, D. Mellinger, and V. Kumar, “Construction of cubic structure with quadrotor teams,” Autonomous Robots, vol. 33, no. 3, pp. 323–336, June 2012.CrossRefGoogle Scholar
  3. [3]
    C. Bills, J. Chen, and A. Saxena, “Autonomous MAV flight in indoor environments using single image perspective cues,” Proc. of IEEE International Conference on Robotics and Automation, vol. 30, pp. 5776–5783, 2011.CrossRefGoogle Scholar
  4. [4]
    J. Qi, D. Song, L. Dai, J. Han, and Y. Wang, “The New Evolution for SIA Rotorcraft UAV Project,” Journal of Robotics, vol. 3, pp. 1–9, May 2010.CrossRefGoogle Scholar
  5. [5]
    A. Alarifi, A. Al–Salman, M. Alsaleh, A. Alnafessah, S. Al–Hadhrami, M. A. Al–Ammar, and H. S. Al–Khalifa, “Ultra wideband indoor positioning technologies: analysis and recent advances,” Sensors, vol. 16, no. 5, pp. 1–36, 2016.CrossRefGoogle Scholar
  6. [6]
    L. Meier, P. Tanskanen, L. Heng, G. H. Lee, and F. Fraundorfer, “PIXHAWK: a micro aerial vehicle design for autonomous flight using onboard computer vision,” Autonomous Robots, vol. 33, no. 1–2, pp. 21–39, 2012.CrossRefGoogle Scholar
  7. [7]
    S. Grzonka, G. Grisetti, and W. Burgard, “Towards a navigation system for autonomous indoor flying,” Proc. of IEEE International Conference on Robotics & Automation, pp. 2878–2883, 2019.Google Scholar
  8. [8]
    B. Hummelink, C. D. Wagter, Q. P. Chu, and J. A. Mulder, “AHRS for small fixed–wing UAV with low–cost IMU/GPS using nonlinear complementary filtering,” Aiaa Guidance, Navigation, & Control Conference, 2006.Google Scholar
  9. [9]
    F. Jurado, M. Rodriguez, A. Dzul, and R. Campa, “Stochastic feedback controller for a quadrotor UAV with dual modified extended Kalman filter,” InternationalWorkshop on Research, 2015.Google Scholar
  10. [10]
    H. Abaunza, P. Castillo, R. Lozano, and A. Victorino, “Quadrotor aerial manipulator based on dual quaternions,” Proc. of International Conference on Unmanned Aircraft Systems, pp. 152–161, 2016.Google Scholar
  11. [11]
    L. C. Lai, C. C. Yang, and C. J. Wu, “Time–optimal control of a hovering quad–rotor helicopter,” Journal of Intelligent & Robotic Systems, vol. 45, no. 2, pp. 115–135, 2006.CrossRefGoogle Scholar
  12. [12]
    L. Li, L. Sun, and J. Jin, “Survey of advances in control algorithms of quadrotor unmanned aerial vehicle,” Proc. of IEEE International Conference on Communication Technology, pp. 107–111, 2015.Google Scholar
  13. [13]
    B. Niu, D. Wang, H. Li, X. Xie, and N. D. Alotaibi, “A novel neural–network–based adaptive control scheme for output–constrained stochastic switched nonlinear systems,” IEEE Transactions on Systems Man & Cybernetics Systems, vol. 99, pp. 1–15, 2017.Google Scholar
  14. [14]
    B. Niu, H. Li, and T. Qin, “Adaptive NN dynamic surface controller design for nonlinear pure–feedback switched systems with time–delays and quantized input,” IEEE Transactions on Systems Man & Cybernetics Systems, pp. 1–13, 2017.Google Scholar
  15. [15]
    Y. Yang, Q. Wu, and M. Chen, “Robust trajectory tracking control for a quadrotor unmanned aerial vehicle using disturbance observer,” World Congress on Intelligent Control & Automation, pp. 697–702, 2016.Google Scholar
  16. [16]
    M. Tailanian, S. Patemain, R. Rosa, and R. Canetti, “Design and implementation of sensor data fusion for an autonomous quadrotor,” Pro. of IEEE International Conference in Instrumentation and Measurement Technology (I2MTC), pp. 1431–1436, 2014.Google Scholar
  17. [17]
    Q. Gao, Y. Wang, and D. Hu, “Onboard optical flow and vision based localization for a quadrotor in unstructured indoor environment,” Proc. of Guidance, Navigation & Control Conference, pp. 2387–2391, 2014.Google Scholar
  18. [18]
    J. F. Guerrero–Castellanos, N. Marchand, A. Hably, S. Lesecq, and J. Delamare, “Bounded attitude control of rigid bodies: real–time experimentation to a quadrotor mini–helicopter,” Control Engineering Practice, vol.19, no. 8, pp. 790–797, 2011.CrossRefGoogle Scholar
  19. [19]
    E. Fresk and G. Nikolakopoulos, “Full quaternion based attitude control for a quadrotor,” Proc. of Control Conference, no. 415, pp. 3864–3869, 2013.Google Scholar
  20. [20]
    A. L. da Silva and J. J. da Cruz, “Fuzzy adaptive extended Kalman filter forUAV INS/GPS data fusion,” Journal of the Brazilian Society of Mechanical Sciences and Engineering, vol.38, no. 6, pp. 1671–168, 2016.CrossRefGoogle Scholar
  21. [21]
    M. Ficco, F. Palmieri, and A. Castiglione, “Hybrid indoor and outdoor location services for new generation mobile terminals,” Personal and Ubiquitous Computing, vol. 18, no. 2, pp. 271–285, 2014.CrossRefGoogle Scholar
  22. [22]
    S. A. Belokon, Y. N. Zolotukhin, K. Y. Kotov, A. S. Mal’tsev, and A. A. Nesterov, “Using the Kalman filter in the quadrotor vehicle trajectory tracking system,” Optoelectronics, Instrumentation and Data Processing, vol.49, no. 6, pp. 536–545, 2013.CrossRefGoogle Scholar
  23. [23]
    Z. Zhang, Y. Xu, J. Yang, X. Li, and D. Zhang, “A survey of sparse representation: algorithms and applications,” IEEE Access, no. 3, pp. 490–530, 2015.Google Scholar
  24. [24]
    Y. Xu, D. Zhang, J. Yang, and J.–Y. Yang, “A two–phase test sample sparse representation method for use with face recognition,” IEEE Transactions on Circuits and Systems for Video Technology, vol. 21, no. 9, pp. 1255–1262, 2011.MathSciNetCrossRefGoogle Scholar
  25. [25]
    J. Kim, M.–S. Kang, and S. Park, “Accurate modeling and robust hovering control for a quadrotor VTOL aircraft,” Journal of Intelligent and Robotic Systems, vol.57, no. 1, pp. 9, 2010.Google Scholar
  26. [26]
    H. Wang and M. Chen, “Sliding mode attitude control for quadrotor micro unmanned aircraft vehicle using disturbance observer,” Proc. of Guidance, Navigation & Control Conference, pp. 568–573, 2015.Google Scholar
  27. [27]
    K. Schauwecker and A. Zell, “On–Board Dual–Stereo–Vision for the Navigation of an Autonomous MAV,” Journal of Intelligent & Robotic Systems, vol. 74, no. 1, pp. 1–16, 2014.CrossRefGoogle Scholar
  28. [28]
    M. Eich, F. Bonnin–Pascual, E. Garcia–Fidalgo, A. Ortiz, G. Bruzzone, Y. Koveos, and F. Kirchner, “A robot application for marine vessel inspection,” Journal of Field Robotics, vol. 31. no. 2,pp. 319–341, 2014.CrossRefGoogle Scholar
  29. [29]
    D. Matouk, O. Gherouat, F. Abdessemed, and A. Hassam, “Quadrotor position and attitude control via backstepping approach,” Proc. of 8th International Conference on Modelling, ICMIC 2016. pp. 73–79, 2017.Google Scholar
  30. [30]
    H. Bolandi, M. Rezaei, R. Mohsenipour, H. Nemati, and S. M. Smailzadeh, “Attitude control of a quadrotor with optimized PID controller,” Intelligent Control & Automation, vol. 4, no. 3, pp. 342–349, 2013.CrossRefGoogle Scholar
  31. [31]
    G. Hoffmann, H. Huang, S. Waslander, and C. Tomlin, “Quadrotor helicopter flight dynamics and control: theory and experiment,” Proc. of the AIAA Guidance, Navigation, and Control Conference, Hilton Head, South Carolina, August 2007.Google Scholar
  32. [32]
    M. A. Vieira, M. Vieira, P. Louro, L. Mateus, and P. Vieira, “Indoor positioning system using a WDM device based on a–SiC:H technology,” Journal of Luminescence, vol. 191, pp. 135–138, 2017.CrossRefGoogle Scholar
  33. [33]
    H. S. Khan and M. B. Kadri, “Position control of quadrotor by embedded PID control with hardware in loop simulation,” Proc. of Multi–topic Conference, pp. 395–400, 2014.Google Scholar

Copyright information

© Institute of Control, Robotics and Systems and The Korean Institute of Electrical Engineers and Springer-Verlag GmbH Germany, part of Springer Nature 2019

Authors and Affiliations

  • Zhongli Ma
    • 1
  • Huixin Li
    • 2
    Email author
  • Yanming Gu
    • 3
  • Zuoyong Li
    • 4
  • Qianqian Li
    • 2
  1. 1.Department of Control Engineering in Chengdu University of Information TechnologyChengdu, SichuanChina
  2. 2.College of AutomationHarbin Engineering UniversityHarbinChina
  3. 3.School of AstronauticsHarbin Institute of TechnologyHarbin, HeilongjiangChina
  4. 4.Fujian Provincial Key Laboratory of Information Processing and Intelligent ControlMinjiang UniversityFuzhouChina

Personalised recommendations