Please wait a minute...
Chinese Journal of Engineering Design  2017, Vol. 24 Issue (2): 196-202,210    DOI: 10.3785/j.issn.1006-754X.2017.02.011
    
Design of X-type unmanned quadrotor based on STM32
PAN Chun-rong, XU Hua
School of Mechanical and Electrical Engineering, Jiangxi University of Science and Technology, Ganzhou 341000, China
Download: HTML     PDF(2148KB)
Export: BibTeX | EndNote (RIS)      

Abstract  

For the flight attitude control of unmanned quadrotor, there still exist some issues on accurate measurement, calculation and output. To acquire a stable flight attitude control, an X-type unmanned quadrotor was designed based on STM32 microprocessor. Dual processors, dual gyroscopes and dual accelerometers were integrated into the hardware architecture. Real time flight attitude information was collected. Quaternion complementary filter algorithm and cascade PID control algorithm were adopted in attitude calculation and output. The experiment results showed that the structure of dual gyroscopes and dual accelerometers had higher measurement accuracy under little angle disturbance, and the attitude angle got a smaller output error with appropriate parameter settings of cascade PID. The results demonstrate that dual sensors can perform stronger noise immunity in attitude measurement, and the designed X-type unmanned quadrotor has good flying performance and can achieve the purpose of flight attitude stability control, which provides guidance for further study on flight control system.



Key wordsX-type quadrotor      STM32      quaternion      complementary filter      cascade PID     
Published: 28 April 2017
CLC:  TP27  
Cite this article:

PAN Chun-rong, XU Hua. Design of X-type unmanned quadrotor based on STM32. Chinese Journal of Engineering Design, 2017, 24(2): 196-202,210.

URL:

https://www.zjujournals.com/gcsjxb/10.3785/j.issn.1006-754X.2017.02.011     OR     https://www.zjujournals.com/gcsjxb/Y2017/V24/I2/196


基于STM32的X型四旋翼无人机设计

针对四旋翼无人机飞行姿态测量易受干扰、姿态解算和姿态控制输出误差大等问题,以飞行姿态稳定控制为目标,设计了一种基于STM32系列微控制器的X型四旋翼无人机。采用以双处理器、双陀螺仪和双加速度计为主的硬件架构,实时采集无人机飞行姿态信息,并结合基于四元数的互补滤波算法和串级PID控制算法对姿态信息分别进行解算和控制输出。实验结果显示:小角度扰动下,双陀螺仪和双加速度计姿态测量精度高,合理设置双环PID参数后,姿态角输出误差小。结果表明:双传感器硬件架构在姿态测量中的抗干扰性更强,设计的X型四旋翼无人机飞行性能较好,达到飞行姿态稳定控制的目的。研究结果对后续飞行控制系统的深入研究具有一定的指导作用。


