CN105045284B - 一种抗干扰无人飞行器路径跟踪控制方法 - Google Patents
一种抗干扰无人飞行器路径跟踪控制方法 Download PDFInfo
- Publication number
- CN105045284B CN105045284B CN201510537549.9A CN201510537549A CN105045284B CN 105045284 B CN105045284 B CN 105045284B CN 201510537549 A CN201510537549 A CN 201510537549A CN 105045284 B CN105045284 B CN 105045284B
- Authority
- CN
- China
- Prior art keywords
- path
- angle
- error
- aerial vehicle
- unmanned aerial
- 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 44
- 239000013598 vector Substances 0.000 claims abstract description 27
- 238000004364 calculation method Methods 0.000 claims abstract description 11
- 238000000354 decomposition reaction Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims 1
- 238000005516 engineering process Methods 0.000 abstract description 2
- 238000013461 design Methods 0.000 description 4
- 238000004422 calculation algorithm Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 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 1
- 238000013459 approach Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005290 field theory Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明“一种抗干扰无人飞行器路径跟踪控制方法”,提供一种抗干扰无人飞行器路径跟踪控制方法,相对于基于传统向量场制导的路径跟踪控制方法,本方法对外界扰动具有更好的鲁棒性,属于自动控制技术领域。其具体步骤如下:步骤一,给定期望跟踪值:给定期望平面路径;给定期望速度。步骤二,导航计算:计算消除期望位置与实际位置之间的误差所需的期望航向角。步骤三,路径跟踪航向角误差计算:计算期望航向角与实际航向角之间的误差。步骤四,滑模控制器计算:计算消除期望航向角与实际航向角间误差所需的控制量。
Description
技术领域
本发明提供一种抗干扰无人飞行器路径跟踪控制方法,相对于基于传统向量场制导的路径跟踪控制方法,本方法对外界扰动具有更好的鲁棒性,属于自动控制技术领域。
背景技术
无人飞行器的跟踪控制包括轨迹跟踪控制和路径跟踪控制两种,是当今自主飞行控制研究的热点和难点。路径跟踪问题要求***收敛到给定的且与时间无关的几何路径上,并做匀速或分段匀速运动。
目前路径跟踪主要的设计方法有反步法和制导路径跟踪理论等,其中制导方法包括视线制导、坐标变换制导、向量场制导等。向量场制导方法采用在跟踪路径周围建立向量场的方法解算期望姿态,而不是跟踪期望路径上虚拟点。场中的向量能够提供引导飞行器趋向期望路径所需的航向角信息,因而飞行器只需改变自身姿态即可实现路径跟踪。这种制导方式能够将控制目标中空间与时间解耦,为后续发展基于时间控制项的控制目标(如基于速度控制的协同组网)留下可能。
然而,传统的向量场制导技术在处理具有外界扰动的路径跟踪问题时具有一定的局限性。向量场向量角度的生成只与飞行器的位置误差有关,在飞行器受到位置扰动时,由于飞行器位置误差并未发生明显变化,因此向量场不能及时做出调整来消除扰动的影响。
本发明“一种抗干扰无人飞行器路径跟踪控制方法”,在传统向量场制导的基础上,加入位置误差积分项,提出了基于积分向量场制导方法的平面路径跟踪控制方法。该方法通过引入误差积分项,提高了路径跟踪算法对未知扰动的鲁棒性。由该方法控制的闭环***是有界稳定的,且具有良好的收敛效果,这就为该无人飞行器在具有扰动情况下的路径跟踪控制问题提供了有效的设计手段。
发明内容
(1) 目的:本发明的目的在于提供一种基于积分向量场制导技术的抗干扰路径跟踪控制方法,控制工程师可以按照该方法并结合实际参数实现飞行器在未知扰动环境中的路径跟踪控制。
(2) 技术方案:本发明“一种抗干扰无人飞行器路径跟踪控制方法”,其主要内容及程序是:
路径跟踪的期望路径直线可以近似分解为参数化的直线和圆弧。基于积分向量场的平面路径跟踪方法先利用积分向量场理论在给定期望路径(包括直线和圆弧路径)所在平面建立导航向量场,生成期望角度;然后利用滑模控制理论设计路径跟踪控制器,使其跟踪误差在有限时间内趋近于零。实际应用中,飞行器的位置、姿态、速度等状态量由组合惯导等机载传感器测量得到,将由该方法计算得到的控制量传输至舵机与发动机等执行装置即可实现飞行器的平面路径跟踪功能。
本发明“一种抗干扰无人飞行器路径跟踪控制方法”,其具体步骤如下:
步骤一 给定期望跟踪值:给定期望平面路径;给定期望速度;
步骤二 导航计算:计算消除期望位置与实际位置之间的误差所需的期望航向角;
步骤三 路径跟踪航向角误差计算:计算期望航向角与实际航向角之间的误差;
步骤四 滑模控制器计算:计算消除期望航向角与实际航向角间误差所需的控制量。
其中,在步骤一中所述的给定期望平面路径分为直线和圆弧两种,直线路径由直线与北向夹角与规划路径起始点坐标确定,记作;圆路径由圆心位置与半径确定记作。所述的给定期望速度为,为常数,为期望速度沿艇体坐标系的分解量。
其中,在步骤二中所述的计算消除期望位置与实际位置之间的误差所需的期望航向角,其计算方法如下:
直线:,其中为设定的初始航向角,为机体与直线路径之间的位置误差,可由规划路径起始点坐标机***置坐标与直线路径由直线与北向夹角求得,为位置误差积分项,为控制参数;为无人飞行器航向角,可由机体轴与北向夹角与直线位置角求得,即,为决定向量场中向量方向转换速度的参数;
圆弧:,其中为机***置与期望路径圆心连线与北向夹角,可由机***置与期望路径圆心位置求得,为机***置与期望路径之间的距离,为位置误差积分项,为控制参数;为决定向量场中向量方向转换速度的参数。
其中,在步骤三中所述的路径跟踪航向角误差,其计算方法如下:
直线:
圆弧:。
其中,在步骤四中所述的消除期望航向角与实际航向角之间的误差所需的控制量,其计算方法如下:
直线:
其中,控制参数 均大于0,且满足 , , 为任意值;
圆:
其中,控制参数 均大于0,且满足,,为任意值。
(3) 优点及效果:
本发明“一种抗干扰无人飞行器路径跟踪控制方法”,与现有技术比,其优点是:
1)该方法直接利用路径周围向量场而不是跟踪路径上虚拟点进行路径跟踪,将时间与空间解耦,可实现其他与时间相关的控制目的,如在时间约束下的协同飞行;
2)该方法能够保证闭环***的渐近稳定性能,且收敛速度及滑动流形边界层厚度可根据实际要求进行调节;
3)该方法相比与传统向量场制导方法,增加了位置误差积分项,增加了路径跟踪控制算法对未知扰动的鲁棒性;
4)该方法采用变结构控制算法,结构简单,响应速度快,易于工程实现。
控制工程师在应用过程中可以根据实际无人飞行器给定任意期望巡航路径,并将由该方法计算得到的控制量直接传输至执行机构实现路径跟踪功能。
附图说明:
图1 为本发明所述控制方法流程框图;
图2 为本发明向量场直线路径导航计算几何关系图;
图3为本发明向量场圆弧路径导航计算几何关系图;
符号说明如下:
为直线期望路径规划起始点位置;
为无人飞行器在惯性坐标系下的当前位置;
期望直线路径与北向夹角;
无人飞行器航向角;
无人飞行器期望航向角;
无人飞行器航向角误差;
无人飞行器航向角速度;
惯性系中无人飞行器速度;
无人飞行器机体坐标系下线速度;
无人飞行器机体坐标系下角速度;
机体轴与北向夹角;
无穷远处航向角,向量场参数,为可调节正数;
圆弧路径圆心位置坐标;
圆弧路径半径;
机***置和圆心位置连线与北向夹角
机体距离圆心距离。
具体实施方式:
下面结合附图,对本发明中的各部分设计方法作进一步的说明:
本发明“一种抗干扰无人飞行器路径跟踪控制方法”,见图1所示,具体步骤如下:
步骤一:给定期望跟踪值
1)以无人飞行器浮心为原点建立艇体坐标系;以地面上任一点为原点建立惯性坐标系,其中原点为地面任意一点,指向北,指向东,指向地心;
2)给定期望平面路径,包括直线和圆弧。其中,如图2所示,直线路径由直线与北向夹角与规划路径起始点坐标确定,记作;如图3所示,圆弧路径由圆心位置与半径确定,记作;
3)给定期望速度,为常数,为期望速度沿机体 坐标系的分解量。在无人飞行器工作环境中,无垂直方向风速,水平风速较小,可将其影响忽略。本方法中控制无人飞行器前向速度为定值,因而对于水平面内路径跟踪,可认为卫星前向速度与地速相等,即。
步骤二:计算期望航向角
1)直线路径期望航向角计算:
首先,计算机体距离直线的位置误差,如图2所示;
然后,给定无穷远处航向角;
最后,计算直线路径期望航向角;
2)圆弧路径期望航向角计算:
首先,计算机体距离圆心的位置误差,如图3所示,;
然后,计算机***置与圆心位置连线与北向坐标轴夹角,如图3所示,;
最后,计算圆弧路径期望航向角,;
步骤三:计算路径跟踪航向角误差
1)对于直线路径,航向角为机体轴相对于直线的偏转角度,可由机体轴与北向坐标轴夹角与直线位置角求得,即;
2)对于圆弧路径,航向角为机体轴与北向坐标轴夹角,可直接测得;
3)分别求直线与圆弧路径的航向角误差:
直线:
圆:。
步骤四:设计滑模控制路径跟踪控制器
1)对于配有自动驾驶仪的无人飞行器,可通过对自驾仪程序的编码使其航向角控制回路的动力学模型表示如下:
其中,为航向角控制输入,为表征该回路响应快慢的参数;
2)对于直线路径,采用一个滑动模型来保证***路径在有限时间内收敛到期望路径:
则有
取控制项为
其中,控制参数 均大于0,且满足 , , 为任意值;
按照上述方法设计控制参数,可以保证***稳定性;
3) 对于圆弧路径,采用一个滑动模型来保证***路径在有限时间内收敛到期望路径:
则有
取控制项为
其中,控制参数 均大于0,且满足,, 为任意值。按照上述方法设计控制参数,可以保证***稳定性。
Claims (3)
1.一种抗干扰无人飞行器路径跟踪控制方法,其特征在于,具体步骤如下:
步骤一给定期望跟踪值:给定期望平面路径;给定期望速度;
步骤二导航计算:计算消除期望位置与实际位置之间的误差所需的期望航向角χd,其计算方法如下:
直线:其中χ∞为无穷远处航向角,向量场参数,为可调节正数;为机体与直线路径之间的位置误差,由规划路径起始点坐标P0=[x0 y0]T和机***置坐标P=[x y]T之间的直线路径与北向夹角ξ求得,为直线路径跟踪位置误差积分补偿项,为其一阶导数,σ>0为控制参数;χ为无人飞行器航向角,由机体轴与北向夹角ζ与直线位置角ξ求得,即χ=ζ-ξ,k>0为决定向量场中向量方向转换速度的参数;Vg为惯性系中无人飞行器速度;
圆弧:其中λ为机***置与期望路径圆心连线与北向夹角,由机***置Po=[xo yo]与期望路径圆心位置Pc=[xc yc]求得,为机***置与期望路径之间的距离,d为机体距离圆心距离,R为圆弧路径半径,为圆弧路径跟踪位置误差积分补偿项,为其一阶导数;
步骤三路径跟踪航向角误差计算:计算期望航向角与实际航向角之间的误差
步骤四滑模控制器计算:计算消除期望航向角与实际航向角间误差所需的控制量χc,其计算方法如下:直线:
其中,控制参数α,κ,ε均大于0,且满足 为任意值;
圆:
其中,控制参数满足 为任意值。
2.根据权利要求1所述的一种抗干扰无人飞行器路径跟踪控制方法,其特征在于:
步骤一中所述的给定期望平面路径分为直线和圆弧两种,直线路径由直线与北向夹角与规划路径起始点坐标确定,记作pl(x0,y0,ξ);圆路径由圆心位置与半径确定记作po(x0,y0,R);所述的给定期望速度为υc=[uc,vc,wc]T=[C,0,0]T,C>0为常数,uc,vc,wc为期望速度沿艇体坐标系的分解量。
3.根据权利要求1所述的一种抗干扰无人飞行器路径跟踪控制方法,其特征在于:
在步骤三中所述的路径跟踪航向角误差其计算方法如下:
直线:
圆弧:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510537549.9A CN105045284B (zh) | 2015-09-21 | 2015-09-21 | 一种抗干扰无人飞行器路径跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510537549.9A CN105045284B (zh) | 2015-09-21 | 2015-09-21 | 一种抗干扰无人飞行器路径跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105045284A CN105045284A (zh) | 2015-11-11 |
CN105045284B true CN105045284B (zh) | 2019-03-19 |
Family
ID=54451887
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510537549.9A Active CN105045284B (zh) | 2015-09-21 | 2015-09-21 | 一种抗干扰无人飞行器路径跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105045284B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107703973B (zh) * | 2017-09-11 | 2021-08-31 | 广州视源电子科技股份有限公司 | 轨迹跟踪方法、装置 |
CN107992069B (zh) * | 2017-11-29 | 2021-01-19 | 上海无线电设备研究所 | 一种无人机路径跟踪控制的制导律设计方法 |
CN108417096A (zh) * | 2018-02-01 | 2018-08-17 | 四川九洲电器集团有限责任公司 | 一种飞行状态评估方法及*** |
CN108845588B (zh) * | 2018-06-22 | 2021-05-07 | 哈尔滨工业大学 | 一种基于非线性制导的四旋翼飞行器轨迹跟踪控制方法 |
CN109375643B (zh) * | 2018-10-24 | 2021-06-25 | 中北大学 | 基于领航-跟随式三角形编队的多四旋翼对峙跟踪目标制导律 |
CN109708639B (zh) * | 2018-12-07 | 2022-11-22 | 湖北航天飞行器研究所 | 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 |
CN110488875B (zh) * | 2019-09-02 | 2022-07-12 | 中国人民解放军海军航空大学 | 基于动态逆的无人机跟踪目标初始段航向误差修正方法 |
CN113219970B (zh) * | 2021-04-23 | 2023-11-03 | 大连海事大学 | 一种无人船向量场路径跟踪控制器及设计方法 |
CN113176788B (zh) * | 2021-04-27 | 2022-08-16 | 北京理工大学 | 一种基于变前向距离los制导律的飞行器路径跟踪方法 |
CN113495571B (zh) * | 2021-07-26 | 2024-02-27 | 中国人民解放军63629部队 | 飞行器路径跟踪方法、装置、设备和介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3998412A (en) * | 1975-05-29 | 1976-12-21 | Sperry Rand Corporation | Helical vertical path control apparatus for aircraft area navigation system |
CN102163057B (zh) * | 2011-04-14 | 2013-05-29 | 北京航空航天大学 | 一种自治飞艇平面路径跟踪控制方法 |
CN102759928B (zh) * | 2012-04-28 | 2015-04-15 | 中国人民解放军国防科学技术大学 | 一种平流层飞艇航迹控制方法 |
CN104199303B (zh) * | 2014-09-18 | 2017-02-01 | 北京航空航天大学 | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 |
CN104199457B (zh) * | 2014-09-19 | 2017-05-24 | 北京航空航天大学 | 一种基于h∞和模型修复抗饱和的平流层飞艇姿态控制方法 |
-
2015
- 2015-09-21 CN CN201510537549.9A patent/CN105045284B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105045284A (zh) | 2015-11-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105045284B (zh) | 一种抗干扰无人飞行器路径跟踪控制方法 | |
CN109189071B (zh) | 基于模糊观测器的鲁棒自适应无人船路径跟踪控制方法 | |
Liang et al. | Leader-following formation tracking control of mobile robots without direct position measurements | |
Belleter et al. | Observer based path following for underactuated marine vessels in the presence of ocean currents: A global approach | |
Lekkas et al. | Integral LOS path following for curved paths based on a monotone cubic Hermite spline parametrization | |
CN109828570B (zh) | 一种自适应边界层水面无人艇控制导引方法 | |
CN111487966B (zh) | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 | |
CN106444822B (zh) | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 | |
CN113126644B (zh) | 基于自适应视线法的无人机三维航迹跟踪方法 | |
CN109358499A (zh) | 基于速度与航向双重制导的无人船精确路径跟踪控制方法 | |
CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
CN105425812B (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
CN110609556A (zh) | 一种基于los导航法的多无人艇协同控制方法 | |
CN107515617A (zh) | 一种固定翼无人机航线平滑切换控制方法 | |
Ji et al. | Time-varying sliding mode guidance scheme for maneuvering target interception with impact angle constraint | |
CN105116914B (zh) | 一种平流层飞艇解析模型预测路径跟踪控制方法 | |
Chen et al. | Trajectory-following guidance based on a virtual target and an angle constraint | |
CN113093804B (zh) | 基于反演滑模控制的无人艇编队控制方法和控制*** | |
Zhao et al. | A novel path-following control algorithm for surface vessels based on global course constraint and nonlinear feedback technology | |
CN117389312B (zh) | 一种基于模型的水下航行器抗横滚三维跟踪控制方法 | |
CN113296505B (zh) | 一种基于速变los的无人船多模式路径跟踪控制方法 | |
CN105094144B (zh) | 一种无人飞艇自适应抗风路径跟踪控制方法 | |
Juan et al. | Trajectory tracking control of multi-AUVs formation based on virtual leader | |
CN116339355A (zh) | 水下航行器及其编队跟踪控制方法和装置 | |
Jain et al. | Three dimensional moving path following control for robotic vehicles with minimum positive forward speed |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |