CN111026160A - 一种四旋翼无人机轨迹跟踪控制方法 - Google Patents
一种四旋翼无人机轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN111026160A CN111026160A CN201911367910.2A CN201911367910A CN111026160A CN 111026160 A CN111026160 A CN 111026160A CN 201911367910 A CN201911367910 A CN 201911367910A CN 111026160 A CN111026160 A CN 111026160A
- Authority
- CN
- China
- Prior art keywords
- angle
- loop
- aerial vehicle
- unmanned aerial
- control
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000001133 acceleration Effects 0.000 claims abstract description 26
- 239000011159 matrix material Substances 0.000 claims description 11
- 239000000126 substance Substances 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 12
- 238000013461 design Methods 0.000 description 8
- 230000009286 beneficial effect Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 238000009795 derivation Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000002195 synergetic effect Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 239000011541 reaction mixture Substances 0.000 description 1
- 238000004088 simulation Methods 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/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
-
- 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
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
本发明属于机器人控制领域,具体涉及一种四旋翼无人机轨迹跟踪控制方法,包括:采用位置速度控制环实时估计该环路的扰动,并基于该扰动估计量计算无人机合力控制量以及第一角度及其对应的角速度和角加速度,第一角度为横滚角度和俯仰角度,该环路扰动估计误差在固定时间内收敛到零;采用姿态角控制环实时估计该环路扰动,并基于该扰动估计量,分别计算无人机绕机体坐标系x、y、z轴转动的力矩控制量,第二角度为偏航角度,该环路扰动估计误差在固定时间内收敛到零;基于合力控制量和力矩控制量控制无人机轨迹跟踪,其中无人机的角度、角速度误差以及位置、速度误差均在固定时间内收敛到零。本发明实现对无人机在固定时间上的高精度轨迹跟踪控制。
Description
技术领域
本发明属于机器人控制领域,更具体地,涉及一种四旋翼无人机轨迹跟踪控制方法。
背景技术
随着现代控制理论和旋翼无人机技术研究的发展,旋翼无人机可以实现稳定悬停,定点起飞和降落等优良特性,旋翼无人机作为实现未来空中物流交通运输的主流发展方向,激励了大量科研人员从事旋翼无人机控制***相关课题的研究工作。
然而用于单旋翼无人机在实际应用中往往存在着控制难度高稳定性差,针对应用领域的稳定性简易性,研究人员也开始将研究对象转向四旋翼无人机***。另一方面,因存在输入变量更多,四旋翼往往比单旋翼无人机更加灵活、易于控制且稳定性更好,可以在飞行时,同时完成某些高要求任务,如航拍。因而,四旋翼无人机更符合实际应用需求。
在实际应用中,可能会要求四旋翼无人机***在固定时间完成轨迹跟踪任务,而目前主流控制方法无法实现固定时间轨迹跟踪,为满足实际应用需求,固定时间跟踪方法尤为重要。另外,同大多机械刚体结构一样,四旋翼无人机的动态特性可通过由其机械参数表示的数学模型表达,但前提是无人机的结构已知,且机械参数已知。实际上,无人机在工作过程中,受工况以及外部干扰的影响,其部分机械参数往往无法精确测得。故在对无人机进行数学建模时,通常需要考虑参数不确定性。
因此,结合以上,在任务空间中考虑扰动及模型参数不确定性的四旋翼无人机***的有限时间轨迹跟踪控制具有重要意义。
发明内容
本发明提供一种四旋翼无人机轨迹跟踪控制方法,用以解决现有四旋翼无人机轨迹跟踪控制中因在建模时机械参数无法精确获得且无法固定轨迹跟踪时间而导致在实际应用中无法实现对无人机在时间和轨迹上的高精度跟踪控制的技术问题。
本发明解决上述技术问题的技术方案如下:一种四旋翼无人机轨迹跟踪控制方法,包括:
基于期望位置及其对应的速度和加速度以及实时采集的实际位置及其对应的速度和角度,采用位置速度控制环,实时估计该环路的扰动,并基于该扰动的估计量,计算无人机的合力控制量以及参考第一角度及其对应的角速度和角加速度,其中,所述第一角度为横滚角度和俯仰角度,该环路的扰动估计误差在固定时间内收敛到零;
基于所述参考第一角度及其对应的角速度和角加速度、期望第二角度其对应的角速度和角加速度以及实际角度及其对应的角速度,采用姿态角控制环,实时估计该环路的扰动,并基于该扰动的估计量,分别计算无人机绕机体坐标系x、y、z轴转动的力矩控制量,其中,所述第二角度为偏航角度,该环路的扰动估计误差在固定时间内收敛到零;
基于所述合力控制量和所述力矩控制量,控制无人机轨迹跟踪,其中,无人机的角度、角速度误差以及位置、速度误差均在固定时间内收敛到零。
本发明的有益效果是:本方法是一种考虑扰动及模型参数不确定性的固定时间轨迹跟踪控制方法,通过控制位置速度环中的扰动估计误差以及姿态角控制环中的扰动估计误差均在固定时间内收敛到零,进而实现位置速度控制环在固定时间内使得无人机的角度、角速度误差收敛到零以及实现姿态角控制环在孤独时间内使得无人机的位置、速度误差在固定时间内收敛到零。具体实现中,可考虑四旋翼无人机模型中的动力学参数不确定性以及外部扰动,选用适当的控制参数来满足对机器人的工作速度和工作精度的要求,使得所涉及控制方法在实际应用中可实现四旋翼无人机***在固定时间完成轨迹跟踪任务,时效性好,实用性更强,实现在实际应用中对无人机在时间和轨迹上的高精度跟踪控制。
上述技术方案的基础上,本发明还可以做如下改进。
进一步,所述位置速度控制环包括用于使得该环路的扰动估计误差在第一固定时间T1内收敛到零的状态估计器,表示为:
其中,为该环路的实际扰动D1的估计量,在初始时刻t0,该环路的实际扰动量D1为零,L1为该环路的实际扰动各分量变化率的上界;ki,i=1,2,3为控制增益常数;v为无人机的实际速度矢量,vd为无人机的期望速度矢量,g为重力加速度,u1为所述合力控制量,ez表示大地坐标系下z轴的单位矢量,m为无人机质量,R∈R3×3为依次以机体坐标系的z、y、x顺序旋转的旋转矩阵,ad为无人机的期望加速度矢量;
则所述第一固定时间T1表示为:
进一步,所述合力控制量u1表示为:
其中,αi>0,βi>0,0<ni<mi,0<pi<qi,i=1,2,mi,ni,pi,qi均为正奇数;p为无人机的实际位置,pd为无人机的期望位置,ev为无人机的速度误差,S1为该环路的预设滑模面。
进一步,所述参考第一角度的计算表达式为:
其中,ψ为大地坐标系下的偏航角度。
进一步,所述位置速度控制环控制的位置和速度误差在第四固定时间T4内收敛于零,表达式为:
本发明的进一步有益效果是:本发明采用上述位置速度控制环中状态估计器和控制律进行协同作用,由第四固定时间的公式可知,只需要根据实际需要有效设置参数,即可有效实现位置和速度误差在固定时间内收敛于零,实用性强。
进一步,所述姿态角控制环节包括用于使得该环路的扰动估计误差在第二固定时间T2内收敛到零的间状态估计器表示为:
其中,为WD2的估计量,D2为该环路的实际扰动,L2为该环路的实际扰动各分量变化率的上界,在初始时刻t0,该环路的实际扰动量D2为零,W为坐标系变换矩阵,I为单位矩阵,Ω为机体坐标系下的实际角速度矢量,为在大地坐标系下的无人机的期望角速度矢量,τ'为该环的滑模控制律;ki,i=4,5,6为控制增益常数,
则所述第二固定时间T2表示为:
进一步,所述无人机绕机体坐标系x、y、z轴转动的力矩控制量分别为u2、u3、u4,表示为:[u2,u3,u4]T=τ;τ=I-1Wτ';
其中,αi>0,βi>0,0<ni<mi,0<pi<qi,i=3,4,mi,ni,pi,qi均为正奇数;Θ为在大地坐标系下的无人机的实际角度矢量,Θd为在大地坐标系下的无人机的期望角度矢量,为在大地坐标系下的无人机的期望角加速度矢量,为W的导数,S2为该环路的预设滑模面。
进一步,所述姿态角控制环控制的角度、角速度误差在第三固定时间T3内收敛于零,T3的表达式为:
本发明的进一步有益效果是:本发明采用上述姿态角控制环中状态估计器和控制律进行协同作用,由第三固定时间的公式可知,只需要根据实际需要有效设置参数,即可有效实现角度、角速度误差在固定时间内收敛于零,实用性强。
进一步,所述轨迹跟踪总的收敛时间T≤max(T1,T2)+T3+T4。
本发明的进一步有益效果是:角度、角速度误差先收敛,然后位置和速度误差再收敛,并且扰动收敛时间T1、T2与控制输入量无关,基于此,确定的轨迹跟踪总的收敛时间,精确度高,实用性强。
本发明还提供一种存储介质,所述存储介质中存储有指令,当计算机读取所述指令时,使所述计算机执行如上述任一种四旋翼无人机轨迹跟踪控制方法。
附图说明
图1为本发明实施例提供的一种四旋翼无人机轨迹跟踪控制方法的流程框图;
图2为本发明实施例提供的四旋翼无人机轨迹跟踪双环控制示意图;
图3为本发明实施例提供的四旋翼无人机模型图;
图4为本发明实施例提供的位置速度控制环的结构图;
图5为本发明实施例提供的姿态角控制环的结构图;
图6为本发明实施例提供的位置速度控制环和姿态角控制环中扰动估计量和实际扰动量之间的对比图;
图7为本发明实施例提供的任务空间中位置和姿态角的跟踪轨迹图;
图8为本发明实施例提供的无人机的控制输入量示意图;
图9为本发明实施例提供的任务空间中位置和姿态角轨迹跟踪图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
实施例一
一种四旋翼无人机轨迹跟踪控制方法100,如图1所示,包括:
步骤110、基于期望位置及其对应的速度和加速度以及实时采集的实际位置及其对应的速度和角度,采用位置速度控制环,实时估计该环路的扰动,并基于该扰动的估计量,计算无人机的合力控制量以及参考第一角度及其对应的角速度和角加速度,其中,第一角度为横滚角度和俯仰角度,该环路的扰动估计误差在固定时间内收敛到零;
步骤120、基于参考第一角度及其对应的角速度和角加速度、期望第二角度其对应的角速度和角加速度以及实际角度及其对应的角速度,采用姿态角控制环,实时估计该环路的扰动,并基于该扰动的估计量,分别计算无人机绕机体坐标系x、y、z轴转动的力矩控制量,其中,第二角度为偏航角度,该环路的扰动估计误差在固定时间内收敛到零;
步骤130、基于合力控制量和力矩控制量,控制无人机轨迹跟踪,其中,无人机的角度、角速度误差以及位置、速度误差均在固定时间内收敛到零。
需要说明的是,本方法首先考虑扰动,对无人机进行动力学和运动学建模;然后把无人机的轨迹跟踪控制转换为双环控制,外环是位置速度控制环,内环是姿态角环控制;如图2所示,位置速度控制环输入期望的位置和速度以及实际的位置和速度,输出给电机的部分控制输入量以及给姿态角控制环的参考期望的角度和角速度;姿态角控制环输入期望的角度和角速度以及实际的角度和角速度,输出给电机的另一部分控制输入量。接下来,进行内外环控制器设计,具体包括:位置速度控制器设计,包括固定时间状态估计器和固定时间滑模控制器设计,其中状态估计器可以在固定时间后准确估计位置速度控制环的扰动,在准确补偿位置速度控制环的扰动后,另外一个固定时间后在所提出的滑模控制律的控制下可以跟踪期望的位置速度轨迹;姿态角控制器设计,包括固定时间状态估计器和固定时间滑模控制器设计,其中状态估计器可以在固定时间后准确估计姿态角控制环的扰动,在准确补偿姿态角控制环的扰动后,另外一个固定时间后在所提出的滑模控制律的控制下可以跟踪期望的角度和角速度。其中,状态估计器的估计误差收敛于0的时间由它的参数唯一决定;补偿扰动后,滑模控制器控制位置速度收敛到期望的位置速度值的时间由它的参数唯一决定。基于该***设计,进行上述四旋翼无人机轨迹跟踪控制。其中,横滚角度、俯仰角度和偏航角度均为在大地坐标系下的角度。
本方法是一种考虑扰动及模型参数不确定性的固定时间轨迹跟踪控制方法,通过控制位置速度环中的扰动估计误差以及姿态角控制环中的扰动估计误差均在固定时间内收敛到零,进而实现位置速度控制环在固定时间内使得无人机的角度、角速度误差收敛到零以及实现姿态角控制环在孤独时间内使得无人机的位置、速度误差在固定时间内收敛到零。具体实现中,可考虑四旋翼无人机模型中的动力学参数不确定性以及外部扰动,选用适当的控制参数来满足对机器人的工作速度和工作精度的要求,使得所涉及控制方法在实际应用中可实现四旋翼无人机***在固定时间完成轨迹跟踪任务,时效性好,实用性更强。
为保证前述方法的结果正确性,将上述方法建立在以下三项条件基础上:
动力学和运动学建模模型为:
如图3所示的四旋翼无人机模型图,图中,E={ex,ey,ez}表示大地坐标系,B={bx,by,bz}表示无人机机身坐标系,p=[x,y,z]T∈R3表示无人机在世界坐标系中的位置,v=[vx,vy,vz]T∈R3为无人机在世界坐标系中的速度,Θ=[φ,θ,ψ]T∈R3为无人机在世界坐标系中的欧拉角,Ω=[ωx,ωy,ωz]T∈R3为无人机在机身坐标系中的角速度,g,m分别为重力加速度和无人机质量,ez为z方向的单位向量,D1=[dx,dy,dz]T∈R3,D2=[dφ,dθ,dψ]T∈R3为扰动;I=diag(Ixx,Iyy,Izz)∈R3×3表示惯性矩阵;τ=[u2,u3,u4]T∈R3表示***输入力矩,u1表示***输入无人机总升力;R∈R3×3,W∈R3×3表示旋转矩阵,C·=cos(·),S·=sin(·),另外:
跟踪目标的数学表达式为:该表达式即为当前跟踪目标,pd=[xd,yd,zd]T∈R3,vd=[vx_d,vy_d,vz_d]T∈R3,ad=[ax_d,ay_d,az_d]T∈R3分别表示跟踪目标的位置状态、速度、加速度。
四旋翼无人机的物理参数如下表1所示:
表1四旋翼无人机物理参数
结合目标的位置、速度、加速度,根据牛顿第二定律,可以得到位置速度控制方程:
目标的角度Θd=[φd,θd,ψd]T∈R3,可以得到:
ψd可以自行设计,一般设为0;对Θds求导数可得目标角速度aΩ_d=[aωx_d,aωy_d,aωz_d]T∈R3目标角加速度,aΩ_d是控制器设计参数决定的,θ为横滚角度,φ为俯仰角度,ψ为偏航角度。
结合目标的角度、角速度、加速度,可以得到姿态角控制环的控制方程:
优选的,上述位置速度控制环包括用于使得该环路的扰动估计误差在第一固定时间T1内收敛到零的状态估计器,表示为:
其中,为该环路的实际扰动D1的估计量,在初始时刻t0,该环路的实际扰动量D1为零,L1为该环路的实际扰动各分量变化率的上界;ki,i=1,2,3为控制增益常数;v为无人机的实际速度矢量,vd为无人机的期望速度矢量,g为重力加速度,u1为所述合力控制量,ez表示大地坐标系下z轴的单位矢量,m为无人机质量,R∈R3×3为依次以机体坐标系的z、y、x顺序旋转的旋转矩阵,ad为无人机的期望加速度矢量;则上述第一固定时间T1表示为:
优选的,上述合力控制量u1表示为:
其中,αi>0,βi>0,0<ni<mi,0<pi<qi,i=1,2,mi,ni,pi,qi均为正奇数;p为无人机的实际位置,pd为无人机的期望位置,ev为无人机的速度误差,S1为该环路的预设滑模面。
优选的,上述位置速度控制环控制的位置和速度误差在第四固定时间T4内收敛于零,表达式为:
如图4所示,位置速度控制环的结构包括状态估计器和控制律,图中:
优选的,上述姿态角控制环节包括用于使得该环路的扰动估计误差在第二固定时间T2内收敛到零的间状态估计器表示为:
其中,为WD2的估计量,D2为该环路的实际扰动,L2为该环路的实际扰动各分量变化率的上界,在初始时刻t0,该环路的实际扰动量D2为零,W为坐标系变换矩阵,I为单位矩阵,Ω为机体坐标系下的实际角速度矢量,为在大地坐标系下的无人机的期望角速度矢量,τ'为该环的滑模控制律;ki,i=4,5,6为控制增益常数,
则上述第二固定时间T2表示为:
各估计器的参数的选取具体可见如下表2,扰动设置为:
di=0.2sin(5t),i=x,y,z,φ,θ,ψ;
表2估计器的参数
参数名称 | 参数取值 | 参数名称 | 参数取值 |
k<sub>1</sub> | 3 | k<sub>4</sub> | 3 |
k<sub>2</sub> | 0.5 | k<sub>5</sub> | 0.5 |
k<sub>3</sub> | 4 | k<sub>6</sub> | 4 |
μ<sub>1</sub> | 0.5 | μ<sub>2</sub> | 0.5 |
λ<sub>1</sub> | 2 | λ<sub>2</sub> | 2 |
优选的,上述无人机绕机体坐标系x、y、z轴转动的力矩控制量分别为u2、u3、u4,表示为:[u2,u3,u4]T=τ;τ=I-1Wτ';
其中,αi>0,βi>0,0<ni<mi,0<pi<qi,i=3,4,mi,ni,pi,qi均为正奇数;Θ为在大地坐标系下的无人机的实际角度矢量,Θd为在大地坐标系下的无人机的期望角度矢量,为在大地坐标系下的无人机的期望角加速度矢量,为W的导数,S2为该环路的预设滑模面。
优选的,上述姿态角控制环控制的角度、角速度误差在第三固定时间T3内收敛于零,T3的表达式为:
优选的,上述轨迹跟踪总的收敛时间T≤max(T1,T2)+T3+T4。
如图5所示,姿态角控制环的结构图,包括状态估计器和控制律,图中:
各控制律中的控制参数的选取具体可见如下表3,目标轨迹设置为:
zd(t)=0.25,ψd(t)=0;
表3控制参数
为了更好的说明本发明,现证明状态估计器是固定时间收敛的,如下:
分为以下两种情况,对所述的状态估计器进行分析,得到以下分析结果:
所以渐进稳定。
如图6所示,左图对应位置速度控制环,右图对应姿态角控制环,位置速度控制环和姿态角控制环扰动估计量和实际的扰动值,在所设计的状态估计器的作用下,位置和姿态角扰动估计量的每个分量都在固定时间收敛于其对应的扰动值。
对滑模面S1求导,可得:
位置速度控制环收敛时间为:
同理姿态角控制环收敛时间为:
由于角度、角速度误差先收敛,然后位置和速度误差才会收敛,并且扰动收敛时间T1、T2与控制输入量无关,则所述轨迹跟踪收敛总时间表示为:
T≤max(T1,T2)+T3+T4。
如图7所示,任务空间中位置和姿态角的跟踪轨迹图,在所设计的基于估计器的固定时间控制器的作用下,任务空间中位置和姿态角都在固定时间(8秒内)收敛于其对应的跟踪目标轨迹。基于图6和图7,得到无人机的控制输入,包括合力控制量和所有力矩控制量,如图8所示,最终得到任务空间中位置和姿态角轨迹跟踪图,如图9所示,图9整体和图7仿真的结果很接近,仅仅因为传感器精度问题造成位置和姿态角跟踪有微小的误差,除去这一因素带来的误差,位置和姿态角都可以在固定时间(8秒内)收敛于其对应的跟踪目标轨迹,其结果可支撑本实施例方法的控制效果。
实施例二
一种存储介质,存储介质中存储有指令,当计算机读取所述指令时,使所述计算机执行上述如实施例一所述的一种四旋翼无人机轨迹跟踪控制方法。
相关技术方案同实施例一,在此不再赘述。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种四旋翼无人机轨迹跟踪控制方法,其特征在于,包括:
基于期望位置及其对应的速度和加速度以及实时采集的实际位置及其对应的速度和角度,采用位置速度控制环,实时估计该环路的扰动,并基于该扰动的估计量,计算无人机的合力控制量以及参考第一角度及其对应的角速度和角加速度,其中,所述第一角度为横滚角度和俯仰角度,该环路的扰动估计误差在固定时间内收敛到零;
基于所述参考第一角度及其对应的角速度和角加速度、期望第二角度其对应的角速度和角加速度以及实际角度及其对应的角速度,采用姿态角控制环,实时估计该环路的扰动,并基于该扰动的估计量,分别计算无人机绕机体坐标系x、y、z轴转动的力矩控制量,其中,所述第二角度为偏航角度,该环路的扰动估计误差在固定时间内收敛到零;
基于所述合力控制量和所述力矩控制量,控制无人机轨迹跟踪,其中,无人机的角度、角速度误差以及位置、速度误差均在固定时间内收敛到零。
2.根据权利要求1所述的一种四旋翼无人机轨迹跟踪控制方法,其特征在于,所述位置速度控制环包括用于使得该环路的扰动估计误差在第一固定时间T1内收敛到零的状态估计器,表示为:
其中,为该环路的实际扰动D1的估计量,在初始时刻t0,该环路的实际扰动量D1为零,L1为该环路的实际扰动各分量变化率的上界;ki,i=1,2,3为控制增益常数;k2>0,k3>4L1,0<μ1<1,λ1>1,v为无人机的实际速度矢量,vd为无人机的期望速度矢量,g为重力加速度,u1为所述合力控制量,ez表示大地坐标系下z轴的单位矢量,m为无人机质量,R∈R3×3为依次以机体坐标系的z、y、x顺序旋转的旋转矩阵,ad为无人机的期望加速度矢量;
则所述第一固定时间T1表示为:
9.根据权利要求8所述的一种四旋翼无人机轨迹跟踪控制方法,其特征在于,所述轨迹跟踪总的收敛时间T≤max(T1,T2)+T3+T4。
10.一种存储介质,其特征在于,所述存储介质中存储有指令,当计算机读取所述指令时,使所述计算机执行上述如权利要求1至9任一项所述的一种四旋翼无人机轨迹跟踪控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911367910.2A CN111026160B (zh) | 2019-12-26 | 2019-12-26 | 一种四旋翼无人机轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911367910.2A CN111026160B (zh) | 2019-12-26 | 2019-12-26 | 一种四旋翼无人机轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111026160A true CN111026160A (zh) | 2020-04-17 |
CN111026160B CN111026160B (zh) | 2020-12-08 |
Family
ID=70214743
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911367910.2A Active CN111026160B (zh) | 2019-12-26 | 2019-12-26 | 一种四旋翼无人机轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111026160B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111650951A (zh) * | 2020-05-22 | 2020-09-11 | 南京航空航天大学 | 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法 |
CN111665870A (zh) * | 2020-06-24 | 2020-09-15 | 深圳市道通智能航空技术有限公司 | 一种轨迹跟踪方法及无人机 |
CN111948935A (zh) * | 2020-08-03 | 2020-11-17 | 曾喆昭 | 一种欠驱动vtol飞行器的自耦pd控制理论方法 |
CN112269401A (zh) * | 2020-09-04 | 2021-01-26 | 河南大学 | 基于跟踪精度与风险控制的自适应主动传感器跟踪方法 |
CN112650303A (zh) * | 2021-01-20 | 2021-04-13 | 南京航空航天大学 | 一种基于固定时间技术的无人机编队容错控制方法 |
CN114564047A (zh) * | 2022-04-28 | 2022-05-31 | 北京航空航天大学 | 一种考虑气象条件的无人机等速飞行控制方法 |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007018572A2 (en) * | 2004-11-08 | 2007-02-15 | Bell Helicopter Textron Inc. | Flight system with three feedback control loops |
CN104865968A (zh) * | 2015-04-22 | 2015-08-26 | 浙江工业大学 | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 |
US20170153650A1 (en) * | 2015-11-30 | 2017-06-01 | Metal Industries Research & Development Centre | Multiple rotors aircraft and control method |
CN106933104A (zh) * | 2017-04-21 | 2017-07-07 | 苏州工业职业技术学院 | 一种基于dic‑pid的四旋翼飞行器姿态与位置的混合控制方法 |
CN106970646A (zh) * | 2017-05-23 | 2017-07-21 | 四川理工学院 | 基于自适应积分反步的四旋翼飞行器控制方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
CN108594837A (zh) * | 2018-02-12 | 2018-09-28 | 山东大学 | 基于pd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 |
US20190033892A1 (en) * | 2017-07-27 | 2019-01-31 | Intel Corporation | Trajectory tracking controllers for rotorcraft unmanned aerial vehicles (uavs) |
WO2019055025A1 (en) * | 2017-09-15 | 2019-03-21 | Sanyal Amit K | INTEGRATED GUIDE AND FEEDBACK CONTROL FOR AUTONOMOUS VEHICLE |
CN109597426A (zh) * | 2018-11-13 | 2019-04-09 | 上海无线电设备研究所 | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 |
CN109901606A (zh) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | 一种用于四旋翼精确轨迹跟踪的混合有限时间控制方法 |
US20190264864A1 (en) * | 2016-02-26 | 2019-08-29 | Sz Dji Osmo Technology Co., Ltd. | Method and system for stabilizing a payload |
KR20190107422A (ko) * | 2018-03-12 | 2019-09-20 | 광주과학기술원 | Rf 기반 다중 무인 비행체의 측위 및 궤적 제어 장치 및 그 시스템 |
CN110275542A (zh) * | 2019-06-14 | 2019-09-24 | 合肥工业大学 | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 |
CN110456816A (zh) * | 2019-07-05 | 2019-11-15 | 哈尔滨工程大学 | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 |
-
2019
- 2019-12-26 CN CN201911367910.2A patent/CN111026160B/zh active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007018572A2 (en) * | 2004-11-08 | 2007-02-15 | Bell Helicopter Textron Inc. | Flight system with three feedback control loops |
CN104865968A (zh) * | 2015-04-22 | 2015-08-26 | 浙江工业大学 | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 |
US20170153650A1 (en) * | 2015-11-30 | 2017-06-01 | Metal Industries Research & Development Centre | Multiple rotors aircraft and control method |
US20190264864A1 (en) * | 2016-02-26 | 2019-08-29 | Sz Dji Osmo Technology Co., Ltd. | Method and system for stabilizing a payload |
CN106933104A (zh) * | 2017-04-21 | 2017-07-07 | 苏州工业职业技术学院 | 一种基于dic‑pid的四旋翼飞行器姿态与位置的混合控制方法 |
CN106970646A (zh) * | 2017-05-23 | 2017-07-21 | 四川理工学院 | 基于自适应积分反步的四旋翼飞行器控制方法 |
US20190033892A1 (en) * | 2017-07-27 | 2019-01-31 | Intel Corporation | Trajectory tracking controllers for rotorcraft unmanned aerial vehicles (uavs) |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
WO2019055025A1 (en) * | 2017-09-15 | 2019-03-21 | Sanyal Amit K | INTEGRATED GUIDE AND FEEDBACK CONTROL FOR AUTONOMOUS VEHICLE |
CN108594837A (zh) * | 2018-02-12 | 2018-09-28 | 山东大学 | 基于pd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 |
KR20190107422A (ko) * | 2018-03-12 | 2019-09-20 | 광주과학기술원 | Rf 기반 다중 무인 비행체의 측위 및 궤적 제어 장치 및 그 시스템 |
CN109597426A (zh) * | 2018-11-13 | 2019-04-09 | 上海无线电设备研究所 | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 |
CN109901606A (zh) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | 一种用于四旋翼精确轨迹跟踪的混合有限时间控制方法 |
CN110275542A (zh) * | 2019-06-14 | 2019-09-24 | 合肥工业大学 | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 |
CN110456816A (zh) * | 2019-07-05 | 2019-11-15 | 哈尔滨工程大学 | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 |
Non-Patent Citations (5)
Title |
---|
XIAOLIN AI 等: "Fixed-time trajectory tracking for a quadrotor with external disturbances:A flatness-based sliding mode control approach", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
ZHENG ZHANG 等: "Multivariable sliding mode backstepping controller design for quadrotor UAV based on disturbance observer", 《SCIENCE CHINA INFORMATION SCIENCES》 * |
姜明瑞: "四旋翼无人机轨迹跟踪控制***设计", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
王春阳 等: "四旋翼无人机轨迹跟踪控制***设计", 《电光与控制》 * |
范云生 等: "四旋翼飞行器轨迹跟踪控制器的设计与验证", 《仪器仪表学报》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111650951A (zh) * | 2020-05-22 | 2020-09-11 | 南京航空航天大学 | 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法 |
CN111650951B (zh) * | 2020-05-22 | 2021-09-17 | 南京航空航天大学 | 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法 |
CN111665870A (zh) * | 2020-06-24 | 2020-09-15 | 深圳市道通智能航空技术有限公司 | 一种轨迹跟踪方法及无人机 |
CN111948935A (zh) * | 2020-08-03 | 2020-11-17 | 曾喆昭 | 一种欠驱动vtol飞行器的自耦pd控制理论方法 |
CN112269401A (zh) * | 2020-09-04 | 2021-01-26 | 河南大学 | 基于跟踪精度与风险控制的自适应主动传感器跟踪方法 |
CN112269401B (zh) * | 2020-09-04 | 2021-07-20 | 河南大学 | 基于跟踪精度与风险控制的自适应主动传感器跟踪方法 |
CN112650303A (zh) * | 2021-01-20 | 2021-04-13 | 南京航空航天大学 | 一种基于固定时间技术的无人机编队容错控制方法 |
CN114564047A (zh) * | 2022-04-28 | 2022-05-31 | 北京航空航天大学 | 一种考虑气象条件的无人机等速飞行控制方法 |
CN114564047B (zh) * | 2022-04-28 | 2022-08-16 | 北京航空航天大学 | 一种考虑气象条件的无人机等速飞行控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111026160B (zh) | 2020-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111026160B (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
Colorado et al. | Mini-quadrotor attitude control based on Hybrid Backstepping & Frenet-Serret theory | |
CN109614633B (zh) | 一种复合式旋翼飞行器非线性建模及线性化配平方法 | |
CN109062042B (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
CN106325291B (zh) | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及*** | |
CN105159305B (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN109947126B (zh) | 四旋翼无人机的控制方法、装置、设备及可读介质 | |
CN111258216B (zh) | 一种适用于四旋翼飞行器的滑模重复控制器 | |
CN108037662A (zh) | 一种基于积分滑模障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
CN108638068B (zh) | 一种携带冗余度机械臂的飞行机器人控制***设计方法 | |
CN112578805B (zh) | 一种旋翼飞行器的姿态控制方法 | |
CN110377044B (zh) | 一种无人直升机的有限时间高度和姿态跟踪控制方法 | |
CN109507890A (zh) | 一种基于eso的无人机动态逆广义预测控制器 | |
CN109885074B (zh) | 四旋翼无人机有限时间收敛姿态控制方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN111198570B (zh) | 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法 | |
CN110703603B (zh) | 一种无人机多层递归收敛神经网络控制器的控制方法 | |
CN106802570B (zh) | 一种无人直升机位置跟踪的方法与装置 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂*** | |
CN111813140A (zh) | 一种具有高精度的四旋翼无人机轨迹跟踪控制方法 | |
CN111459188A (zh) | 一种基于四元数的多旋翼非线性飞行控制方法 | |
CN109976364B (zh) | 一种六旋翼飞行器姿态解耦控制方法 | |
CN106292297A (zh) | 基于pid控制器和l1自适应控制器的姿态控制方法 | |
CN116088549B (zh) | 一种尾座式垂直起降无人机姿态控制方法 | |
CN108845508B (zh) | 一种基于cmac-滑膜一体化控制的无人机半物理仿真控制方法 |
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 |