CN113448348A - 基于贝塞尔曲线的无人机转向飞行路径规划方法 - Google Patents

基于贝塞尔曲线的无人机转向飞行路径规划方法 Download PDF

Info

Publication number
CN113448348A
CN113448348A CN202110632061.XA CN202110632061A CN113448348A CN 113448348 A CN113448348 A CN 113448348A CN 202110632061 A CN202110632061 A CN 202110632061A CN 113448348 A CN113448348 A CN 113448348A
Authority
CN
China
Prior art keywords
speed
target
initial
distance
flight path
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
CN202110632061.XA
Other languages
English (en)
Other versions
CN113448348B (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.)
Beijing Tt Aviation Technology Co ltd
Original Assignee
Beijing Tt Aviation Technology Co ltd
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 Beijing Tt Aviation Technology Co ltd filed Critical Beijing Tt Aviation Technology Co ltd
Priority to CN202110632061.XA priority Critical patent/CN113448348B/zh
Publication of CN113448348A publication Critical patent/CN113448348A/zh
Application granted granted Critical
Publication of CN113448348B publication Critical patent/CN113448348B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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

基于贝塞尔曲线的无人机转向飞行路径规划方法
技术领域
本发明涉及无人机路径规划技术领域，具体涉及一种基于贝塞尔曲线的无人机转向飞行路径规划方法。
背景技术
由于惯性强，空气阻力弱的原因，无人机无法在空中完成角度明确的变向，任何变向的动作，只要当前航向角度与目标航向角度的差值不为0，都需要通过划过一段圆弧的方式完成变向。以如下工况为例，假设无人机在变向之前的状态为匀速直线运动，此时速度是一个常数V1，加速度是0；经过90°变向，假设这段圆弧的速度是一个常数V2，向心加速度是一个常数a2；在变向之后，无人机同样要回到之前的状态，即速度是一个常数V1，加速度是0。在这个过程中，无人机的速度变化：从匀速直线运动的一个恒定速度V1到圆周运动的另一个恒定速度V2，再回到匀速直线运动的一个恒定速度V1。这个过程是不连续的。同理，对于无人机的加速度而言，同样是不连续的。
对运动中的无人机而言，一切速度和加速度的变化，都由改变马达的转速来完成，而马达的转速是由通过马达的电压和电流控制的，而电荷的运动是一个连续的过程。因此，马达转速的调整也必须是连续的。如果即使像前文中的例子那样规划无人机的变向，会产生两次速度和加速度不连续的情况，这种情况是无人机的马达无法执行的，导致无人机的稳定性变差。更何况实际应用中，无人机要面临的控制问题较复杂，加速度和速度都会随时变化。
针对上述问题，现有主要基于B样条基函数进行路径规划。B样条基函数是经过一系列给定点的光滑曲线，该曲线具有连续的、曲率变化均匀的特点。但在实际工业应用场景中，常有目标曲线复杂的情况，此时需要的控制点变多且需要的计算量变大。基于B样条基函数进行路径规划的方法虽然可行，但是是低效率的。另外对于B样条基函数，改变其中一个控制点，那么整条曲线都会随之改变。因此该方法同样有稳定性较差的缺点。
发明内容
本发明的目的在于提供一种基于贝塞尔曲线的无人机转向飞行路径规划方法，以解决无人机在转向过程中产生的速度与加速度的函数不连续不可导的问题，进行转向路径规划。
为实现上述目的，本发明提供了一种基于贝塞尔曲线的无人机转向飞行路径规划方法，包括：
采集无人机实际转向飞行路径数据，根据飞行动作对实际转向飞行路径进行分类；
基于贝塞尔曲线对实际转向飞行路径进行规划，生成目标转向飞行路径，对实际转向飞行路径进行修正。
优选的，无人机的飞行动作包括直线飞行与曲线飞行，将直线飞行与曲线飞行动作结合，确定无人机实际转向飞行路径分类为：直线飞行路径、先直线飞行后曲线飞行路径、先曲线飞行后直线飞行路径、先曲线飞行中间直线飞行后曲线飞行路径、两段连接的曲线飞行路径。
优选的，根据无人机目标初始航行节点与目标转向航行节点之间的距离、目标最终航行节点与目标转向航行节点之间的距离确定目标安全半径，并以目标转向航行节点为圆心，确定规划曲线的目标安全范围；根据目标初始航行节点、目标最终航行节点分别与目标转向航行节点之间的连线与目标安全范围的交点，以及目标初始航行节点、目标转向航行节点、目标最终航行节点，确定规划所需的贝塞尔曲线，生成目标转向飞行路径。
优选的，根据目标初始航行节点、目标最终航行节点分别与目标转向航行节点之间的连线与目标安全范围的交点，以及目标初始航行节点、目标转向航行节点、目标最终航行节点，确定规划所需的贝塞尔曲线为：
p(t)＝P0B0,4(t)+P1B1,4(t)+P2B2,4(t)+P3B3,4(t)+P4B4,4(t)
＝(1-t)4P0+4t(1-t)3P1+6t2(1-t)2P2+4t3(1-t)P3+t4P4
其中，P0、P1、P2、P3、P4表示规划贝塞尔曲线的控制点，B0,4(t)、B1,4(t)、B2,4(t)、B3,4(t)、B4,4(t)为对应的伯恩斯坦多项式。
优选的，若确定的规划所需的贝塞尔曲线与目标安全范围不相切，修正贝塞尔曲线，使修正后的贝塞尔曲线与目标安全范围相切。
优选的，若为直线飞行路径，则目标初始航行节点、目标转向航行节点、目标最终航行节点在同一水平度上，确定目标安全半径为0，目标初始航行节点、目标转向航行节点之间的距离为目标安全范围，根据目标初始航行节点、目标转向航行节点、目标最终航行节点确定的直线为相应规划的目标转向飞行路径。
优选的，若为先直线飞行后曲线飞行路径，则根据确定的贝塞尔曲线，确定入弧航行节点，计算目标初始航行节点与入弧航行节点之间的距离；根据目标初始航行节点与入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围；
若为先曲线飞行后直线飞行路径，则根据确定的贝塞尔曲线，确定入弧航行节点，计算目标转向航行节点与入弧航行节点之间的距离；根据目标转向航行节点与入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围；
若为先曲线飞行中间直线飞行后曲线飞行路径，则根据确定的贝塞尔曲线，计算两段贝塞尔曲线的入弧航行节点之间的距离；根据计算两段贝塞尔曲线的入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围；
若为曲线飞行路径，则根据确定的两段贝塞尔曲线的长度，确定目标安全范围。
优选的，对转向飞行路径的任意航行节点，计算受下一个航行节点限制的当前航行节点的初始的最大速度；根据初速度、末速度、初始的最大速度，判断无人机的状态，修正最大目标速度，预测变速所需的目标航行路程与目标航行时间，规划速度、加速度与航行时间的关系，进行路径时间规划。
优选的，若初速度＝末速度＜初始的最大速度，将初速度加速到初始的最大速度所需距离与初始的最大速度减速到末速度所需距离的和，与确定的目标安全范围进行比较：
若初速度加速到初始的最大速度所需距离与初始的最大速度减速到末速度所需距离的和超出目标安全范围，根据初速度与初始的最大速度对最大目标速度进行修正，使初速度加速到修正的最大目标速度所需距离与修正的最大目标速度减速到末速度所需距离的和未超出目标安全范围；
若初始的最大速度＜末速度＜初速度或初始的最大速度＜初速度＜末速度，将初速度减速至初始的最大速度的距离与确定的目标安全范围进行比较，若初速度减速至初始的最大速度的距离超出目标安全范围，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度减速至修正的最大目标速度所需距离未超出目标安全范围；
若末速度＜初始的最大速度＜初速度，将初速度减速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和、及初速度减速至末速度的距离分别与确定的目标安全范围进行比较：
若初速度减速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和超出目标安全范围，且初速度减速至末速度的距离未超出目标安全范围，且末速度近似0，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度减速至修正的最大目标速度的距离与修正的最大目标速度减速至末速度的距离之和未超出目标安全范围；
若末速度＜初速度＜初始的最大速度，将初速度加速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和、及初速度减速至末速度的距离分别与确定的目标安全范围进行比较：
若初速度加速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和超出目标安全范围、且初速度减速至末速度的距离未超出目标安全范围，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度加速至修正的最大目标速度的距离与修正的最大目标速度减速至末速度的距离之和未超出目标安全范围。
优选的，当前航行节点为转向航行节点时，若初角速度＝末角速度＜初始的最大目标角速度，若初角速度加速至初始的最大目标角速度的对应的角速度变化值与初始的最大目标角速度减速至末角速度对应的角速度变化值之和超出初始航向角与最终航向角之间的差值，则根据初角速度与初始的最大目标角速度对最大目标角速度进行修正，使初角速度加速至修正后的最大目标角速度的对应的角速度变化值与修正后的最大目标角速度减速至末角速度对应的角速度变化值之和超出初始航向角与最终航向角之间的差值。
本发明方法具有如下优点：
本发明提供了一种基于贝塞尔曲线的无人机转向飞行路径规划方法，以解决无人机在转向过程中产生的速度与加速度的函数不连续不可导的问题，进行转向路径规划。具体为，将直线飞行与曲线飞行动作结合，确定无人机实际转向飞行路径分类为：直线飞行路径、先直线飞行后曲线飞行路径、先曲线飞行后直线飞行路径、先曲线飞行中间直线飞行后曲线飞行路径、两段连接的曲线飞行路径。然后通过确定规划曲线的目标安全范围、控制点，规划贝塞尔曲线，进行向心加速度规划；然后根据初速度、末速度、初始的最大速度，判断无人机的状态，预测变速所需的目标航行路程与目标航行时间，规划速度、加速度与航行时间的关系，进行路径时间规划。该路径规划方法解决了在转向过程中产生的速度与加速度的函数不连续不可导的技术难点，具有计算量小，稳定性高的优点。
附图说明
图1为转角的路径规划原理；
图2为本发明的无人机转向路径规划方法总体原理图；
图3为本发明的无人机转向路径规划方法整体流程图；
图4为四阶贝塞尔曲线规划原理图。
具体实施方式
以下实施例用于说明本发明，但不用来限制本发明的范围。
对于无人机转向飞行路径的规划，在改变速度和方向的过程中，如图1中，使无人机自A点出发，经过B点，到达C点，最理想的条件为：使无人机自A点飞到B点，在逼近B点的过程中减速，在到达B点的时候速度降为零，从静止状态开始加速，自B点飞到C点。但该
理想条件的实现过程是非常低效的，2要避免先减速到零再加速的过程，因此需要在B点周围确定安全范围，只要无人机在路径上能够经过这个范围，就视为路过了B点。因此，理想的规划路径，是一条与B点确定的安全范围区域相切的弧线。因此，本实施例中考虑采用贝塞尔曲线进行路径规划，给定空间n+1个点的位置矢量Pi,i＝0，1，2，...，n，n次贝塞尔曲线表示为：
Figure BDA0003104076980000061
贝塞尔函数中作为参数项的伯恩斯坦多项式表示为：
Figure BDA0003104076980000062
如图2、图3所示，本发明提供的基于贝塞尔曲线的无人机转向飞行路径规划方法，具体为：
(1)采集无人机实际转向飞行路径数据，根据飞行动作对实际转向飞行路径进行分类：无人机的飞行动作包括直线飞行与曲线飞行，将直线飞行与曲线飞行动作结合，确定无人机实际转向飞行路径分类为：直线飞行路径、先直线飞行后曲线飞行路径、先曲线飞行后直线飞行路径、先曲线飞行中间直线飞行后曲线飞行路径、曲线飞行路径。
(2)基于贝塞尔曲线对实际转向飞行路径进行规划，生成目标转向飞行路径，对实际转向飞行路径进行修正，确定目标规划路径：
①根据无人机目标初始航行节点与目标转向航行节点之间的距离、目标最终航行节点与目标转向航行节点之间的距离确定目标安全半径，并以目标转向航行节点为圆心，确定规划曲线的目标安全范围；根据目标初始航行节点、目标最终航行节点分别与目标转向航行节点之间的连线与目标安全范围的交点，以及目标初始航行节点、目标转向航行节点、目标最终航行节点，确定规划所需的贝塞尔曲线为：
p(t)＝P0B0,4(t)+P1B1,4(t)+P2B2,4(t)+P3B3,4(t)+P4B4,4(t)
＝(1-t)4P0+4t(1-t)3P1+6t2(1-t)2P2+4t3(1-t)P3+t4P4
其中，P0、P1、P2、P3、P4为规划贝塞尔曲线的控制点，B0,4(t)、B1,4(t)、B2,4(t)、B3,4(t)、B4,4(t)为对应的伯恩斯坦多项式。
对于贝塞尔曲线的确定如图4所示，图中点O代表目标初始航行节点、点B代表目标最终航行节点、点A代表目标转向航行节点，点M、N表示目标最终航行节点分别与目标转向航行节点之间的连线与目标安全范围的交点。对于目标安全半径，本实施例中规定为如果目标安全半径大于min(0.25OA,0.25AB)，更新安全半径为之前的一半；然后，确定点C、D的位置，使AC＝AD＝min(0.5OA,0.5AB)；确认点M、N的位置，为目标安全范围与OA、AB的交点，则确定点C、M、N、A、D为规划四阶贝塞尔曲线的五个控制点，可确定对应的贝塞尔曲线。
②若确定的规划所需的贝塞尔曲线与目标安全范围至少有两交点，将目标初始航行节点、目标最终航行节点分别与目标转向航行节点之间的连线与目标安全范围的交点外延，修正贝塞尔曲线，使修正后的贝塞尔曲线与目标安全范围相切。本实施例中将点M外延至现有C、M的平均值，将点N外延至现有D、N的平均值，重新根据C、M、N、A、D修正贝塞尔曲线。
若确定的规划所需的贝塞尔曲线与目标安全范围不相切，修正贝塞尔曲线，使修正后的贝塞尔曲线与目标安全范围相切。本实施例中将点C收缩至现有C,M的平均值，将点D收缩至现有D,N的平均值，重新根据C、M、N、A、D修正贝塞尔曲线。
③对于目标安全范围的确定，若为直线飞行路径，则目标初始航行节点、目标转向航行节点、目标最终航行节点在同一水平度上，确定目标安全半径为0，目标初始航行节点、目标转向航行节点之间的距离为目标安全范围，根据目标初始航行节点、目标转向航行节点、目标最终航行节点确定的直线为相应规划的目标转向飞行路径。
若为先直线飞行后曲线飞行路径，则根据确定的贝塞尔曲线，确定入弧航行节点，计算目标初始航行节点与入弧航行节点之间的距离；根据目标初始航行节点与入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围；本实施例中具体将目标初始航行节点与入弧航行节点之间的距离+1/2贝塞尔曲线的长度，确定目标安全范围。
若为先曲线飞行后直线飞行路径，则根据确定的贝塞尔曲线，确定入弧航行节点，计算目标转向航行节点与入弧航行节点之间的距离；根据目标转向航行节点与入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围。本实施例中具体将目标转向航行节点与入弧航行节点之间的距离+1/2贝塞尔曲线的长度，确定目标安全范围。
若为先曲线飞行中间直线飞行后曲线飞行路径，则根据确定的贝塞尔曲线，计算两段贝塞尔曲线的入弧航行节点之间的距离；根据计算两段贝塞尔曲线的入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围；本实施例中具体将两段贝塞尔曲线的入弧航行节点之间的距离+1/2贝塞尔曲线的长度，确定目标安全范围。
若为曲线飞行路径，则两段贝塞尔曲线相连，根据确定的两段贝塞尔曲线的长度，确定目标安全范围。本实施例中将两段贝塞尔曲线长度的一半相加确定目标安全范围。
④在路径规划的过程中，对任意航行节点，需要对末速度进行调整，使无人机在这个末速度的条件下可以顺利通过所有航行节点。因此，对转向飞行路径的任意航行节点，进一步计算受下一个航行节点限制的当前航行节点的初始的最大速度；根据初速度、末速度、初始的最大速度，判断无人机的状态，修正最大目标速度，预测变速所需的目标航行路程与目标航行时间，规划速度、加速度与航行时间的关系，进行路径时间规划。即：
计算末速度和初速度的差，为速度的变化量：
δV＝Vend-Vstart
则位移s、速度v、加速度a、加加速度
Figure BDA0003104076980000091
关于航行时间t的公式：
Figure BDA0003104076980000092
Figure BDA0003104076980000093
Figure BDA0003104076980000094
加速度a存在贝塞尔曲线理论计算的最大值atarget，加加速度
Figure BDA0003104076980000095
是一个定值
Figure BDA0003104076980000096
计算加加速时间，即从加速度的最小值0加加速到理论的最大值atarget，不考虑加速度的正负。
Figure BDA0003104076980000097
假设匀加速运动，即加速度一直保持在atarget，假设加速时间是t0，计算最小速度变化量
min(δV)作为比较的临界值。
min(δV)＝atarget*ttarget
若δV≤min(δV)，说明加速度没有一开始就保持在理论设计的最大值atarget，因此说明存在加加速过程和减加速过程。相反，如果δV＞min(δV)，说明运动过程不仅有加加速段和减加速段，还有匀加速段。
在最小速度变化量min(δV)的计算过程中，速度V始终按照最大值atarget的加速度在[0,ttarget]的范围上加速，最终速度的变化量达到min(δV)，即：
min(δV)＝atargetttarget
在存在加加速的过程中，速度V始终按照
Figure BDA0003104076980000098
的加加速度在[0,ttarget]，此时加速度a是一个关于加加速度
Figure BDA0003104076980000099
的表达式，即：
Figure BDA00031040769800000910
此时速度V是关于加速度a(t)在时间[0,ttarget]上的积分，加速度持续上升，直到到达最大值atarget，此时有：
Figure BDA0003104076980000101
因此，说明在加加速的过程结束之后，速度V最多只能达到min(δV)的一半，因此在经过同样的减加速过程之后，速度V只能小于等于min(δV)。
然而，无人机并不是总能够持续加加速的过程直到加速度到达最大值atarget，因此直接把加加速时间t0假设为ttarget是不合适的。加加速时间t0可以通过公式计算，假设这段时间内的加速度变化量是δa，即：
Figure BDA0003104076980000102
Figure BDA0003104076980000103
Figure BDA0003104076980000104
因此，存在如下几种情况以及对应的公式是：
①、δV＞0，δV≤min(δV)
在加加速段，起始速度是Vstart，无人机按照规定的加加速度
Figure BDA0003104076980000105
在时间范围[0,t0]内加速。
Figure BDA0003104076980000106
Figure BDA0003104076980000107
在减加速段，
Figure BDA0003104076980000108
②、δV＞0，δV＞min(δV).
在加加速段，无人机的加加速时间t0在[0,ttarget]范围内，以
Figure BDA0003104076980000111
加加速，直到加速度达到atarget。因此有
Figure BDA0003104076980000112
Figure BDA0003104076980000113
在匀加速段，加速时间即是速度超过min(δV)的时间，因此匀加速时间t1可求，在这段时间内的速度和距离可求。
Figure BDA0003104076980000114
V1＝Vstart+atargett1
Figure BDA0003104076980000115
在减加速段，减加速时间t2等同加加速时间t0，距离S2表示为:
Figure BDA0003104076980000116
③、至于δV＜0，δV≤min(δV)与δV＜0，δV＞min(δV)时，为减速运动，加速度方向是相反的，与前两种情况雷同，本申请不在具体描述。
若初速度＝末速度＜初始的最大速度，将初速度加速到初始的最大速度所需距离与初始的最大速度减速到末速度所需距离的和，与确定的目标安全范围进行比较：
若初速度加速到初始的最大速度所需距离与初始的最大速度减速到末速度所需距离的和超出目标安全范围，即无人机不能达到初始的最大速度，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度加速到修正的最大目标速度所需距离与修正的最大目标速度减速到末速度所需距离的和未超出目标安全范围；本实施例中采用二分法修正，将最大目标速度修正为初速度与初始的最大速度之和的一半。若初速度加速到初始的最大速度所需距离与初始的最大速度减速到末速度所需距离的和未超出目标安全范围，则表示无人机能够加速到初始的最大速度，并在初始的最大速度保持匀速飞行一段时间，然后进入减速阶段。
若初始的最大速度＜末速度＜初速度或初始的最大速度＜初速度＜末速度，将初速度减速至初始的最大速度的距离与确定的目标安全范围进行比较，若初速度减速至初始的最大速度的距离超出目标安全范围，即无人机不能达到初始的最大速度，需要进行速度修正，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度减速至修正的最大目标速度所需距离未超出目标安全范围；本实施例中采用二分法修正，将最大目标速度修正为初速度与初始的最大速度之和的一半。
若末速度＜初始的最大速度＜初速度，将初速度减速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和、及初速度减速至末速度的距离分别与确定的目标安全范围进行比较：
若初速度减速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和超出目标安全范围，且初速度减速至末速度的距离未超出目标安全范围，且末速度近似0，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度减速至修正的最大目标速度的距离与修正的最大目标速度减速至末速度的距离之和未超出目标安全范围；本实施例中采用二分法修正，将最大目标速度修正为初速度与初始的最大速度之和的一半。
若末速度＜初速度＜初始的最大速度，将初速度加速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和、及初速度减速至末速度的距离分别与确定的目标安全范围进行比较：
若初速度加速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和超出目标安全范围、且初速度减速至末速度的距离未超出目标安全范围，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度加速至修正的最大目标速度的距离与修正的最大目标速度减速至末速度的距离之和未超出目标安全范围。本实施例中采用二分法修正，将最大目标速度修正为初速度与初始的最大速度之和的一半。
当前航行节点为转向航行节点时，若初角速度＝末角速度＜初始的最大目标角速度，若初角速度加速至初始的最大目标角速度的对应的角速度变化值与初始的最大目标角速度减速至末角速度对应的角速度变化值之和超出初始航向角与最终航向角之间的差值，则根据初角速度与初始的最大目标角速度对最大目标角速度进行修正，使初角速度加速至修正后的最大目标角速度的对应的角速度变化值与修正后的最大目标角速度减速至末角速度对应的角速度变化值之和超出初始航向角与最终航向角之间的差值。
(3)判断当前无人机状态，计算已经飞过的航行节点的距离，确定当前无人机所处航行节点的区间位置，执行上述路径规划过程。
综上，本发明针对无人机在转向过程中产生的速度与加速度的函数不连续不可导的问题，基于贝塞尔曲线提供了一种无人机转向飞行路径规划方法，进行转向路径规划。通过将直线飞行与曲线飞行动作结合，确定无人机实际转向飞行路径分类为：直线飞行路径、先直线飞行后曲线飞行路径、先曲线飞行后直线飞行路径、先曲线飞行中间直线飞行后曲线飞行路径、曲线飞行路径；然后通过确定规划曲线的目标安全范围、控制点，规划贝塞尔曲线，进行向心加速度规划；然后根据初速度、末速度、初始的最大速度，判断无人机的状态，预测变速所需的目标航行路程与目标航行时间，规划速度、加速度与航行时间的关系，进行路径时间规划。该路径规划方法解决了在转向过程中产生的速度与加速度的函数不连续不可导的技术难点，具有计算量小，稳定性高的优点。
虽然，上文中已经用一般性说明及具体实施例对本发明作了详尽的描述，但在本发明基础上，可以对之作一些修改或改进，这对本领域技术人员而言是显而易见的。因此，在不偏离本发明精神的基础上所做的这些修改或改进，均属于本发明要求保护的范围。

Claims (10)

1.一种基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于，包括：
采集无人机实际转向飞行路径数据，根据飞行动作对实际转向飞行路径进行分类；
基于贝塞尔曲线对实际转向飞行路径进行规划，生成目标转向飞行路径，对实际转向飞行路径进行修正。
2.根据权利要求1所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于，无人机的飞行动作包括直线飞行与曲线飞行，将直线飞行与曲线飞行动作结合，确定无人机实际转向飞行路径分类为：直线飞行路径、先直线飞行后曲线飞行路径、先曲线飞行后直线飞行路径、先曲线飞行中间直线飞行后曲线飞行路径、两段连接的曲线飞行路径。
3.根据权利要求2所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于，根据无人机目标初始航行节点与目标转向航行节点之间的距离、目标最终航行节点与目标转向航行节点之间的距离确定目标安全半径，并以目标转向航行节点为圆心，确定规划曲线的目标安全范围；根据目标初始航行节点、目标最终航行节点分别与目标转向航行节点之间的连线与目标安全范围的交点，以及目标初始航行节点、目标转向航行节点、目标最终航行节点，确定规划所需的贝塞尔曲线，生成目标转向飞行路径。
4.根据权利要求3所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于，根据目标初始航行节点、目标最终航行节点分别与目标转向航行节点之间的连线与目标安全范围的交点，以及目标初始航行节点、目标转向航行节点、目标最终航行节点，确定规划所需的贝塞尔曲线为：
p(t)＝P0B0,4(t)+P1B1,4(t)+P2B2,4(t)+P3B3,4(t)+P4B4,4(t)
＝(1-t)4P0+4t(1-t)3P1+6t2(1-t)2P2+4t3(1-t)P3+t4P4
其中，P0、P1、P2、P3、P4表示规划贝塞尔曲线的控制点，B0,4(t)、B1,4(t)、B2,4(t)、B3,4(t)、B4,4(t)为对应的伯恩斯坦多项式。
5.根据权利要求3所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于，若确定的规划所需的贝塞尔曲线与目标安全范围不相切，修正贝塞尔曲线，使修正后的贝塞尔曲线与目标安全范围相切。
6.根据权利要求3所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于，若为直线飞行路径，则目标初始航行节点、目标转向航行节点、目标最终航行节点在同一水平度上，确定目标安全半径为0，目标初始航行节点、目标转向航行节点之间的距离为目标安全范围，根据目标初始航行节点、目标转向航行节点、目标最终航行节点确定的直线为相应规划的目标转向飞行路径。
7.根据权利要求3或6所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于：
若为先直线飞行后曲线飞行路径，则根据确定的贝塞尔曲线，确定入弧航行节点，计算目标初始航行节点与入弧航行节点之间的距离；根据目标初始航行节点与入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围；
若为先曲线飞行后直线飞行路径，则根据确定的贝塞尔曲线，确定入弧航行节点，计算目标转向航行节点与入弧航行节点之间的距离；根据目标转向航行节点与入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围；
若为先曲线飞行中间直线飞行后曲线飞行路径，则根据确定的贝塞尔曲线，计算两段贝塞尔曲线的入弧航行节点之间的距离；根据计算两段贝塞尔曲线的入弧航行节点之间的距离、以及贝塞尔曲线的长度，确定目标安全范围；
若为曲线飞行路径，则根据确定的两段贝塞尔曲线的长度，确定目标安全范围。
8.根据权利要求3所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于，对转向飞行路径的任意航行节点，计算受下一个航行节点限制的当前航行节点的初始的最大速度；根据初速度、末速度、初始的最大速度，判断无人机的状态，修正最大目标速度，预测变速所需的目标航行路程与目标航行时间，规划速度、加速度与航行时间的关系，进行路径时间规划。
9.根据权利要求8所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于：
若初速度＝末速度＜初始的最大速度，将初速度加速到初始的最大速度所需距离与初始的最大速度减速到末速度所需距离的和，与确定的目标安全范围进行比较：
若初速度加速到初始的最大速度所需距离与初始的最大速度减速到末速度所需距离的和超出目标安全范围，根据初速度与初始的最大速度对最大目标速度进行修正，使初速度加速到修正的最大目标速度所需距离与修正的最大目标速度减速到末速度所需距离的和未超出目标安全范围；
若初始的最大速度＜末速度＜初速度或初始的最大速度＜初速度＜末速度，将初速度减速至初始的最大速度的距离与确定的目标安全范围进行比较，若初速度减速至初始的最大速度的距离超出目标安全范围，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度减速至修正的最大目标速度所需距离未超出目标安全范围；
若末速度＜初始的最大速度＜初速度，将初速度减速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和、及初速度减速至末速度的距离分别与确定的目标安全范围进行比较：
若初速度减速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和超出目标安全范围，且初速度减速至末速度的距离未超出目标安全范围，且末速度近似0，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度减速至修正的最大目标速度的距离与修正的最大目标速度减速至末速度的距离之和未超出目标安全范围；
若末速度＜初速度＜初始的最大速度，将初速度加速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和、及初速度减速至末速度的距离分别与确定的目标安全范围进行比较：
若初速度加速至初始的最大速度的距离与初始的最大速度减速至末速度的距离之和超出目标安全范围、且初速度减速至末速度的距离未超出目标安全范围，则根据初速度与初始的最大速度对最大目标速度进行修正，使初速度加速至修正的最大目标速度的距离与修正的最大目标速度减速至末速度的距离之和未超出目标安全范围。
10.根据权利要求8所述的基于贝塞尔曲线的无人机转向飞行路径规划方法，其特征在于：当前航行节点为转向航行节点时，若初角速度＝末角速度＜初始的最大目标角速度，若初角速度加速至初始的最大目标角速度的对应的角速度变化值与初始的最大目标角速度减速至末角速度对应的角速度变化值之和超出初始航向角与最终航向角之间的差值，则根据初角速度与初始的最大目标角速度对最大目标角速度进行修正，使初角速度加速至修正后的最大目标角速度的对应的角速度变化值与修正后的最大目标角速度减速至末角速度对应的角速度变化值之和超出初始航向角与最终航向角之间的差值。
CN202110632061.XA 2021-06-07 2021-06-07 基于贝塞尔曲线的无人机转向飞行路径规划方法 Active CN113448348B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110632061.XA CN113448348B (zh) 2021-06-07 2021-06-07 基于贝塞尔曲线的无人机转向飞行路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110632061.XA CN113448348B (zh) 2021-06-07 2021-06-07 基于贝塞尔曲线的无人机转向飞行路径规划方法

Publications (2)

Publication Number Publication Date
CN113448348A true CN113448348A (zh) 2021-09-28
CN113448348B CN113448348B (zh) 2023-02-17

Family

ID=77811035

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110632061.XA Active CN113448348B (zh) 2021-06-07 2021-06-07 基于贝塞尔曲线的无人机转向飞行路径规划方法

Country Status (1)

Country Link
CN (1) CN113448348B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114296398A (zh) * 2021-11-16 2022-04-08 中南大学 一种用于激光切割的高速高精度插补方法

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060015247A1 (en) * 2004-07-07 2006-01-19 The Boeing Company Bezier curve flightpath guidance using moving waypoints
CN106275066A (zh) * 2016-08-30 2017-01-04 北京智行者科技有限公司 一种智能车的转向控制方法及装置
CN106325294A (zh) * 2016-08-22 2017-01-11 上海交通大学 基于贝塞尔曲线转接的无人机轨迹平滑方法
CN106909144A (zh) * 2017-01-22 2017-06-30 无锡卡尔曼导航技术有限公司 用于农机无人驾驶的田间避障路径规划及其控制方法
US20170213466A1 (en) * 2016-01-26 2017-07-27 Northrop Grumman Systems Corporation Maneuver planning with higher order rational bezier curves
CN108204814A (zh) * 2016-12-20 2018-06-26 南京理工大学 无人机三维场景路径导航平台及其三维改进路径规划方法
CN108490970A (zh) * 2018-03-19 2018-09-04 广州亿航智能技术有限公司 预测无人机飞行轨迹方法、装置和储存介质
CN108563243A (zh) * 2018-06-28 2018-09-21 西北工业大学 一种基于改进rrt算法的无人机航迹规划方法
CN111338349A (zh) * 2020-03-09 2020-06-26 兰剑智能科技股份有限公司 Agv的贝塞尔曲线控制方法及系统
CN112223290A (zh) * 2020-10-21 2021-01-15 哈工大机器人（合肥）国际创新研究院 一种关节空间连续点轨迹过渡方法及装置
CN112506219A (zh) * 2020-11-27 2021-03-16 佛山市墨纳森智能科技有限公司 一种智能交通监管无人机航迹规划方法、系统及可读存储介质

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060015247A1 (en) * 2004-07-07 2006-01-19 The Boeing Company Bezier curve flightpath guidance using moving waypoints
US20170213466A1 (en) * 2016-01-26 2017-07-27 Northrop Grumman Systems Corporation Maneuver planning with higher order rational bezier curves
CN106325294A (zh) * 2016-08-22 2017-01-11 上海交通大学 基于贝塞尔曲线转接的无人机轨迹平滑方法
CN106275066A (zh) * 2016-08-30 2017-01-04 北京智行者科技有限公司 一种智能车的转向控制方法及装置
CN108204814A (zh) * 2016-12-20 2018-06-26 南京理工大学 无人机三维场景路径导航平台及其三维改进路径规划方法
CN106909144A (zh) * 2017-01-22 2017-06-30 无锡卡尔曼导航技术有限公司 用于农机无人驾驶的田间避障路径规划及其控制方法
CN108490970A (zh) * 2018-03-19 2018-09-04 广州亿航智能技术有限公司 预测无人机飞行轨迹方法、装置和储存介质
CN108563243A (zh) * 2018-06-28 2018-09-21 西北工业大学 一种基于改进rrt算法的无人机航迹规划方法
CN111338349A (zh) * 2020-03-09 2020-06-26 兰剑智能科技股份有限公司 Agv的贝塞尔曲线控制方法及系统
CN112223290A (zh) * 2020-10-21 2021-01-15 哈工大机器人（合肥）国际创新研究院 一种关节空间连续点轨迹过渡方法及装置
CN112506219A (zh) * 2020-11-27 2021-03-16 佛山市墨纳森智能科技有限公司 一种智能交通监管无人机航迹规划方法、系统及可读存储介质

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
JUNTONG QI ET AL.: "Formation Trajectory Planning and Realization of multi-UAVs", 《PROCEEDINGS OF THE 2018 13TH WORLD CONGRESS ON INTELLIGENT CONTROL AND AUTOMATION》 *
王晓芳 等: "基于分段贝塞尔曲线的多导弹协同航迹规划", 《系统工程与电子技术》 *
陈成 等: "基于四阶贝塞尔曲线的无人车可行轨迹规划", 《自动化学报》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114296398A (zh) * 2021-11-16 2022-04-08 中南大学 一种用于激光切割的高速高精度插补方法
CN114296398B (zh) * 2021-11-16 2024-04-05 中南大学 一种用于激光切割的高速高精度插补方法

