基于专家PID的带臂四旋翼无人机控制方法

doi:10.11772/j.issn.1001-9081.2021060975

《计算机应用》唯一官方网站 ›› 2022, Vol. 42 ›› Issue (8): 2637-2642.DOI: 10.11772/j.issn.1001-9081.2021060975

• 前沿与综合应用 • 上一篇

基于专家PID的带臂四旋翼无人机控制方法

陈宝, 周祖鹏(), 卫欢, 吕延钊, 睢志成

桂林电子科技大学机电工程学院，广西桂林 541004

收稿日期:2021-06-09 修回日期:2021-08-05 接受日期:2021-08-17 发布日期:2022-08-09 出版日期:2022-08-10
通讯作者: 周祖鹏
作者简介:陈宝（1997—），男，海南乐东人，硕士研究生，主要研究方向：带机械臂无人机控制、无人机协同；
周祖鹏（1977—），男，广西桂林人，教授，博士，主要研究方向：带机械臂无人机协同控制、仿生机器人、故障诊断；
卫欢（1995—），男，湖北黄冈人，硕士研究生，主要研究方向：带机械臂无人机的控制；
吕延钊（1996—），男，山东泰安人，硕士研究生，主要研究方向：仿生机器人；
睢志成（1995—），男，河南开封人，硕士研究生，主要研究方向：带机械臂无人机的控制。
基金资助:
国家自然科学资金资助项目(61763006)

Control method of quadrotor UAV with manipulator based on expert PID

Bao CHEN, Zupeng ZHOU(), Huan WEI, Yanzhao LYU, Zhicheng SUI

School of Mechanical and Electrical Engineering，Guilin University of Electronic Technology，Guilin Guangxi 541004，China

Received:2021-06-09 Revised:2021-08-05 Accepted:2021-08-17 Online:2022-08-09 Published:2022-08-10
Contact: Zupeng ZHOU
About author:CHEN Bao， born in 1997， M. S. candidate. His research interests include control of unmanned aerial vehicle with manipulator， unmanned aerial vehicle collaboration.
ZHOU Zupeng， born in 1977， Ph. D.， professor. His research interests include cooperative control of unmanned aerial vehicle with manipulator， bionic robot， fault diagnosis.
WEI Huan， born in 1995， M. S. candidate. His research interests include control of unmanned aerial vehicle with manipulator.
LYU Yanzhao， born in 1996， M. S. candidate. His research interests include bionic robot.
SUI Zhicheng， born in 1995， M. S. candidate. His research interests include control of unmanned aerial vehicle with manipulator.
Supported by:
National Natural Science Foundation of China(61763006)

摘要/Abstract

摘要：

相较于未带臂的无人机，带臂无人机（UAV）的飞行轨迹会出现较大偏差，更难以稳定控制。为了解决带臂UAV的精确轨迹控制问题，提出基于专家PID的带臂四旋翼无人机控制方法。首先，将机械臂搭载于UAV上把它们作为整体，并通过拉格朗日方程建立了带臂UAV的运动学和动力学系统模型；其次，设计专家PID控制器用于对系统的稳定控制；然后利用五次多项式对带臂UAV的机械臂进行轨迹规划；最后，通过仿真验证专家PID控制方法对带臂UAV稳定控制的有效性。实验结果表明，相较于常规PID控制，所提基于专家PID的控制方法提高了系统的响应速度，且能够有效地抑制外部扰动；该方法对于动作情况下的机械臂能够稳定地跟踪其轨迹，且具有很好的抗扰性和鲁棒性。

关键词: 带臂无人机, 专家PID控制, 无人机, 轨迹规划, 干扰

Abstract:

