CN110221543A - 一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法 - Google Patents

一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法 Download PDF

Info

Publication number
CN110221543A
CN110221543A CN201910497637.9A CN201910497637A CN110221543A CN 110221543 A CN110221543 A CN 110221543A CN 201910497637 A CN201910497637 A CN 201910497637A CN 110221543 A CN110221543 A CN 110221543A
Authority
CN
China
Prior art keywords
tether
aerial vehicle
unmanned aerial
thrust
swing
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201910497637.9A
Other languages
English (en)
Other versions
CN110221543B (zh
Inventor
孟中杰
白宇彤
陈志亮
黄攀峰
张夷斋
张帆
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201910497637.9A priority Critical patent/CN110221543B/zh
Publication of CN110221543A publication Critical patent/CN110221543A/zh
Application granted granted Critical
Publication of CN110221543B publication Critical patent/CN110221543B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Wind Motors (AREA)

Abstract

本发明涉及一种种利用系绳/推力协调的无人机吊挂系统摆动抑制方法,利用安装在多旋翼无人机上的系绳收放装置和多旋翼无人机的螺旋桨推力抑制系绳摆动,避免单纯利用螺旋桨推力抑制摆动时产生的无人机位姿误差过大的问题,避免了系绳摆动抑制和多旋翼无人机位姿控制的需求冲突,具有很好的实用性。利用系绳收放装置实现系绳摆动抑制,避免了利用无人机螺旋桨推力进行摆动抑制时的推力要求与无人机位姿控制过程中的推力要求产生冲突的情况,能够在实现无人机位置误差很小情况下的系绳摆动抑制,满足无人机实现精确轨迹跟踪的需求。此外,结合无人机推力共同抑制系绳摆动,可以取得更好的摆动抑制效果。

Description

一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法
技术领域
本发明属于无人机吊挂飞行控制领域,涉及一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法,具体涉及一种在无人机吊挂飞行过程中利用系绳收放作用和无人机推力协调控制的摆动抑制方法。
背景技术
随着多旋翼无人机技术的快速发展,多旋翼无人机已经应用在了自然灾害、警用和军用任务中的高空侦查、农业植保、快递投放以及货物运输等众多军事和民事领域。其中利用多旋翼无人机安装绳索吊挂货物进行运输是一种有效的货物运输手段。同时,由于无人机吊挂系统运输货物的快速性和对多种复杂运输环境的适应性,无人机吊挂飞行得到国内外研究人员的日益关注。
在多旋翼无人机吊挂飞行过程中,多旋翼无人机的控制力由多旋翼无人机的螺旋桨推力提供,此外由于外界条件的影响,需要对系绳进行收放操作,降低飞行过程中外界环境对多旋翼无人机系绳捕获系统发生碰撞、钩挂的风险,同时,降低多旋翼无人机的避障及轨迹跟踪控制难度。在无人机吊挂系统运动过程中,主要的难题是保持多旋翼无人机、系绳、吊挂物体的组合体系统的姿态稳定。这包括三方面内容:1、多旋翼无人机姿态保持;2、吊挂物体姿态保持;3、系绳姿态保持。由于多旋翼无人机具有完善的飞行控制系统,同时由于其具有的欠驱动特性,多旋翼无人机的控制系统通过利用螺旋桨推力能够完成飞行过程中的位置和姿态控制;由于重力和系绳拉力的原因,吊挂物体的姿态在飞行过程中处于相对稳定的范围内;在系绳姿态保持方面,发表于2015年《Proceeding of IEEE Conferenceon Robotics and Automation(ICRA)》的文章“Mixed integer quadratic programtrajectory generation for a quadrotor with a cable-suspended payload.”和2017年同样在《Proceeding of IEEE Conference on Robotics and Automation(ICRA)》发表的文章“Autonomous swing-angle estimation for stable slung-load flight ofmulti-rotor UAVs”给出了利用轨迹规划的方法,引导无人机吊挂系统进行避障飞行的方法。在2016年,《控制理论与应用》的文章“无人机吊挂飞行的非线性控制方法设计”,用能量分析的方法设计了非线性控制器,能够对无人机吊挂系统飞行过程的系绳摆动进行有效抑制。但是,上述运用轨迹规划和控制器设计的方法很大程度上利用了多旋翼无人机的螺旋桨推力,由于多旋翼无人机的欠驱动特性,当较大程度上利用螺旋桨推力抑制系绳摆动时,会和多旋翼无人机的位置和姿态控制需求产生冲突,使多旋翼无人机吊挂系统在飞行过程中产生较大的位置和姿态误差。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法。
技术方案
一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法,其特征在于步骤如下:
步骤1、建立含有系绳收放运动的多旋翼无人机吊挂系统动力学模型:Oxz为惯性坐标系,O1xbzb为多旋翼无人机的本体坐标系;动力学模型为:
m1为多旋翼无人机质量,m2为吊挂物体质量,是系绳的面内摆角,L为系绳长度,x1,z1,x2,z2分别是多旋翼无人机和吊挂物体在惯性系中的位置,g是重力加速度,螺旋桨推力分解到垂直于系绳方向Fnx和沿系绳方向Fny
步骤2、设计期望系绳长度的收放规律:
收放规律即为系绳收放速度为:
每次系绳收放的长度为:
其中:kl是设定的系数,是最近系绳摆动周期的幅值;
每次系绳收放的时间为:
其中:k是设定的系数,是系绳原长条件下的摆动周期,L0是系绳原长;
步骤3、设计含有系绳收放的多旋翼无人机吊挂系统控制器:
其中:由第二步中给定的系绳收放速度的微分得到,L和都是引入的系绳收放规律对无人机控制力产生的反馈,xcontrol,zcontrol是多旋翼无人机的位置误差经过PID控制器的控制量;
所述
其中,为多旋翼无人机的位置误差,xd,zd是多旋翼无人机的期望位置。kpx,kix,kdx和kpz,kiz,kdz分别是设计的位置误差ex,ez PID控制器的比例项、积分项和微分项系数;
步骤4:以多旋翼无人机吊挂系统控制器控制无人机推力的输出,结合步骤2的系绳收放速度,抑制无人机吊挂系统的摆动。
所述系数kl和k的取值为:0~10。
有益效果
本发明提出的一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法,利用安装在多旋翼无人机上的系绳收放装置和多旋翼无人机的螺旋桨推力抑制系绳摆动,避免单纯利用螺旋桨推力抑制摆动时产生的无人机位姿误差过大的问题,避免了系绳摆动抑制和多旋翼无人机位姿控制的需求冲突,具有很好的实用性。
本发明与国内外同类技术对比,具有的积极效果如下:
利用系绳收放装置实现系绳摆动抑制,避免了利用无人机螺旋桨推力进行摆动抑制时的推力要求与无人机位姿控制过程中的推力要求产生冲突的情况,能够在实现无人机位置误差很小情况下的系绳摆动抑制,满足无人机实现精确轨迹跟踪的需求。此外,结合无人机推力共同抑制系绳摆动,可以取得更好的摆动抑制效果。
附图说明
图1是无人机吊挂系统运动过程示意图
图2是利用系绳收放的系绳摆动抑制方法控制流程图
具体实施方式
现结合实施例、附图对本发明作进一步描述:
本发明所采用的技术方案包括以下步骤:
第一步:建立含有系绳收放运动的多旋翼无人机吊挂系统动力学模型
假设:1、由于运动过程中,系绳一直处于绷紧状态,忽略系绳弹性、柔性及质量;
2、忽略吊挂物体的姿态,将吊挂物体看作质点;
3、将系绳与多旋翼无人机的连接点与无人机质心重合。
4、由于系绳的面内摆角和面外摆角可解耦,忽略面外摆动
无人机吊挂飞行运动过程如附图1所示,1为多旋翼无人机,2为系绳,3为吊挂物体,4是惯性坐标系。由于忽略了系绳的面外摆动,故可以只考虑无人机在平面内的运动,模型简化为二维模型。Oxz为惯性坐标系,O1xbzb为多旋翼无人机的本体坐标系。θ是O1xb轴和Ox轴的夹角即无人机的俯仰角,是系绳的面内摆角,L为系绳长度。m1为多旋翼无人机质量,m2为吊挂物体质量,F是多旋翼无人机旋翼的推力。x1,z1,x2,z2分别是多旋翼无人机和吊挂物体在惯性系中的位置。
利用牛顿-欧拉法分析多旋翼无人机和吊挂物体的受力运动情况:
其中,g是重力加速度,Fx和Fz是多旋翼无人机螺旋桨推力F在惯性坐标系中沿各轴的分量,T是系绳上的拉力大小。分别为x1,z1,x2,z2的二阶导数。
分析多旋翼无人机和吊挂物体的运动关系:
其中,为绳长L的一阶和二阶导数,为系绳摆角的一阶和二阶导数。
联立(1)(2)得到多旋翼无人机吊挂系统的二维动力学模型:
为了便于分析和表示方便,将螺旋桨推力分解到垂直于系绳方向Fnx和沿系绳方向Fny。则动力学模型变为:
第二步,设计期望系绳长度的收放规律
设计系绳的收放长度、时间和速度,使系绳摆角能够在系绳收放作用下,完成摆动抑制。
将(4)中描述系绳摆角运动规律第三式提出得到:
分析系绳摆角加速度的运动规律,第一项是无人机螺旋桨推力引起的摆动角加速度,其中第二项是科里奥力引起的加速度,当时,第二项与的符号相反,该项为正阻尼项,同时的值越大,阻尼的值越大,系绳的摆动抑制效果越好,所以在摆动角速度的最大值处(即处)进行放绳最利于摆动抑制。当时,第二项与的符号相同,该项为负阻尼项,会促进系绳的摆动,当摆动角速度的值越小,该项阻尼的值越小,摆动的促进效果越小,所以在摆动速度的最小值处(即处)进行收绳最利于摆动抑制。
根据系绳摆动抑制的条件,设计系绳收放规律:
每次系绳收放的时间为:
其中k是设定的系数,是系绳原长条件下的摆动周期,L0是系绳原长。
每次系绳收放的长度为:
其中,kl是设定的系数,是最近系绳摆动周期的幅值。
取系绳收放速度为:
根据摆动抑制的要求,在系绳摆角满足时对系绳进行收紧,系绳回收速度为回收时间为Δt。当系绳摆角满足时对系绳进行释放,系绳释放速度为回收时间为Δt。在同一系绳摆动周期内,由于系绳收放的长度相等(摆动幅值相同),所以在每个摆动周期后,系绳保持原绳长不变。
第三步:设计含有系绳收放的多旋翼无人机吊挂系统控制器
含有系绳收放的无人机吊挂系统控制器主要依靠系绳收放实现系绳摆动抑制,在设计好能够抑制系绳摆动的系绳收放规律后,根据设计的系绳收放规律,为了控制无人机的质心位置沿期望的轨迹运动,设计基于PID控制的含有系绳收放的无人机吊挂系统控制器如下:
其中:由第二步中给定的系绳收放速度的微分得到,L和都是引入的系绳收放规律对无人机控制力产生的反馈,xcontrol,zcontrol是多旋翼无人机的位置误差经过PID控制器的控制量:
其中,为多旋翼无人机的位置误差,xd,zd是多旋翼无人机的期望位置。kpx,kix,kdx和kpz,kiz,kdz分别是设计的位置误差ex,ez PID控制器的比例项、积分项和微分项系数。
第四步:以多旋翼无人机吊挂系统控制器控制无人机推力的输出,结合步骤2的系绳收放速度,抑制无人机吊挂系统的摆动。

Claims (2)

1.一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法,其特征在于步骤如下:
步骤1、建立含有系绳收放运动的多旋翼无人机吊挂系统动力学模型:Oxz为惯性坐标系,O1xbzb为多旋翼无人机的本体坐标系;动力学模型为:
m1为多旋翼无人机质量,m2为吊挂物体质量,是系绳的面内摆角,L为系绳长度,x1,z1,x2,z2分别是多旋翼无人机和吊挂物体在惯性系中的位置,g是重力加速度,螺旋桨推力分解到垂直于系绳方向Fnx和沿系绳方向Fny
步骤2、设计期望系绳长度的收放规律:
收放规律即为系绳收放速度为:
每次系绳收放的长度为:
其中:kl是设定的系数,是最近系绳摆动周期的幅值;
每次系绳收放的时间为:
其中:k是设定的系数,是系绳原长条件下的摆动周期,L0是系绳原长;
步骤3、设计含有系绳收放的多旋翼无人机吊挂系统控制器:
其中:由第二步中给定的系绳收放速度的微分得到,L和都是引入的系绳收放规律对无人机控制力产生的反馈,xcontrol,zcontrol是多旋翼无人机的位置误差经过PID控制器的控制量;
所述
其中,为多旋翼无人机的位置误差,xd,zd是多旋翼无人机的期望位置。kpx,kix,kdx和kpz,kiz,kdz分别是设计的位置误差ex,ez PID控制器的比例项、积分项和微分项系数;
步骤4:以多旋翼无人机吊挂系统控制器控制无人机推力的输出,结合步骤2的系绳收放速度,抑制无人机吊挂系统的摆动。
2.根据权利要求1所述利用系绳/推力协调的无人机吊挂系统摆动抑制方法,其特征在于:所述系数kl和k的取值为:0~10。
CN201910497637.9A 2019-06-10 2019-06-10 一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法 Active CN110221543B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910497637.9A CN110221543B (zh) 2019-06-10 2019-06-10 一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910497637.9A CN110221543B (zh) 2019-06-10 2019-06-10 一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法

Publications (2)

Publication Number Publication Date
CN110221543A true CN110221543A (zh) 2019-09-10
CN110221543B CN110221543B (zh) 2021-06-15

Family

ID=67816081

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910497637.9A Active CN110221543B (zh) 2019-06-10 2019-06-10 一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法

Country Status (1)

Country Link
CN (1) CN110221543B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110579969A (zh) * 2019-10-23 2019-12-17 南开大学 一种用于双无人机协同吊运棒状刚体负载的控制方法
CN111190430A (zh) * 2020-01-15 2020-05-22 西北工业大学 一种利用系绳旋翼协调的无人机吊挂负载控制方法

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103116358A (zh) * 2013-01-15 2013-05-22 南京航空航天大学 一种空间飞行器绳索稳定收放控制方法
CN104142687A (zh) * 2014-07-17 2014-11-12 西北工业大学 一种空间绳系机械臂目标抓捕后复合体姿态稳定控制方法
CN105182748A (zh) * 2015-09-01 2015-12-23 西北工业大学 一种空间绳系机器人目标抓捕稳定控制方法
US20170043872A1 (en) * 2014-07-08 2017-02-16 Todd Michael Whitaker Tethered unmanned aerial vehicle fire fighting system
CN106873624A (zh) * 2017-03-26 2017-06-20 天津大学 基于部分反馈线性化四旋翼无人机吊挂飞行控制方法
CN106970635A (zh) * 2017-05-17 2017-07-21 西北工业大学 一种拖曳变轨中利用拖曳飞行器机动的系绳摆动抑制方法
CN107589750A (zh) * 2016-07-07 2018-01-16 北京航空航天大学 一种用于绳系拖曳离轨的系统组合体姿态协同控制方法
CN108303879A (zh) * 2018-01-18 2018-07-20 西北工业大学 一种空间柔性系统的欠驱动控制方法
CN108508746A (zh) * 2018-01-30 2018-09-07 天津大学 四旋翼无人机吊挂运输系统的自适应控制方法
CN109491250A (zh) * 2018-12-11 2019-03-19 哈尔滨工业大学 一种无人机吊装运输系统吊装摆动抑制方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103116358A (zh) * 2013-01-15 2013-05-22 南京航空航天大学 一种空间飞行器绳索稳定收放控制方法
US20170043872A1 (en) * 2014-07-08 2017-02-16 Todd Michael Whitaker Tethered unmanned aerial vehicle fire fighting system
CN104142687A (zh) * 2014-07-17 2014-11-12 西北工业大学 一种空间绳系机械臂目标抓捕后复合体姿态稳定控制方法
CN105182748A (zh) * 2015-09-01 2015-12-23 西北工业大学 一种空间绳系机器人目标抓捕稳定控制方法
CN107589750A (zh) * 2016-07-07 2018-01-16 北京航空航天大学 一种用于绳系拖曳离轨的系统组合体姿态协同控制方法
CN106873624A (zh) * 2017-03-26 2017-06-20 天津大学 基于部分反馈线性化四旋翼无人机吊挂飞行控制方法
CN106970635A (zh) * 2017-05-17 2017-07-21 西北工业大学 一种拖曳变轨中利用拖曳飞行器机动的系绳摆动抑制方法
CN108303879A (zh) * 2018-01-18 2018-07-20 西北工业大学 一种空间柔性系统的欠驱动控制方法
CN108508746A (zh) * 2018-01-30 2018-09-07 天津大学 四旋翼无人机吊挂运输系统的自适应控制方法
CN109491250A (zh) * 2018-12-11 2019-03-19 哈尔滨工业大学 一种无人机吊装运输系统吊装摆动抑制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
ZHONGJIE MENG 等: "Underactuated Control of Swing in Orbit Debris Towing Removal via Tether Space Robots", 《INTERNATIONAL CONFERENCE ON ROBOTICS AND BIOMIMETICS》 *
鲜斌 等: "无人机吊挂飞行的非线性控制方法设计", 《控制理论与应用》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110579969A (zh) * 2019-10-23 2019-12-17 南开大学 一种用于双无人机协同吊运棒状刚体负载的控制方法
CN110579969B (zh) * 2019-10-23 2022-09-30 南开大学 一种用于双无人机协同吊运棒状刚体负载的控制方法
CN111190430A (zh) * 2020-01-15 2020-05-22 西北工业大学 一种利用系绳旋翼协调的无人机吊挂负载控制方法
CN111190430B (zh) * 2020-01-15 2022-07-05 西北工业大学 一种利用系绳旋翼协调的无人机吊挂负载控制方法

Also Published As

Publication number Publication date
CN110221543B (zh) 2021-06-15

Similar Documents

Publication Publication Date Title
US11834174B2 (en) Control of drone-load system method, system, and apparatus
CN111190430B (zh) 一种利用系绳旋翼协调的无人机吊挂负载控制方法
Chen et al. Composite control of stratospheric airships with moving masses
Das et al. Dynamic inversion with zero-dynamics stabilisation for quadrotor control
Gimenez et al. Multi-objective control for cooperative payload transport with rotorcraft UAVs
Sydney et al. Dynamic control of autonomous quadrotor flight in an estimated wind field
Zuo et al. Three-dimensional path-following backstepping control for an underactuated stratospheric airship
Miyazaki et al. Airborne docking for multi-rotor aerial manipulations
Schatz et al. Modular trajectory/path following controller using nonlinear error dynamics
Hançer et al. Robust hovering control of a quad tilt-wing UAV
Mohammadi et al. Passivity-based control of multiple quadrotors carrying a cable-suspended payload
Geng et al. Implementation and demonstration of coordinated transport of a slung load by a team of rotorcraft
CN110221543B (zh) 一种利用系绳/推力协调的无人机吊挂系统摆动抑制方法
Li et al. Coordinated transport of a slung load by a team of autonomous rotorcraft
Zheng et al. Hovering control for a stratospheric airship in unknown wind
Mu et al. Integral sliding mode control for a quadrotor in the presence of model uncertainties and external disturbances
Walid et al. Modeling and control of a quadrotor UAV
Chen et al. Adaptive path following control of a stratospheric airship with full-state constraint and actuator saturation
Wang et al. ADRC methodology for a quadrotor UAV transporting hanged payload
Emran et al. Adaptive neural network control of quadrotor system under the presence of actuator constraints
Tsay Guidance and control laws for quadrotor UAV
Lee et al. Study on payload stabilization method with the slung-load transportation system using a quad-rotor
Omar et al. Integrating anti-swing controller with px4 autopilot for quadrotor with suspended load
CN114967724A (zh) 一种四旋翼无人机目标环绕抗干扰控制方法
CN111158240B (zh) 一种空中快速偏航抓捕器的位姿滑模控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant