CN107992084B - 不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 - Google Patents
不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 Download PDFInfo
- Publication number
- CN107992084B CN107992084B CN201711455527.3A CN201711455527A CN107992084B CN 107992084 B CN107992084 B CN 107992084B CN 201711455527 A CN201711455527 A CN 201711455527A CN 107992084 B CN107992084 B CN 107992084B
- Authority
- CN
- China
- Prior art keywords
- control signal
- attitude
- angle
- unmanned aerial
- aerial vehicle
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 70
- 238000005096 rolling process Methods 0.000 claims abstract description 11
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 claims description 3
- 230000008878 coupling Effects 0.000 abstract description 9
- 238000010168 coupling process Methods 0.000 abstract description 9
- 238000005859 coupling reaction Methods 0.000 abstract description 9
- 230000008569 process Effects 0.000 abstract description 9
- 238000010586 diagram Methods 0.000 description 21
- 230000004044 response Effects 0.000 description 9
- 230000000694 effects Effects 0.000 description 4
- 238000002474 experimental method Methods 0.000 description 4
- 239000011159 matrix material Substances 0.000 description 4
- 230000001419 dependent effect Effects 0.000 description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000005312 nonlinear dynamic Methods 0.000 description 2
- 230000036544 posture Effects 0.000 description 2
- 241000764238 Isis Species 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种不依靠角速度反馈的无人机鲁棒姿态控制方法和装置;其中,该方法包括:采集无人机的动力***输出的姿态角,计算姿态角与期望参考量之间的姿态角误差;根据姿态角误差和标称控制信号,生成姿态角速度误差的估计值;姿态角包括滚动角、俯仰角或偏航角;根据估计值,更新标称控制信号;根据姿态角误差和当前的最终控制信号,生成鲁棒补偿控制信号;根据更新后的标称控制信号和鲁棒补偿控制信号,更新最终控制信号;根据更新后的最终控制信号,控制无人机执行姿态角对应的姿态。本发明可以抑制无人机飞行过程中非线性、耦合和外部时变干扰等多种不确定性的影响,提高无人机姿态控制的精度及鲁棒性。
Description
技术领域
本发明涉及自动控制领域技术领域,尤其是涉及一种不依靠角速度反馈的无人机鲁棒姿态控制方法和装置。
背景技术
目前,无人飞行机,尤其是四旋翼无人机,广泛地应用于侦察监视、交通监管和航空拍摄等领域,具有重要的应用价值和广阔的应用前景。现有的无人飞行机具备完成各式各样任务的能力,特别是在城市环境中,无人机与固定翼飞机相比,具有悬停和垂直起降的优势。尤其是四旋翼无人机,因其不需要尾翼或复杂的机械控制联动装置来改变空气动力和力矩,在城市环境中越来越多被运用。
为了使无人机准确可靠地完成各种任务,需要对其飞行姿态进行跟踪控制;现有的姿态控制方式中,可以通过基于四元数的反馈姿态控制器、开关模型预测控制器、指令滤波控制器等对无人机的姿态进行控制,通过滑模观测器等对无人机在飞行过程中可能出现的不确定性因素进行估计;但是,这种控制方式难以有效抑制这些不确定性因素,导致对无人机姿态控制的精度和鲁棒性较差。
发明内容
本发明的目的在于提供一种不依靠角速度反馈的无人机鲁棒姿态控制方法、装置和四旋翼无人机,以抑制无人机飞行过程中非线性、耦合和外部时变干扰等多种不确定性的影响,提高无人机姿态控制的精度及鲁棒性。
第一方面,本发明实施例提供了一种不依靠角速度反馈的无人机鲁棒姿态控制方法,应用于四旋翼无人机的处理器,此方法包括以下步骤:采集无人机的动力***输出的姿态角,计算姿态角与期望参考量之间的姿态角误差;根据姿态角误差和标称控制信号,生成姿态角速度误差的估计值;姿态角包括滚动角、俯仰角或偏航角;根据估计值,更新标称控制信号;根据姿态角误差和当前的最终控制信号,生成鲁棒补偿控制信号;根据更新后的标称控制信号和鲁棒补偿控制信号,更新最终控制信号;根据更新后的最终控制信号,控制无人机执行姿态角对应的姿态。
其中,li(i=φ,θ,ψ)为预设的正参数;φ为滚动角;θ为俯仰角;ψ为偏航角;为ai的标称参数;ai=ai1lmckω(i=φ);ai=ai1lmckω(i=θ);ai=ai1kfmkω(i=ψ);ai1为正参数;lmc为四旋翼无人机的质心和电机之间的距离,kfm为力-力矩比例因子,为正常数;kω为正常数;为标称控制信号;所述姿态角误差ei1=i-ri;ri为姿态角的期望的参考量;计算估计值的误差其中,
其中,ki1和ki2(i=φ,θ,ψ)为预设的正常数。
结合第一方面的第三种可能的实施方式,本发明实施例提供了第一方面的第四种可能的实施方式。根据更新后的标称控制信号和鲁棒补偿控制信号,更新最终控制信号的步骤,包括:通过下述公式,计算最终控制信号ui:
结合第一方面的第四种可能的实施方式,本发明实施例提供了第一方面的第五种可能的实施方式。根据更新后的最终控制信号,控制无人机执行姿态角对应的姿态的步骤,包括:通过下述公式,计算无人机四个旋翼的转速:
结合第一方面,本发明实施例提供了第一方面的第六种可能的实施方式,其中,根据更新后的最终控制信号,控制无人机执行姿态角对应的姿态的步骤,包括:当姿态角为滚动角时,根据更新后的最终控制信号控制无人机左旋翼和右旋翼的转速,以实现滚转运动;当姿态角为俯仰角时,根据更新后的最终控制信号控制无人机前旋翼和后旋翼的转速,以实现俯仰运动;当姿态角为偏航角时,根据更新后的最终控制信号控制无人机前旋翼、后旋翼、左旋翼和右旋翼的转速,以实现偏航运动。
第二方面,本发明实施例还提供一种不依靠角速度反馈的无人机鲁棒姿态控制装置,此装置设置于四旋翼无人机的处理器,包括:误差采集模块,用于采集无人机的动力***输出的姿态角,计算姿态角与期望参考量之间的姿态角误差;估计值生成模块,用于根据姿态角误差和标称控制信号,生成姿态角速度误差的估计值;姿态角包括滚动角、俯仰角或偏航角;标称控制信号更新模块,用于根据估计值,更新标称控制信号;鲁棒补偿控制信号生成模块,用于根据姿态角误差和当前的最终控制信号,生成鲁棒补偿控制信号;最终控制信号更新模块,用于根据更新后的标称控制信号和鲁棒补偿控制信号,更新最终控制信号;控制模块,用于根据更新后的最终控制信号,控制无人机执行姿态角对应的姿态。
其中,li(i=φ,θ,ψ)为预设的正参数;φ为滚动角;θ为俯仰角;ψ为偏航角;为ai的标称参数;ai=ai1lmckω(i=φ);ai=ai1lmckω(i=θ);ai=ai1kfmkω(i=ψ);ai1为正参数;lmc为四旋翼无人机的质心和电机之间的距离,kfm为力-力矩比例因子,为正常数;kω为正常数;为标称控制信号;姿态角误差ei1=i-ri;ri为姿态角的期望的参考量;计算估计值的误差其中,
第三方面,本发明实施例提供了一种四旋翼无人机,该无人机包括处理器和传感器,上述不依靠角速度反馈的无人机鲁棒姿态控制装置设置于处理器中。
本发明实施例提供的一种不依靠角速度反馈的无人机鲁棒姿态控制方法、装置和四旋翼无人机,根据姿态角误差和标称控制信号,可以生成姿态角速度误差的估计值,进而更新标称控制信号;根据姿态角误差和当前的最终控制信号,可以生成鲁棒补偿控制信号;根据更新后的标称控制信号和鲁棒补偿控制信号,可以更新最终控制信号,进而控制无人机执行姿态角对应的姿态;该方式中,通过姿态角误差估计姿态角速度误差,不依赖于姿态角速度的测量值,并通过鲁棒补偿控制信号进一步抑制无人机飞行过程中非线性、耦合和外部时变干扰等多种不确定性的影响,提高了无人机姿态控制的精度及鲁棒性。
本发明的其他特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。
为使本发明的上述目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附附图,作详细说明如下。
附图说明
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种不依靠角速度反馈的无人机鲁棒姿态控制方法的流程图;
图2为本发明实施例提供的一种四旋翼飞行器的结构示意图;
图3为本发明实施例提供的一种鲁棒闭环控制***的结构示意图;
图4为本发明实施例提供的一种不依靠角速度反馈的无人机鲁棒姿态控制方法的实验装置结构示意图;
图5为本发明实施例提供的一种无人机悬停任务中,无人机姿态控制方法的响应图;
图6为本发明实施例提供的另一种无人机悬停任务中,无人机姿态控制方法的响应图;
图7为本发明实施例提供的无人机悬停任务中,各姿态角的控制输入示意图;
图8为本发明实施例提供的一种无人机轨迹跟踪任务中,无人机姿态控制方法的响应图;
图9为本发明实施例提供的另一种无人机轨迹跟踪任务中,无人机姿态控制方法的响应图;
图10为本发明实施例提供的无人机轨迹跟踪任务中,各姿态角的控制输入示意图;
图11为本发明实施例提供的给定不同鲁棒控制器参数下,无人机跟踪误差的对比示意图;
图12为本发明实施例提供的一种不依靠角速度反馈的无人机鲁棒姿态控制装置的结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为了使四旋翼无人机稳定飞行,无人机的姿态控制是基本的控制内容;四旋翼无人机的姿态运动具有强耦合、多变量、非线性、不确定等特点,导致对四旋翼无人机的飞行姿态难以实现高精度,高鲁棒性的控制。基于此,本发明提供了一种不依靠角速度反馈的无人机鲁棒姿态控制方法、装置和四旋翼无人机;该技术可以应用于四旋翼无人机的姿态控制中,还可以应用于其他飞行器的姿态控制中;该技术可以采用相关的软件或硬件实现,下面通过实施例进行描述。
为便于对本实施例进行理解,首先对本发明实施例所公开的一种无人飞行器姿态控制方法进行详细介绍。
参见图1所示的一种不依靠角速度反馈的无人机鲁棒姿态控制方法的流程图;该方法应用于四旋翼无人机的处理器;该方法包括如下步骤:
步骤S100,采集无人机的动力***输出的姿态角,计算姿态角与期望参考量之间的姿态角误差;
步骤S102,根据姿态角误差和标称控制信号,生成姿态角速度误差的估计值;该姿态角包括滚动角、俯仰角或偏航角。
上述步骤S102具体可以通过下述方式实现:
其中,li(i=φ,θ,ψ)为预设的正参数;φ为滚动角;θ为俯仰角;ψ为偏航角;为ai的标称参数;ai=ai1lmckω(i=φ);ai=ai1lmckω(i=θ);ai=ai1kfmkω(i=ψ);ai1为正参数;lmc为四旋翼无人机的质心和电机之间的距离,kfm为力-力矩比例因子,为正常数;kω为正常数;为标称控制信号;姿态角误差ei1=i-ri;ri为所述姿态角的期望的参考量;
步骤S104,根据上述估计值,更新标称控制信号;
其中,ki1和ki2(i=φ,θ,ψ)为预设的正常数。
步骤S106,根据姿态角误差和当前的最终控制信号,生成鲁棒补偿控制信号;
步骤S108,根据更新后的标称控制信号和鲁棒补偿控制信号,更新最终控制信号;
具体可以通过下述公式,计算所述最终控制信号ui:
步骤S110,根据更新后的最终控制信号,控制无人机执行姿态角对应的姿态。
该步骤S110,具体可以通过下述方式实现:
步骤(1),通过下述公式,计算无人机四个旋翼的转速:
步骤(2),控制无人机四个旋翼按照对应的转速进行旋转,以使无人机执行姿态角对应的姿态。
上述ug为预设的正常数,用于抵消飞行器的重力;将ui(i=φ,θ,ψ,g)分配到四个旋翼,可以实现飞行机的姿态控制。
本发明实施例提供的一种不依靠角速度反馈的无人机鲁棒姿态控制方法,根据姿态角误差和标称控制信号,可以生成姿态角速度误差的估计值,进而更新标称控制信号;根据姿态角误差和当前的最终控制信号,可以生成鲁棒补偿控制信号;根据更新后的标称控制信号和鲁棒补偿控制信号,可以更新最终控制信号,进而控制无人机执行姿态角对应的姿态;该方式中,通过姿态角误差估计姿态角速度误差,不依赖于姿态角速度的测量值,并通过鲁棒补偿控制信号进一步抑制无人机飞行过程中非线性、耦合和外部时变干扰等多种不确定性的影响,提高了无人机姿态控制的精度及鲁棒性。
本发明实施例还提供了另一种不依靠角速度反馈的无人机鲁棒姿态控制;该方法可以通过设置在微型四旋翼无人机上的鲁棒姿态控制器实现;该方法首先简化三个姿态角,得到无人机的线性动力学模型,把非线性动力学、轴间耦合、参数扰动和外部扰动等定义为不确定因素。对每个通道(包括滚动角通道、俯仰角通道或偏航角通道),设计了线性时不变鲁棒控制器,该控制器由线性降阶观测器,标称PD控制器和鲁棒补偿器组成。该方法应用线性降阶观测器来估计角速度,然后基于角速度的估计值,应用标称PD控制器实现对于每个角度的标称闭环***的期望跟踪,同时通过二阶鲁棒滤波器构建鲁棒补偿器,以抑制上述不确定因素对姿态跟踪的影响。
该实施例中,首先建立四旋翼飞行器(相当于上述四旋翼无人机)的线性动力学模型,具体步骤如下:
参见图2所示的一种四旋翼飞行器的结构示意图;该四旋翼飞行器具有三个姿态角:滚动角φ,俯仰角θ和偏航角ψ,该飞行器还包括一个刚性十字架和四个旋翼,前后旋翼逆时针旋转,左右旋翼顺时针旋转。按照前左后右的顺序,推力分别被表示为fi(i=1,2,3,4),可以通过以下表达式计算获得推力:i=1,2,3,4;
其中,kω是正常数,ωi(i=1,2,3,4)分别表示四个旋翼的转速。通过改变旋翼的转速,产生不同推力和扭矩,可以实现各种运动。实现俯仰运动,则可以减小(增加)后旋翼的转速并增加(减小)前旋翼的转速。实现滚转运动,可以用类似的方式改变左右旋翼的转速。实现偏航运动,可利用前后旋翼产生的反作用扭矩与左右旋翼之间的差值来实现。
三个姿态角的非线性动力学可以通过以下等式来描述:
其中,ai1(i=φ,θ,ψ)是正参数,是包括离心力矩和陀螺力矩的科里奥利项,η=[φ θ ψ]T分别滚动角,俯仰角以及偏航角,wi(i=φ,θ,ψ)是外部干扰;扭矩τi(i=φ,θ,ψ)可以通过以下等式获得:
其中,lmc是四旋翼飞行器的质心和电机之间的距离,kfm是的力-力矩比例因子,为正常数。
四旋翼飞行器的输出是三个角度,定义与τi(i=φ,θ,ψ)成比例的控制输入ui(i=φ,θ,ψ)如下:
令设置ug其为正常数,以抵消四旋翼飞行器的重力。使用无人机的配电板将ui(i=φ,θ,ψ,g)分配到四个旋翼。由于驱动器动力学相对较快,在实现时驱动器的耗时可以忽略。令aφ=aφ1lmckω,aθ=aθ1lmckω和aψ=aψ1kfmkω。由(1)描述的四旋翼模型可改写为
该实施例基于如下两个假设实现:
四旋翼飞行器的线性动力学模型建立完成后,需要建立鲁棒控制器,以完成上述图1中所示的方法;该鲁棒控制器的建立具体步骤如下:
首先设置低阶观测器,用来估计ei2(i=φ,θ,ψ),忽略不确定度qi(i=φ,θ,ψ);其次,基于角速度的估计值,为标称闭环控制***设计标称PD控制器以实现期望的跟踪性能;最后,引入了鲁棒滤波器构建的鲁棒补偿器来抑制各种不确定性的影响。
本实施例中三个角度(滚动角、俯仰角和偏航角)鲁棒控制器,需要满足:对于给定的正常数和给定的初始误差ei(0)(i=φ,θ,ψ),存在有限的正常数T*,使得ei(i=φ,θ,ψ)有界并满足|ei(t)|≤ε,
具体地,首先通过忽略等效扰动qi(i=φ,θ,ψ)来设计降阶观测器和标称PD控制器。考虑以下三种姿态角度的标称***
其中,li(i=φ,θ,ψ)是要确定的正参数。此外,将标称PD控制器的标称PD反馈控制律设计为
从(7)和(8)可以得到
结合(9)和(10),可以得到
其中,
如果通过忽略等效扰动qi(i=φ,θ,ψ)和鲁棒补偿输入上述公式(12)可以是三个姿态通道的标称闭环控制***。该标称闭环控制***是去耦合的,控制器参数可以单独确定。对于每个通道,选择正参数ki1,ki2和li(i=φ,θ,ψ),使得是Hurwitz矩阵。
其中,s是拉普拉斯算子,gi(i=φ,θ,ψ)是要确定的鲁棒滤波器参数。鲁棒滤波器具有以下性质:如果gi(i=φ,θ,ψ)足够大,则Fi(s)(i=φ,θ,ψ)将具有足够宽的频率带宽并满足|Fi(s)|≈1。因此,设计鲁棒的补偿输入如下:
由于等效扰动qi(i=φ,θ,ψ)不能直接测量,所以从(4)可以看出
参见图3所示的一种鲁棒闭环控制***的结构示意图;从图3可以看出,提出的鲁棒控制器在角度之间解耦。整个姿态闭环控制***可以分为三个子***:滚动子***,俯仰子***和偏航子***。每个子***的鲁棒控制器可以单独设计。此外,对于每个子***,该解耦控制方法产生线性时不变控制器,其在实际应用中容易实现。
本发明实施例提供的一种不依靠角速度反馈的无人机鲁棒姿态控制方法,由不依靠于角速度反馈的无人飞行器鲁棒姿态控制器实现,该控制器主要包括线性降阶观测器,标称PD控制器和鲁棒补偿器三个部分;该方法可以抑制参数不确定性,非线性,耦合和外部时变干扰等各种不确定性的影响;该方法中的姿态跟踪误差被证明是最终有界的,并且可以根据需要使边界变小;此外,所提出的控制器是输出控制器,其独立于角速度测量。
上述该方法中,所使用的的鲁棒姿态控制器是线性时间不变的,并且在角度之间去耦,这在实际应用中容易实现;对于每个通道,可以分别确定控制器参数:可以在悬停状态下根据规定的性能要求调整额定控制器和观测器的参数;可以在大角度参考跟踪任务中单向在线调整鲁棒补偿器参数。
为了从理论层面说明上述无人机姿态控制方法的鲁棒性,本发明实施例对上述方法的鲁棒性能进行了分析,具体分析过程如下:
本实施例中,将分析由四旋翼姿态模型(上述公式(1)),观测器(上述公式(7)),标称控制器(上述公式(8))和鲁棒补偿器(上述公式(15))组成的闭环控制***的鲁棒特性。
定义
其中,In×n为n×n单位矩阵;然后从(12)和(13)可以得到
引理1:如果gi(i=φ,θ,ψ)足够大,则存在正常常数αi(i=φ,θ,ψ),使得
该引理1的证明过程如下:
定义diH(s)(i=φ,θ,ψ)为
其中,si1和si2为常数;定义ψi(s)=[ψi,jk(s)]3×3(i=φ,θ,ψ)为
可以得到矩阵ψi(s)(i=φ,θ,ψ)的元素具有以下形式
其中ψi2,jk和ψi3,jk(i=φ,θ,ψ)为相应的常数。然后,存在正常数αi1(i=φ,θ,ψ)满足
之后,可以得到
其中,
如果gi(i=φ,θ,ψ)有充分大的正值使得ηg2i≤2,ηgi≤2,以及ηli≤1(i=φ,θ,ψ),可以得到
根据上式,引理1得证。
该定理1的证明过程如下:
通过上述公式(5),公式(8)和公式(13),可以得到正常数λuei和λuci(i=φ,θ,ψ)使得
由于0≤ρi<1(i=φ,θ,ψ),然后将公式(20)带入公式(19),可以得到
其中,
在这种情况下其满足
由公式(18),可以得到
如果gmin足够大并满足
其满足
便能得到公式(28)。
由公式(12)可以得到
其中
联立公式(13),公式(25)和公式(31)可以得到
因此,对于给定的正常数ε和给定的初始状态存在满足公式(29)和公式(30)的正常数T*和足够大的参数gmin,zi2(i=φ,θ,ψ)则是有界的并且从公式(15)可以看出,zi1和zi2(i=φ,θ,ψ)是有界的。因此,涉及的所有状态都是有界的,定理1是有限的,定理1得证。
为了从实验层面说明上述无人机姿态控制方法的鲁棒性,本发明实施例对上述方法的鲁棒性能进行实验,并对实验结果进行了分析,具体过程如下:
参见图4所示的一种不依靠角速度反馈的无人机鲁棒姿态控制方法的实验装置结构示意图;该实验中使用的四旋翼飞行器是基于X-aircraft X650机械框架开发的,其机载航空电子组件主要包括飞行控制计算机和传感器***。使用TMS320F28335DSP作为飞行控制计算机。传感器***由3轴线性加速度计,3个陀螺仪和罗盘组成。采用一对ZigBee无线模块将姿态数据传送到地面站。姿态循环以500Hz更新,也是数据采集和数据融合的更新速率。四旋翼的标称参数为和
首先,介绍如何在实际应用中确定鲁棒控制器参数的***方法,相应的实验结果也将显示出提出的鲁棒姿态控制方法的有效性。
步骤1:确定悬停任务中的标称PD控制器和降阶观测器参数。
理论上,对于不确定的四旋转角度的姿态控制问题,应选择每个通道的正参数ki1,ki2和li(i=φ,θ,ψ),使得为Hurwitz矩阵。在实际应用中,这些参数可以根据指定性能要求通过试验和错误的悬停任务。在任务中,三个姿态角接近0度,因此非线性和耦合对闭环控制***的影响很小。在这种情况下,等效扰动qi(i=φ,θ,ψ)的影响也很小,因此可以通过忽略qi(i=φ,θ,ψ)根据闭环控制***的响应来调整标称控制器参数。实际上,由于不确定性的影响很小,所以可以分别应用极点配置方法来确定标称闭环子***的所需极点。由于三个标称子***是去耦和线性的,所以通过这种方法很容易设置标称控制器和观测器参数。
实验中,将标称PD控制器和降阶观测器参数设置为:kφ1=4,kφ2=3,lφ=50,kθ1=4,kθ2=3,lθ=50,kψ1=0.5,kψ2=0.2,和lψ=50。参见图5所示的一种无人机悬停任务中,无人机姿态控制方法的响应图;该图5中,在没有鲁棒补偿器进行补偿的情况下,对于滚动,俯仰和偏航角,稳态误差分别约为2.5°,2°和0.2°。虽然三通道存在稳态误差,但盘旋的表现仍然令人满意。
然后,添加鲁棒补偿器来抑制不确定性的影响。选择鲁棒补偿器参数gi(i=φ,θ,ψ)具有某些特定值:gi=3(i=φ,θ,ψ)。参见图6所示的另一种无人机悬停任务中,无人机姿态控制方法的响应图;该图6中,通过添加鲁棒补偿器来抑制不确定性的影响,稳态误差分别对于滚动,俯仰和偏航角分别约为0.2°,0.5°和0.05°。可以观察到稳态跟踪性能得到改善。图7为无人机悬停任务中,各姿态角的控制输入示意图。
步骤2:确定大角度参考跟踪任务中的鲁棒补偿器参数。
在这个步骤中,需要四旋翼在耦合条件下跟踪大角度参考信号,因此不能忽略等效干扰qi(i=φ,θ,ψ)的影响。三个姿态角不接近0°,因此非线性和耦合动力学,特别是科里奥利项将严重影响闭环控制***。因此,引入了鲁棒补偿器来减少其影响。理论上,如定理1所示,需要鲁棒补偿器参数gi(i=φ,θ,ψ)来满足在实际应用中,gi(i=φ,θ,ψ)可以单向在线调整,也就是将其设置为一些初始值并运行闭环控制***;如果***性能不够满意,则将gi(i=φ,θ,ψ)设置为更大的值,直到获得令人满意的性能。在此步骤中,选择鲁棒补偿器参数值gi=3(i=φ,θ,ψ)。参见图8所示的一种无人机轨迹跟踪任务中,无人机姿态控制方法的响应图和图9所示的另一种无人机轨迹跟踪任务中,无人机姿态控制方法的响应图;没有鲁棒补偿器的两个相互作用通道的实验结果如图8所示,添加了鲁棒补偿器的实验结果则如图9所示。从这图像可以看出,四旋翼的闭环***在各种不确定性的影响下,通过加入鲁棒补偿器,改进了动态和稳态跟踪性能。图10为无人机轨迹跟踪任务中,各姿态角的控制输入示意图。
实际上,如果将gi(i=φ,θ,ψ)设置为较大的值,则鲁棒滤波器具有更宽的频率带宽,因此将更接近于这种情况下,可以减少更多闭环***等效干扰qi(i=φ,θ,ψ)的影响。因此,应用在线单向调谐方法来确定鲁棒补偿器参数。参见图11所示的给定不同鲁棒控制器参数下,无人机跟踪误差的对比示意图;从图11可以看出,与gi=1(i=φ,θ,ψ)时闭环***的跟踪误差相比,gi=3(i=φ,θ,ψ)时跟踪误差更小,特别是对于滚动角而言。
本发明实施例提供的一种不依靠角速度反馈的无人机鲁棒姿态控制方法,通过鲁棒去耦控制器来解决不依赖角速度反馈的姿态控制问题。该方式中,对于每个姿态角度,设计的控制器由线性降阶观测器,标称控制器和鲁棒补偿器组成。应用观测器来估计角速度,引入鲁棒补偿器来抑制不确定性的影响。已经证明,角速度和角误差的估计误差可以在有限时间内收敛到给定的原点邻域。上述实验结果证明了该方法的有效性。
对应于上述方法实施例,参见图12所示的一种不依靠角速度反馈的无人机鲁棒姿态控制装置的结构示意图;该装置包括:
误差采集模块120,用于采集无人机的动力***输出的姿态角,计算姿态角与期望参考量之间的姿态角误差;
估计值生成模块122,用于根据姿态角误差和标称控制信号,生成姿态角速度误差的估计值;姿态角包括滚动角、俯仰角或偏航角;
标称控制信号更新模块124,用于根据估计值,更新标称控制信号;
鲁棒补偿控制信号生成模块126,用于根据姿态角误差和当前的最终控制信号,生成鲁棒补偿控制信号;
最终控制信号更新模块128,用于根据更新后的标称控制信号和鲁棒补偿控制信号,更新最终控制信号;
控制模块130,用于根据更新后的最终控制信号,控制无人机执行所述姿态角对应的姿态。
其中,li(i=φ,θ,ψ)为预设的正参数;φ为滚动角;θ为俯仰角;ψ为偏航角;为ai的标称参数;ai=ai1lmckω(i=φ);ai=ai1lmckω(i=θ);ai=ai1kfmkω(i=ψ);ai1为正参数;lmc为四旋翼无人机的质心和电机之间的距离,kfm为力-力矩比例因子,为正常数;kω为正常数;为标称控制信号;姿态角误差ei1=i-ri;ri为所述姿态角的期望的参考量;
本发明实施例还提供了一种四旋翼无人机,该无人机包括处理器和传感器;上述不依靠角速度反馈的无人机鲁棒姿态控制装置设置于处理器中。
最后应说明的是:以上所述实施例,仅为本发明的具体实施方式,用以说明本发明的技术方案,而非对其限制,本发明的保护范围并不局限于此,尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,其依然可以对前述实施例所记载的技术方案进行修改或可轻易想到变化,或者对其中部分技术特征进行等同替换;而这些修改、变化或者替换,并不使相应技术方案的本质脱离本发明实施例技术方案的精神和范围,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应所述以权利要求的保护范围为准。
Claims (8)
1.一种不依靠角速度反馈的无人机鲁棒姿态控制方法,其特征在于,所述方法应用于四旋翼无人机的处理器;所述方法包括:
采集所述无人机的动力***输出的姿态角,计算所述姿态角与期望参考量之间的姿态角误差;
根据所述姿态角误差和标称控制信号,生成姿态角速度误差的估计值;所述姿态角包括滚动角、俯仰角或偏航角;
根据所述估计值,更新所述标称控制信号;
根据所述姿态角误差和当前的最终控制信号,生成鲁棒补偿控制信号;
根据更新后的标称控制信号和所述鲁棒补偿控制信号,更新所述最终控制信号;
根据更新后的最终控制信号,控制所述无人机执行所述姿态角对应的姿态;
所述根据所述姿态角误差和标称控制信号,生成姿态角速度误差的估计值的步骤,包括:
其中,i=φ,θ,ψ;φ为滚动角;θ为俯仰角;ψ为偏航角;li为预设的正参数;为ai的标称参数;aφ=aφ1lmckω;aθ=aθ1lmckω;aψ=aψ1kfmkω;ai1为正参数;lmc为四旋翼无人机的质心和电机之间的距离,kfm为力-力矩比例因子,为正常数;kω为正常数;为标称控制信号;所述姿态角误差ei1=i-ri;ri为所述姿态角的期望参考量;zei为所述线性降阶观测器的状态;
6.根据权利要求1所述的方法,其特征在于,所述根据更新后的最终控制信号,控制所述无人机执行所述姿态角对应的姿态的步骤,包括:
当所述姿态角为滚动角时,根据更新后的最终控制信号控制所述无人机左旋翼和右旋翼的转速,以实现滚转运动;
当所述姿态角为俯仰角时,根据更新后的最终控制信号控制所述无人机前旋翼和后旋翼的转速,以实现俯仰运动;
当所述姿态角为偏航角时,根据更新后的最终控制信号控制所述无人机前旋翼、后旋翼、左旋翼和右旋翼的转速,以实现偏航运动。
7.一种不依靠角速度反馈的无人机鲁棒姿态控制装置,其特征在于,所述装置设置于四旋翼无人机的处理器;所述装置包括:
误差采集模块,用于采集所述无人机的动力***输出的姿态角,计算所述姿态角与期望参考量之间的姿态角误差;
估计值生成模块,用于根据所述姿态角误差和标称控制信号,生成所述姿态角速度误差的估计值;所述姿态角包括滚动角、俯仰角或偏航角;
标称控制信号更新模块,用于根据所述估计值,更新所述标称控制信号;
鲁棒补偿控制信号生成模块,用于根据所述姿态角误差和当前的最终控制信号,生成鲁棒补偿控制信号;
最终控制信号更新模块,用于根据更新后的标称控制信号和所述鲁棒补偿控制信号,更新所述最终控制信号;
控制模块,用于根据更新后的最终控制信号,控制所述无人机执行所述姿态角对应的姿态;
所述估计值生成模块,还用于:
其中,i=φ,θ,ψ;φ为滚动角;θ为俯仰角;ψ为偏航角;li为预设的正参数;为ai的标称参数;aφ=aφ1lmckω;aθ=aθ1lmckω;aψ=aψ1kfmkω;ai1为正参数;lmc为四旋翼无人机的质心和电机之间的距离,kfm为力-力矩比例因子,为正常数;kω为正常数;为标称控制信号;所述姿态角误差ei1=i-ri;ri为所述姿态角的期望参考量;zei为所述线性降阶观测器的状态;
8.一种四旋翼无人机,其特征在于,所述无人机包括处理器和传感器;权利要求7所述的装置设置于所述处理器中。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711455527.3A CN107992084B (zh) | 2017-12-27 | 2017-12-27 | 不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711455527.3A CN107992084B (zh) | 2017-12-27 | 2017-12-27 | 不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107992084A CN107992084A (zh) | 2018-05-04 |
CN107992084B true CN107992084B (zh) | 2020-03-24 |
Family
ID=62042431
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711455527.3A Active CN107992084B (zh) | 2017-12-27 | 2017-12-27 | 不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107992084B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108919835B (zh) * | 2018-09-25 | 2021-02-02 | 北京航空航天大学 | 无人飞行器编队的控制方法、装置及控制器 |
CN110618694B (zh) * | 2019-09-10 | 2022-08-12 | 北方信息控制研究院集团有限公司 | 一种空间***鲁棒姿态控制方法 |
CN110928324B (zh) * | 2019-12-30 | 2023-07-14 | 北京润科通用技术有限公司 | 无人机飞行参数采集设备及其校准方法 |
CN112015196B (zh) * | 2020-10-21 | 2021-11-16 | 蓝箭航天空间科技股份有限公司 | 一种姿控***限幅值设计方法、存储介质及服务器 |
CN113608541B (zh) * | 2021-08-06 | 2023-05-23 | 中国科学院声学研究所 | 一种水下航行器姿态控制方法和*** |
CN116954267B (zh) * | 2023-09-21 | 2023-12-08 | 北京航空航天大学 | 一种不依靠速度反馈的无人机编队鲁棒控制方法及*** |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103365296B (zh) * | 2013-06-29 | 2015-12-09 | 天津大学 | 一种四旋翼无人飞行器非线性输出反馈飞行控制方法 |
CN104035447A (zh) * | 2014-06-27 | 2014-09-10 | 金陵科技学院 | 基于动态控制重新分配的无人飞行器姿态容错控制方法 |
CN104483977B (zh) * | 2014-10-11 | 2016-11-30 | 国家电网公司 | 一种舵机云台的无速度反馈动态面控制方法及控制器 |
US9715234B2 (en) * | 2015-11-30 | 2017-07-25 | Metal Industries Research & Development Centre | Multiple rotors aircraft and control method |
CN106527137B (zh) * | 2016-11-25 | 2019-08-16 | 天津大学 | 基于观测器的四旋翼无人机容错控制方法 |
CN107479567B (zh) * | 2017-09-13 | 2018-10-30 | 山东大学 | 动态特性未知的四旋翼无人机姿态控制器及方法 |
-
2017
- 2017-12-27 CN CN201711455527.3A patent/CN107992084B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107992084A (zh) | 2018-05-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107992084B (zh) | 不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 | |
Cabecinhas et al. | A nonlinear quadrotor trajectory tracking controller with disturbance rejection | |
Tal et al. | Accurate tracking of aggressive quadrotor trajectories using incremental nonlinear dynamic inversion and differential flatness | |
Liu et al. | Robust attitude controller design for miniature quadrotors | |
Xu et al. | Adaptive neural network finite time control for quadrotor UAV with unknown input saturation | |
CN106249745B (zh) | 四轴无人机的控制方法 | |
CN105911866B (zh) | 四旋翼无人飞行器的有限时间全阶滑模控制方法 | |
Liu et al. | Robust control for quadrotors with multiple time-varying uncertainties and delays | |
Wu et al. | Modeling and sliding mode-based attitude tracking control of a quadrotor UAV with time-varying mass | |
US11693373B2 (en) | Systems and methods for robust learning-based control during forward and landing flight under uncertain conditions | |
CN107479567B (zh) | 动态特性未知的四旋翼无人机姿态控制器及方法 | |
Derafa et al. | Super twisting control algorithm for the attitude tracking of a four rotors UAV | |
Tayebi et al. | Attitude stabilization of a VTOL quadrotor aircraft | |
CN107479370B (zh) | 一种基于非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN106325291B (zh) | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及*** | |
WO2019024303A1 (zh) | 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 | |
Jasim et al. | A robust controller for multi rotor UAVs | |
Omari et al. | Hardware and software architecture for nonlinear control of multirotor helicopters | |
CN111026160B (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
CN107608370A (zh) | 无人飞行器的鲁棒姿态控制方法及无人飞行器 | |
Guenard et al. | Control laws for the tele operation of an unmanned aerial vehicle known as an x4-flyer | |
Qi et al. | MUDE-based control of quadrotor for accurate attitude tracking | |
Capello et al. | Mini quadrotor UAV: design and experiment | |
CN110275542B (zh) | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 | |
CN109062242B (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 |