Compared with the Unmanned Aerial Vehicle （UAV） without manipulator， the UAV with manipulator has large deviation in the flight trajectory and is more difficult to control stably. In order to solve the precise trajectory control problem of UAV with manipulator， a control method of quadrotor UAV with manipulator based on expert PID was proposed. Firstly， the manipulator was equipped to the UAV and the two was considered as a whole， and the kinematics and dynamics system models of UAV with manipulator was established through Lagrange equation. Secondly， an expert PID controller was designed to control the stability of the system. Thirdly， the trajectory planning of the manipulator of UAV with manipulator was carried out by using quintic polynomial. Finally， the effectiveness of expert PID control method for the stability control of UAV with manipulator is verified by simulation. The experimental results show that compared with conventional PID control， the proposed control method based on expert PID improves the response speed of the system and can effectively suppress external disturbances. This method can track the trajectory of the manipulator stably under the action， and has good immunity and robustness.

Key words: Unmanned Aerial Vehicle (UAV) with manipulator, expert PID control, Unmanned Aerial Vehicle (UAV), trajectory planning, interference

中图分类号:

TP11

陈宝, 周祖鹏, 卫欢, 吕延钊, 睢志成. 基于专家PID的带臂四旋翼无人机控制方法[J]. 计算机应用, 2022, 42(8): 2637-2642.

Bao CHEN, Zupeng ZHOU, Huan WEI, Yanzhao LYU, Zhicheng SUI. Control method of quadrotor UAV with manipulator based on expert PID[J]. Journal of Computer Applications, 2022, 42(8): 2637-2642.

图/表 11

图1 带臂四旋翼无人机系统

Fig. 1 System of quadrotor UAV with manipulator

图2 带臂无人机的坐标系模型

Fig. 2 Coordinate system model of UAV with manipulator

图3 带臂无人机的控制系统结构

Fig. 3 Structure of control system of UAV with manipulator

表1 带臂四旋翼无人机系统仿真参数

Tab. 1 Simulation parameters of quadrotor UAV system with manipulator

参数	取值	参数	取值
$I x x$	0.024 kg·m²	$d$	0.25
$I y y$	0.024 kg·m²	$H$	0.5
$I z z$	0.045 9 kg·m²	$m 1$	0.800 kg
$m v$	1.2 kg	$m 2$	0.050 kg
$C t$	3×10^-5	$L 1$	0.20 m
$C q$	7.5×10^-7	$L 2$	0.10 m

表1 带臂四旋翼无人机系统仿真参数

Tab. 1 Simulation parameters of quadrotor UAV system with manipulator

参数	取值	参数	取值
$I x x$	0.024 kg·m²	$d$	0.25
$I y y$	0.024 kg·m²	$H$	0.5
$I z z$	0.045 9 kg·m²	$m 1$	0.800 kg
$m v$	1.2 kg	$m 2$	0.050 kg
$C t$	3×10^-5	$L 1$	0.20 m
$C q$	7.5×10^-7	$L 2$	0.10 m

图4 位置对比曲线

Fig. 4 Curve comparison of position

图5 偏航角ψ对比曲线

Fig. 5 Curve comparison of yaw angle ψ

图6 机械臂关节角度对比曲线

Fig. 6 Curve comparison of joint angles of manipulator

图7 外力干扰对比曲线

Fig. 7 Curve comparison of external interference

图8 带臂无人机轨迹曲线对比

Fig. 8 Comparison of trajectory curves of UAV with manipulator

图9 机械臂角度轨迹曲线对比

Fig. 9 Curve comparison of manipulator angle trajectories

图10 机械臂角速度

Fig. 10 Manipulator angular velocity

参考文献 19