关键词: X型四旋翼,  STM32,  四元数,  互补滤波,  串级PID 
[[1]]   FLOREANO D, WOOD R J. Science, technology and the future of small autonomous drones[J]. Nature, 2015, 521: 460-466.
[[2]]   鲜斌, 古训, 刘祥, 等. 小型无人直升机姿态非线性鲁棒控制设计[J]. 控制理论与应用, 2014, 31(4): 409-416. XIAN Bin, GU Xun, LIU Xiang, et al. Nonlinear robust attitude control for a miniature unmanned helicopter[J].Control Theory & Applications, 2014, 31(4): 409-416.
[[3]]   何勇灵, 陈彦民, 周岷峰. 四旋翼飞行器在风场扰动下的建模与控制[J]. 中国惯性技术学报, 2013, 21 (5): 624-630. HE Yong-ling, CHEN Yan-min, ZHOU Min-feng. Modeling and control of a quadrotor helicopter under impact of wind disturbance[J]. Journal of Chinese Inertial Technology, 2013, 21(5): 624-630.
[[4]]   KENDOUL F. Survey of advances in guidance, navigation, and control of unmanned rotorcraft systems[J]. Journal of Field Robotics, 2012, 29(2): 315-378.
[[5]]   HOFFMANNG, RAJNARAYAN D G, WASLANDER S L, et al. The Stanford testbed of autonomous rotorcraft for multi agent control (STARMAC)[C]//Digital Avionics Systems Conference, Salt Lake, Oct. 24-28, 2004.
[[6]]   KENDOUL F, YU Z, NONAMI K.Guidance and nonlinear control system for autonomous flight of minirotorcraft unmanned aerial vehicles[J]. Journal of Field Robotics, 2010, 27(3): 311-334.
[[7]]   宿敬亚, 张瑞峰, 王新华, 等. 基于滤噪微分器的四旋翼飞行器控制[J]. 控制理论与应用, 2009, 26(8): 827-832. SU Jing-ya, ZHANG Rui-feng, WANG Xin-hua, et al. Controlling a four-rotor aircraft based on noise-attenuation differentiator[J]. Control Theory & Applications, 2009, 26(8): 827-832.
[[8]]   KALANTARI A, SPENKO M. Modeling and performance assessment of the HyTAQ, a hybrid terrestrial/aerial quadrotor[J]. IEEE Transactions on Robotics, 2014, 30(5): 1278-1285.
[[9]]   安宏雷, 李杰, 王剑, 等. 应用于四旋翼无人机角速度估计的几何滑模观测器设计[J]. 国防科技大学学报, 2013, 35(6): 165-170. AN Hong-lei, LI Jie, WANG Jian, et al. Geometric sliding mode observer design with application to angular velocity estimation of quadrotor UAV[J]. Journal of National University of Defense Technology, 2013, 35(6): 165-170.
[[10]]   宿敬亚, 樊鹏辉, 蔡开元. 四旋翼飞行器的非线性 PID 姿态控制[J]. 北京航空航天大学学报, 2011, 37(9): 1054-1058. SU Jing-ya, FAN Peng-hui, CAI Kai-yuan. Attitude control of quadrotor aircraft via nonlinear PID[J]. Journal of Beijing University of Aeronautics and Astronautics, 2011, 37(9): 1054-1058.
[[11]]   杨立本, 章卫国, 黄得刚. 基于ESO的欠驱动四旋翼飞行器轨迹鲁棒控制[J]. 系统工程与电子技术,2015, 37(9):2102-2108. YANG Li-ben, ZHANG Wei-guo, HUANG De-gang. Robust trajectory tracking control for underatuated quadrotor UAV based on ESO[J]. Systems Engineering and Electronics, 2015, 37(9): 2102-2108.
[[12]]   刘建业, 贾文峰, 赖际舟, 等. 微小型四旋翼飞行器多信息非线性融合导航方法及实现[J]. 南京航空航天大学学报, 2013, 45(5): 575-582. LIU Jian-ye, JIA Wen-feng, LAI Ji-zhou, et al. Multi-information nonlinear fusion technology of micro quadrotor aircraft[J]. Journal of Nanjing University of Aeronautics & Astronautics, 2013, 45(5): 575-582.
[[13]]   ZHANG X, XIAN B, ZHAO B, et al. Autonomous flight control of a nano quadrotor helicopter in a GPS-denied environment using on-board vision[J]. IEEE Transactions on Industrial Electronics, 2015, 62(10): 6392-6403.
[[14]]   廖懿华, 张铁民, 廖贻泳. 基于模糊-比例积分偏差修正的多旋翼飞行器姿态测算系统[J]. 农业工程学报, 2014, 30(20): 19-27. LIAO Yi-hua, ZHANG Tie-min, LIAO Yi-yong. Multi-rotor aircraft attitude detection system based on fuzzy-proportion integration deviation correction[J]. Transactions of the Chinese Society of Agricultural Engineering, 2014, 30(20): 19-27.
[[15]]   李翔,李智. 航姿参考系统三轴磁强计校正的点积不变法[J].仪器仪表学报, 2012, 33(8): 1813-1818. LI Xiang, LI Zhi. Dot product invariance method for the calibration of three-axis magnetometer in attitude and heading reference system[J]. Chinese Journal of Scientific Instrument, 2012, 33(8): 1813-1818.
[[16]]   FOURATI H. Heterogeneous data fusion algorithm for pedestrian navigation via foot-mounted inertial measurement unit and complementary filter[J]. IEEE Transactions on Instrumentation and Measurement, 2015, 64(1): 221-229.
[[17]]   DEMARINA H G, PEREDA F J, GIRON-SIERRA J M, et al. UAV attitude estimation using unscented kalman filter and TRIAD[J]. IEEE Transactions on Industrial Electronics, 2012, 59(11): 4465-4474.
[[18]]   ISLAM S, LIU P X, EL SADDIK A. Robust control of four-rotor unmanned aerial vehicle with disturbance uncertainty[J]. IEEE Transactions on Industrial Electronics, 2015, 62(3): 1563-1571.
[[19]]   杨荟憭, 姜斌, 张柯. 四旋翼直升机姿态系统的直接自修复控制[J]. 控制理论与应用, 2014, 31(8): 1053-1060. YANG Hui-liao, JIANG Bin, ZHANG Ke. Direct self-repairing control for four-rotor helicopter attitude systems[J]. Control Theory & Applications, 2014, 31(8): 1053-1060.
[1] Xin-ping TAN,Lang GAN,Cheng-xu LIN,Xue-mei LI,Qian LI,Wang YAN,Gang CHEN,Guang-lan LIAO,Zhi-yong LIU. Design and implementation of fully automatic pathological staining control system based on STM32[J]. Chinese Journal of Engineering Design, 2022, 29(4): 510-518.
[2] PAN Sheng-hu, LIU Yun-qiang, HU Han, ZHANG Xiao-jun, FENG Yi-fu. Research on 3D printer control system based on multiple nozzles in parallel[J]. Chinese Journal of Engineering Design, 2022, 29(1): 100-106.
[3] YIN Rong-fei, XU Hai-li, TIAN Wei-guang, XU Xun-qian, SHEN Biao. Design of control system for frame 3D construction printer[J]. Chinese Journal of Engineering Design, 2022, 29(1): 107-114.
[4] ZHENG Hua-lin, FENG Yi-fu, PAN Sheng-hu. Design of weak magnetic signal acquisition system for metal pipeline based on STM32[J]. Chinese Journal of Engineering Design, 2021, 28(5): 646-653.
[5] ZHENG Hua-lin, WANG Chao, PAN Sheng-hu, GAO Wei-xiang. Research on noise reduction method of magnetic memory signal based on EEMD and layered threshold[J]. Chinese Journal of Engineering Design, 2020, 27(4): 433-440.
[6] SHANG Zhi-wu, ZHOU Xiang-ping, LI Cheng. Design of micro-sampling system with high precision for small enzyme immunoassay analyzer[J]. Chinese Journal of Engineering Design, 2018, 25(5): 597-606.
[7] LÜ Hao, WANG Xue-min, JIANG Zhi-hao, ZHOU Peng. Design of tele pulse recurrence system based on STM32[J]. Chinese Journal of Engineering Design, 2017, 24(4): 465-472.
[8] LIU Zhen-wu, SHANG Zhi-wu, HUANG Yan-bin. Design of full automatic biochemical sampling system[J]. Chinese Journal of Engineering Design, 2016, 23(6): 612-619.