CN114063653A - 空间与时间一致性约束小型无人机高精度航迹控制方法 - Google Patents
空间与时间一致性约束小型无人机高精度航迹控制方法 Download PDFInfo
- Publication number
- CN114063653A CN114063653A CN202111469890.7A CN202111469890A CN114063653A CN 114063653 A CN114063653 A CN 114063653A CN 202111469890 A CN202111469890 A CN 202111469890A CN 114063653 A CN114063653 A CN 114063653A
- Authority
- CN
- China
- Prior art keywords
- track
- aerial vehicle
- unmanned aerial
- speed
- course angle
- 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 24
- 238000012545 processing Methods 0.000 claims abstract description 8
- 238000012937 correction Methods 0.000 claims description 6
- 238000004422 calculation algorithm Methods 0.000 description 9
- 238000010586 diagram Methods 0.000 description 7
- 238000005259 measurement Methods 0.000 description 5
- 238000004088 simulation Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 230000000737 periodic effect Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 230000011218 segmentation Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000003466 anti-cipated effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization 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
- G05D1/106—Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones
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
技术领域
本发明涉及雷达技术领域，具体为空间与时间一致性约束小型无人机高精度航迹控制方法。
背景技术
为了提高航迹控制的精度，无人机需要尽快调整参数，及时到达预期点，调整参数主要包括速度和方向。频繁的调整运动状态会导致航迹不稳，航迹的平稳和跟踪精度是矛盾的，因此需要优化控制参数，同时做到实际航迹与规划航迹在空间上和时间上的一致。
对雷达的航迹生成中，由不确定性误差导致的估计问题主要包含两大类：一是由于先验信息不足，雷达位置误差对航迹欺骗效果产生影响；二是受到动力学约束、硬件系统误差、控制误差和风力影响等原因导致的无人机位置误差。前者可采用复合定位方法提高雷达的定位精度，后者可采取高精度定位系统、航迹控制优化、偏差补偿措施。航迹控制算法主要为间接控制算法，其设计思路是将航迹控制问题转化为航向、航速控制问题，主要实现方式是将其分解为双闭环控制系统，外环使用航向、航速解算算法，计算得到期望航向和期望航速，内环由航向、航速控制算法构成，根据期望值和实际值的差异，控制无人机快速平稳的实现差值纠正。常规的航迹控制算法只考虑空间上的一致性，没有考虑时间上的一致性，无法满足目标模拟的要求。
发明内容
本发明的目的在于提供空间与时间一致性约束小型无人机高精度航迹控制方法，根据上述问题，尤其涉及用无人机搭载雷达回波模拟器进行目标模拟时，解决无人机实际飞行的航迹与规划设计下无人机航迹存在位置和时间不一致的问题。
为实现上述目的，本发明提供如下技术方案：空间与时间一致性约束小型无人机高精度航迹控制方法，包括无人机机体、速度控制器、航迹处理器、速度修正器和航向角调整器，所述无人机机体内部设有速度控制器，其速度控制器包含有航迹处理模块、速度修正模块和航向角调整模块，其中航迹处理模块对应设有航迹处理器，速度修正模块对应设有速度修正器，航向角调整模块对应设有航向角调整器，并且航迹处理器、速度修正器和航向角调整器均作用于速度控制器用于调整无人机机体的飞行轨迹、速度和角度。
优选的，所述无人机机体内部设有信号发射器，其信号发射器采用无线连接方式与控制器连接。
优选的，所述无人机机体的航迹处理器中包含有多个虚拟轨迹节点，其中至少包含有虚拟轨迹节点A、虚拟轨迹节点B、虚拟轨迹节点C和虚拟轨迹节点D。
空间与时间一致性约束小型无人机高精度航迹控制方法，具体如下：
S1：根据无人机机体预计航行轨迹和实际位置的关系，控制速度的大小，设定速度控制器。
S2：根据无人机机体预计航行轨迹，设定航迹模块中的航迹处理器的位置信息。
S3：根据无人机机体预计航行轨迹，并结合设定的位置信息后，设计航迹的速度修正器和航向角调整器的参数。
S4：根据无人机机体调整航行速度和角度后，再对航向角进行优化设定。
与现有技术相比，本发明的有益效果是：该空间与时间一致性约束小型无人机高精度航迹控制方法在目标轨迹切线方向定义一个虚拟的节点，通过控制无人机跟随该节点，从而使得无人机位于规划轨迹上，同时满足时间要求。根据当前时刻无人机的实际位置及预期航迹，利用航迹修正算法，计算得到无人机当前时刻预期航向和预期速度，然后将预期速度和实际速度的差值作为速度控制器的输入，利用速度控制器计算速度控制参数，从而实时调整速度，同时调整无人机的航向，从而实现航迹的位置、时间一致性。
附图说明
图1为本发明空间与时间一致性约束小型无人机高精度航迹控制方法控制流程图；
图2为本发明空间与时间一致性约束小型无人机高精度航迹控制方法速度控制器连接关系示意图；
图3为本发明空间与时间一致性约束小型无人机高精度航迹控制方法速度控制示意图；
图4为本发明空间与时间一致性约束小型无人机高精度航迹控制方法无人机控制系统仿真结构示意图；
图5为本发明空间与时间一致性约束小型无人机高精度航迹控制方法无速度控制时距离误差示意图；
图6为本发明空间与时间一致性约束小型无人机高精度航迹控制方法改进后速度控制时距离误差示意图；
图7为本发明空间与时间一致性约束小型无人机高精度航迹控制方法航向角求解示意图。
图中：1、无人机机体，2、速度控制器，3、航迹处理器，4、速度修正器，5、航向角调整器。
具体实施方式
下面将结合本发明以下实施例，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
请参阅图1-7，本发明提供一种技术方案：空间与时间一致性约束小型无人机高精度航迹控制方法，包括无人机机体1、速度控制器2、航迹处理器3、速度修正器4和航向角调整器5，无人机机体1内部设有速度控制器2，其速度控制器2包含有航迹处理模块、速度修正模块和航向角调整模块，其中航迹处理模块对应设有航迹处理器3，速度修正模块对应设有速度修正器4，航向角调整模块对应设有航向角调整器5，并且航迹处理器3、速度修正器4和航向角调整器5均作用于速度控制器2用于调整无人机机体1的飞行轨迹、速度和角度，无人机机体1内部设有信号发射器，其信号发射器采用无线连接方式与控制器连接，无人机机体1的航迹处理器3中包含有多个虚拟轨迹节点，其中至少包含有虚拟轨迹节点A、虚拟轨迹节点B、虚拟轨迹节点C和虚拟轨迹节点D，需要额外说明的是，其中虚拟轨迹节点设计越多，其修正调节越精确。
空间与时间一致性约束小型无人机高精度航迹控制方法，具体如下：
S1：根据无人机机体1预计航行轨迹和实际位置的关系，控制速度的大小，设定速度控制器2；
为了保证航迹在时间上也能对齐，需求引入速度控制器2，根据期望位置和实际位置的关系，控制速度的大小，速度控制,2速度控制参数的计算式如下：
离散化后可表示为
式中，ev(t)为实际值与期望值的差值，ev(t-1)为上一次计算时刻的差值，Pv(t)为速度控制的输出值，用于控制无人机机体1调整速度。Kp、KT、Kd为控制器系数。
S2：根据无人机机体1预计航行轨迹，设定航迹模块中的航迹处理器3的位置信息；
在无人机机体1的运动模型中，速度不能突变，因此运动模型中的控制参数设置为加速度。
约束条件为：
航迹处理器3的位置信息会受到外界干扰，主要包括风力等因素带来的周期性误差、固定偏移误差，数据测量采集主要是系统定位引入位置的测量误差。速度控制器2能够在干扰存在时通过校正速度，保证时间上的一致性，无法消除数据采集测量带来的误差。采用RTK高精度定位后，位置测量误差为0.1m，数据测量采集误差可以忽略。
S3：根据无人机机体1预计航行轨迹，并结合位置信息后，设计航迹的速度修正器4和航向角调整器5的参数；
通过在预计航行轨迹的切线方向上设定前向目标点，引导无人机机体1的飞行，通过前向目标点可以求解无人机机体1在每一个时刻的无人机机体1的预期航向和预期速度，规划航迹起点为(xd(t0)，yd(t0))，终点为(xd(t1)，yd(t1))，将规划航迹进行离散化，可以得到每个时刻规划位置和航向，将点(xd(t0)，yd(t0))到点(xd(t1)，yd(t1))之间的规划航迹分割为N个点，表示为(xd(k)，yd(k))，k＝1，2，…，N，需要考虑航迹特性进行合理分割，平滑部分可以均匀分割采样，转弯部分需要提高分割采样密度。
除了分割规划航迹得到时间和位置，还需要计算航向角，无人机机体1在t时刻的期望航向角α可用公式来求解：
其中，P0为无人机机体1的t时刻所在位置，坐标表示为P0(x(t),y(t))，A、B为规划轨迹上的采样点，l为前视距离，根据航迹垂点与前视距离l得到前视目标点P，前视目标点P为无人机机体1期望到达的目标点，坐标表示为P(xP,yP)，期望到达时刻为tP，ψ为无人机机体1的t时刻实际航向角。
t时刻的期望速度v可表示为
S4：根据无人机机体1调整航行速度和角度后，再对航向角进行优化设定；
为了获得更加稳定的航迹跟踪性能，利用前视目标点和期望航向角，加入控制参数，对航向角进行优化，首先根据前视距离确定前视目标点，然后加入控制项和控制参数，得到航向角导引公式如下：
其中，β为规划航迹方向，l为前视距离，ye为无人机机体1到规划路径的垂直距离，yeold为上一个控制时刻无人机机体1与规划航迹的偏差，
Kd、Ki为控制参数，通过调整控制参数，可以控制无人机机体1能够更加快速稳定的跟踪到规划航迹。
下面结合附图和具体实施对本发明进一步说明如下：
图3为速度控制示意图，根据航迹修正算法计算得到当前时刻的期望速度和实际速度，进而计算两者之间的误差。对误差、误差积分、误差微分项进行参数控制并相加，得到速度控制量，从而控制无人机机体1调整速度，使其能够快速平稳的向预期速度调整。
图4为无人机机体1速度控制系统仿真结构，当存在风力等因素带来的周期性误差、固定偏移误差时，实际位置与预期位置存在偏差，在速度控制器的作用下，无人机机体1实时调整速度，使得无人机机体1朝向降低误差的方向运动。
图5为无速度控制时距离误差。对干扰条件下无人机机体1的飞行航迹进行了仿真，无人机机体1规划航迹为直线飞行，规划飞行时间60s，规划速度为8m/s。无人机机体1实际飞行中，无人机机体1初始速度存在误差，实际位置存在干扰，其中定位误差0.1m，固定偏移误差2m，存在周期性误差最大值3m，变化周期为12.5s。当无速度控制算法时，距离误差随时间的变化如图5所示。从图中可以看出，由于速度不能及时调整，随着时间的积累，无人机机体1预期航点与实际航点之间的距离差越来越大，不能满足实际需求。
为使用速度控制算法后，距离误差随时间的变化。从图6中可以看出，除去刚开始的调整阶段，在稳定阶段，无人机机体1预期航点与实际航点之间的误差较小，约为0.2m左右，能够满足系统的设计和使用需求。
尽管参照前述实施例对本发明进行了详细的说明，对于本领域的技术人员来说，其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
Claims (4)
1.空间与时间一致性约束小型无人机高精度航迹控制方法，包括无人机机体（1）、速度控制器（2）、航迹处理器（3）、速度修正器（4）和航向角调整器（5），其特征在于：所述无人机机体（1）内部设有速度控制器（2），其速度控制器（2）包含有航迹处理模块、速度修正模块和航向角调整模块，其中航迹处理模块对应设有航迹处理器（3），速度修正模块对应设有速度修正器（4），航向角调整模块对应设有航向角调整器（5），并且航迹处理器（3）、速度修正器（4）和航向角调整器（5）均作用于速度控制器（2）用于调整无人机机体（1）的飞行轨迹、速度和角度。
2.根据权利要求1所述的空间与时间一致性约束小型无人机高精度航迹控制方法，其特征在于：所述无人机机体（1）内部设有信号发射器，其信号发射器采用无线连接方式与控制器连接。
3.根据权利要求1所述的空间与时间一致性约束小型无人机高精度航迹控制方法，其特征在于：所述无人机机体（1）的航迹处理器（3）中包含有多个虚拟轨迹节点，其中至少包含有虚拟轨迹节点A、虚拟轨迹节点B、虚拟轨迹节点C和虚拟轨迹节点D。
4.根据权利要求1-3所述的空间与时间一致性约束小型无人机高精度航迹控制方法，具体如下：S1：根据无人机机体（1）预计航行轨迹和实际位置的关系，控制速度的大小，设定速度控制器（2）。S2：根据无人机机体（1）预计航行轨迹，设定航迹模块中的航迹处理器（3）的位置信息。S3：根据无人机机体（1）预计航行轨迹，并结合设定的位置信息后，设计航迹的速度修正器（4）和航向角调整器（5）的参数。S4：根据无人机机体（1）调整航行速度和角度后，再对航向角进行优化设定。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111469890.7A CN114063653B (zh) | 2021-12-03 | 2021-12-03 | 空间与时间一致性约束小型无人机高精度航迹控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111469890.7A CN114063653B (zh) | 2021-12-03 | 2021-12-03 | 空间与时间一致性约束小型无人机高精度航迹控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114063653A true CN114063653A (zh) | 2022-02-18 |
| CN114063653B CN114063653B (zh) | 2023-12-29 |
Family
ID=80228559
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111469890.7A Active CN114063653B (zh) | 2021-12-03 | 2021-12-03 | 空间与时间一致性约束小型无人机高精度航迹控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114063653B (zh) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101692315A (zh) * | 2009-09-25 | 2010-04-07 | 民航总局空管局技术中心 | 基于实时雷达数据的高精度4d飞机航迹分析方法 |
| CN103869701A (zh) * | 2014-02-27 | 2014-06-18 | 天津大学 | 基于姿态序列解算的飞行器新型实时制导方法 |
| CN105353644A (zh) * | 2015-09-29 | 2016-02-24 | 中国人民解放军63892部队 | 基于实装数据信息挖掘的雷达目标航迹衍生系统及方法 |
| US20190049999A1 (en) * | 2017-08-10 | 2019-02-14 | Mitsubishi Electric Research Laboratories, Inc. | Model predictive control of spacecraft |
| CN111258216A (zh) * | 2018-11-30 | 2020-06-09 | 浙江工业大学 | 一种适用于四旋翼飞行器的滑模重复控制器 |
| CN113204015A (zh) * | 2021-03-31 | 2021-08-03 | 扬州瑞亿达电子科技有限公司 | 用于分布式雷达目标模拟的多无人机航迹规划方法及系统 |
| CN113688560A (zh) * | 2021-07-13 | 2021-11-23 | 中南大学 | 面向多星单侦察目标的轨道机动优化方法 |
-
2021
- 2021-12-03 CN CN202111469890.7A patent/CN114063653B/zh active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101692315A (zh) * | 2009-09-25 | 2010-04-07 | 民航总局空管局技术中心 | 基于实时雷达数据的高精度4d飞机航迹分析方法 |
| CN103869701A (zh) * | 2014-02-27 | 2014-06-18 | 天津大学 | 基于姿态序列解算的飞行器新型实时制导方法 |
| CN105353644A (zh) * | 2015-09-29 | 2016-02-24 | 中国人民解放军63892部队 | 基于实装数据信息挖掘的雷达目标航迹衍生系统及方法 |
| US20190049999A1 (en) * | 2017-08-10 | 2019-02-14 | Mitsubishi Electric Research Laboratories, Inc. | Model predictive control of spacecraft |
| CN111258216A (zh) * | 2018-11-30 | 2020-06-09 | 浙江工业大学 | 一种适用于四旋翼飞行器的滑模重复控制器 |
| CN113204015A (zh) * | 2021-03-31 | 2021-08-03 | 扬州瑞亿达电子科技有限公司 | 用于分布式雷达目标模拟的多无人机航迹规划方法及系统 |
| CN113688560A (zh) * | 2021-07-13 | 2021-11-23 | 中南大学 | 面向多星单侦察目标的轨道机动优化方法 |
Non-Patent Citations (2)
| Title |
|---|
| 管军等: "某型无人机三维空间航迹跟踪控制方法研究", 兵工学报, vol. 37, no. 01, pages 64 - 70 * |
| 薛芳侠等: "模拟与实装雷达混合仿真时空偏差控制", 系统仿真学报, vol. 25, no. 08, pages 1801 - 1805 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114063653B (zh) | 2023-12-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110398969B (zh) | 自动驾驶车辆自适应预测时域转向控制方法及装置 | |
| CN111024064B (zh) | 一种改进Sage-Husa自适应滤波的SINS/DVL组合导航方法 | |
| CN109883426B (zh) | 基于因子图的动态分配与校正多源信息融合方法 | |
| CN106197428B (zh) | 一种利用测量信息优化分布式ekf估计过程的slam方法 | |
| CN109725644A (zh) | 一种高超声速飞行器线性优化控制方法 | |
| CN111506099B (zh) | 一种无人机高度智能控制系统及方法 | |
| CN110763872A (zh) | 一种多普勒测速仪多参数在线标定方法 | |
| CN108931799A (zh) | 基于递归快速正交搜索的列车组合定位方法及系统 | |
| CN110658854B (zh) | 一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法 | |
| CN110770664A (zh) | 一种导航路径跟踪控制方法、设备、移动机器人及系统 | |
| CN111427379A (zh) | 观测驱动的多无人机协同standoff目标跟踪方法 | |
| CN116661469B (zh) | 机器人轨迹误差修正方法及系统 | |
| CN114739397A (zh) | 矿井环境运动惯性估计自适应卡尔曼滤波融合定位方法 | |
| CN115265532A (zh) | 一种用于船用组合导航中的辅助滤波方法 | |
| CN114964226A (zh) | 噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法 | |
| CN114608583A (zh) | 一种高超声速飞行器动态杆臂效应智能补偿方法 | |
| CN107977486B (zh) | 一种地球扰动引力场球冠谐模型阶次扩展方法及系统 | |
| CN109917373A (zh) | 运动补偿搜索的动平台雷达的动态规划检测前跟踪方法 | |
| CN111679269B (zh) | 一种基于变分的多雷达融合航迹状态估计方法 | |
| CN114063653B (zh) | 空间与时间一致性约束小型无人机高精度航迹控制方法 | |
| CN114111840B (zh) | 一种基于组合导航的dvl误差参数在线标定方法 | |
| CN116878510A (zh) | 基于因子图优化的多源融合室内定位方法、装置及系统 | |
| CN113778082A (zh) | 一种基于自触发机制的无人车轨迹跟踪控制方法及系统 | |
| CN113670303A (zh) | 一种基于rbf神经网络的sins/dvl组合导航流速补偿方法 | |
| KR101827955B1 (ko) | 비행체의 대기 속도 추정을 위한 정보 산출 장치 및 방법 |
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 |