1	LI H M， WANG B H， LIU L， et al. The design and application of SmartCopter： an unmanned helicopter based robot for transmission line inspection ［C］// Proceedings of the 2013 Chinese Automation Congress. Piscataway： IEEE， 2013： 697-702. 10.1109/cac.2013.6775824
2	KIM S J， LEE D Y， JUNG G P， et al. An origami-inspired， self-locking robotic arm that can be folded flat［J］. Science Robotics， 2018， 3（16）： No.eaar2915. 10.1126/scirobotics.aar2915
3	KORPELA C M， DANKO T W， OH P Y. MM-UAV： mobile manipulating unmanned aerial vehicle［J］. Journal of Intelligent and Robotic Systems， 2012， 65（1/2/3/4）： 93-101. 10.1007/s10846-011-9591-3
4	KUTIA J R， STOL K A， XU W L. Initial flight experiments of a canopy sampling aerial manipulator ［C］// Proceedings of the 2016 International Conference on Unmanned Aircraft Systems. Piscataway： IEEE， 2016： 1359-1365. 10.1109/icuas.2016.7502616
5	BARTELDS T， CAPRA A， HAMAZA S， et al. Compliant aerial manipulators： toward a new generation of aerial robotic workers［J］. IEEE Robotics and Automation Letters， 2016， 1（1）： 477-483. 10.1109/lra.2016.2519948
6	KAMEL M， ALEXIS K， SIEGWART R. Design and modeling of dexterous aerial manipulator ［C］// Proceedings of the 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway： IEEE， 2016： 4870-4876. 10.1109/iros.2016.7759715
7	HUBER F， KONDAK K， KRIEGER K， et al. First analysis and experiments in aerial manipulation using fully actuated redundant robot arm ［C］// Proceedings of the 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway： IEEE， 2013： 3452-3457. 10.1109/iros.2013.6696848
8	THOMAS J， LOIANNO G， POLIN J， et al. Toward autonomous avian-inspired grasping for micro aerial vehicles［J］. Bioinspiration and Biomimetics， 2014， 9（2）： No.025010. 10.1088/1748-3182/9/2/025010
9	KLAUSEN K， FOSSEN T I， JOHANSEN T A. Nonlinear control with swing damping of a multirotor UAV with suspended load［J］. Journal of Intelligent and Robotic Systems， 2017， 88（2/3/4）： 379-394. 10.1007/s10846-017-0509-6
10	YANG B， HE Y Q， HAN J D， et al. Modeling and control of rotor-flying multi-joint manipulator［J］. IFAC Proceedings Volumes， 2014， 47（3）： 11024-11029. 10.3182/20140824-6-za-1003.00400
11	ORSAG M， KORPELA C M， BOGDAN S， et al. Hybrid adaptive control for aerial manipulation［J］. Journal of Intelligent and Robotic Systems， 2014， 73（1/2/3/4）： 693-707. 10.1007/s10846-013-9936-1
12	BAZYLEV D， KREMLEV A， MARGUN A， et al. Design of control system for a four-rotor UAV equipped with robotic arm ［C］// Proceedings of the 7th International Congress on Ultra Modern Telecommunications and Control Systems and Workshops. Piscataway： IEEE， 2015： 144-149. 10.1109/icumt.2015.7382419
13	SHARIFI M， SAYYAADI H. Nonlinear robust adaptive Cartesian impedance control of UAVs equipped with a robot manipulator［J］. Advanced Robotics， 2015， 29（3）： 171-186. 10.1080/01691864.2014.1002529
14	GARIMELLA G， KOBILAROV M. Towards model-predictive control for aerial pick-and-place ［C］// Proceedings of the 2015 IEEE International Conference on Robotics and Automation. Piscataway： IEEE， 2015： 4692-4697. 10.1109/icra.2015.7139850
15	YOSHIDA K， NAKANISHI H， UENO H， et al. Dynamics， control and impedance matching for robotic capture of a non-cooperative satellite［J］. Advanced Robotics， 2004， 18（2）： 175-198. 10.1163/156855304322758015
16	ARLEO G， CACCAVALE F， MUSCIO G， et al. Control of quadrotor aerial vehicles equipped with a robotic arm ［C］// Proceedings of the 21st Mediterranean Conference on Control and Automation. Piscataway： IEEE， 2013： 1174-1180. 10.1109/med.2013.6608869
17	梁斌，徐文福.空间机器人：建模、规划与控制［M］.北京：清华大学出版社， 2017： 125-135.
	LIANG B， XU W F. Space Robotics： Modeling， Planning and Control［M］. Beijing： Tsinghua University Press， 2017： 125-135.