Also Published As

Publication number Publication date
CN113448348B (zh) 2023-02-17

Similar Documents

Publication Publication Date Title
CN107702716B (zh) 一种无人驾驶路径规划方法、系统和装置
CN110320933B (zh) 一种巡航任务下无人机避障运动规划方法
McGee et al. Optimal path planning in a constant wind with a bounded turning rate
CN112965443B (zh) 一种裁床拐角轨迹跟踪高精度插值控制方法
CN109324620A (zh) 基于车道线平行偏移进行避障及超车的动态轨迹规划方法
CN111806467A (zh) 一种基于车辆行驶规律的变速动态换道轨迹规划方法
CN112925342B (zh) 基于改进相互速度障碍法的无人机动态避障方法
CN113050646A (zh) 一种用于室内移动机器人动态环境路径规划方法
CN113448348B (zh) 基于贝塞尔曲线的无人机转向飞行路径规划方法
CN107515611B (zh) 一种叠加型混合正弦机动路径规划方法
CN111552296B (zh) 一种基于弯曲柱坐标系的局部平滑轨迹规划方法
CN110789530B (zh) 一种四轮独立转向-独立驱动车辆轨迹跟踪方法和系统
CN111158318A (zh) 一种非对称性四次曲线柔性加减速规划方法
CN111739342A (zh) 用于避让侧前方车辆的方法、装置、介质以及车辆
CN113311783A (zh) 一种s型运动曲线规划方法及系统
Qinpeng et al. Path tracking control of wheeled mobile robot based on improved pure pursuit algorithm
CN111881580A (zh) 一种无人船规避障碍物的运动规划方法
CN114852085A (zh) 基于路权侵入度的车辆自动驾驶轨迹规划方法
CN112489500B (zh) 一种基于几何视景模型的短期飞行冲突检测与避免方法
CN115963782A (zh) 一种基于初始加速度不为零的s型速度规划方法
JP3204042B2 (ja) ロボットの軌道の生成装置
CN112129291B (zh) 一种基于Bezier曲线的固定翼无人机航迹优化方法
CN113625703A (zh) 一种动态路径跟踪方法
Chen et al. Research and application of improved pure pursuit algorithm in low-speed driverless vehicle system
CN113885501B (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