18	刘金琨.先进PID控制Matlab仿真［M］. 4版.北京：电子工业出版社， 2016： 307-308.
	LIU J K. Matlab Simulation of Advanced PID Control［M］. 4th ed. Beijing： Publishing House of Electronics Industry， 2016： 307-308.
19	全权.多旋翼飞行器设计与控制［M］.杜光勋，赵峙尧，戴训华，等，译.北京：电子工业出版社， 2018： 65-124.
	QUAN Q. Introduction to Multirotor Aircraft Design and Control［M］. DU G X， ZHAO Z Y， DAI X H， et al. translated. Beijing： Publishing House of Electronics Industry， 2018： 65-124.

[1]	薛远亮, 金国栋, 谭力宁, 许剑锟. 基于像素分类的多尺度无人机航拍目标旋转跟踪算法[J]. 《计算机应用》唯一官方网站, 2022, 42(7): 2239-2247.
[2]	李洪亮, 张弄, 孙婷, 李想. 分布式机器学习作业性能干扰分析与预测[J]. 《计算机应用》唯一官方网站, 2022, 42(6): 1649-1655.
[3]	郭可贵, 曹瑞, 万能, 汪晓, 尹悦, 唐旭明, 熊军林. 基于输电杆塔区域提取的图像匹配算法[J]. 《计算机应用》唯一官方网站, 2022, 42(5): 1591-1597.
[4]	凌欣, 李民政. 无人机巡检系统中高频效的混合波束赋形方法[J]. 《计算机应用》唯一官方网站, 2022, 42(3): 980-984.
[5]	马子玉, 何明, 刘祖均, 顾凌枫, 刘锦涛. 无人机协同控制研究综述[J]. 计算机应用, 2021, 41(5): 1477-1483.
[6]	焦海林, 郭玉英, 朱正为. 基于加速度补偿的无人机吊挂飞行抗摆控制[J]. 计算机应用, 2021, 41(2): 604-610.
[7]	钟莎, 黄玉清. 基于孪生区域候选网络的无人机指定目标跟踪[J]. 计算机应用, 2021, 41(2): 523-529.
[8]	黄书召, 田军委, 乔路, 王沁, 苏宇. 基于改进遗传算法的无人机路径规划[J]. 计算机应用, 2021, 41(2): 390-397.
[9]	欧跃发, 杨鸣坤, 慕德俊, 柯捷, 马文涛. 基于广义最大Versoria准则的稀疏自适应滤波算法[J]. 《计算机应用》唯一官方网站, 2021, 41(11): 3325-3331.
[10]	张驰, 李铸洪, 刘舟, 沈未名. 基于场景图划分的无人机影像定位算法[J]. 计算机应用, 2021, 41(10): 3004-3009.
[11]	王岱巍, 徐高潮, 李龙. 无人机辅助的移动边缘计算中的任务分配策略[J]. 计算机应用, 2021, 41(10): 2928-2936.
[12]	黄巨挺, 高宏力, 戴志坤. 基于编码解码结构的移动端电力线语义分割方法[J]. 计算机应用, 2021, 41(10): 2952-2958.
[13]	张凌浩, 王胜, 周辉, 陈一凡, 桂盛霖. 基于MAVLink协议的无人机系统安全通信方案[J]. 计算机应用, 2020, 40(8): 2286-2292.
[14]	卫文乐, 金国栋, 谭力宁, 芦利斌, 陈丹琪. 利用惯导测量单元确定关键帧的实时SLAM算法[J]. 计算机应用, 2020, 40(4): 1157-1163.
[15]	周磊磊, 梁承姬, 胡筱渊. 不确定干扰约束下外集卡提箱策略[J]. 计算机应用, 2020, 40(3): 891-896.

基于专家PID的带臂四旋翼无人机控制方法

Control method of quadrotor UAV with manipulator based on expert PID

RichHTML

PDF

可视化

摘要/Abstract

引用本文

使用本文

图/表 11

参考文献 19

相关文章 15

编辑推荐

Metrics