CN107515617A - 一种固定翼无人机航线平滑切换控制方法 - Google Patents
一种固定翼无人机航线平滑切换控制方法 Download PDFInfo
- Publication number
- CN107515617A CN107515617A CN201710694409.1A CN201710694409A CN107515617A CN 107515617 A CN107515617 A CN 107515617A CN 201710694409 A CN201710694409 A CN 201710694409A CN 107515617 A CN107515617 A CN 107515617A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- msup
- unmanned plane
- mfrac
- 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 22
- 230000007704 transition Effects 0.000 claims abstract description 17
- 230000010006 flight Effects 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 238000000205 computational method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
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
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种固定翼无人机航点平滑切换的控制方法,采用“直线‑圆形‑直线”的切换方式来控制航线切换,其中引导无人机从源航程点飞往目标航程点为直线方式,引导无人机从目标航程点飞往目标航程点下一航点为直线,两个航线之间过渡采用圆盘旋控制方式,使得两条航线之间的切换过程自然,平滑,避免无人机因调整位置而浪费飞行时间,提高有效任务时间。
Description
技术领域
本发明涉及无人机领域,更具体地说,是指一种固定翼无人机航线平滑切换的控制方法。
背景技术
无人机在空中的飞行是依照预定的航线进行,而航线一般是由多个利用线段连接起来的航点组成,飞行过程中,无人机依照航点顺序进行切换,从而实现预定轨迹飞行。
现有的航点切换方式为无人机飞至该点上空后,再将目标点切换为下一航点,由于固定翼无人机转弯半径的限制,这种方式会出现航迹震荡,其轨迹形状见附图1。该方法会增加无人机调整姿态的时间,并缩短无人机可执行任务的时长。
还有一种切换航点的方法,它是在无人机到达目标航点之前,给定固定的副翼控制量,控制无人机进行盘旋,之后再将航点切换为下一航点。该方法的缺点是飞行中两条航线衔接过渡不平滑,并且容易受到侧风干扰,影响任务的执行精度。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种固定翼无人机航点平滑切换的控制方法,实现无人机航点切换过程的平滑、快速,缩短飞机调整姿态的时间,增加无人机执行任务的有效时长,并能在侧风干扰的情况下保证无人机按期望的航迹进行飞行。
技术方案
一种固定翼无人机航点平滑切换的控制方法,其特征在于步骤如下:
步骤1:获得固定翼无人机当前飞行的航线段中的源航程点纬度、经度坐标(Bs,Ls),目标航程点纬度、经度坐标(Bt,Lt)及目标航程点下一航点纬度、经度坐标(Bn,Ln),并根据卫星定位结果获得无人机的纬度、经度坐标(Bu,Lu);
步骤2:根据高斯坐标转换公式,将步骤1中的四个位置坐标依次转换为直角坐标(Xs,Ys),(Xt,Yt),(Xn,Yn),(Xu,Yu);由前三点位置,依据以下公式计算源航程点指向目标航程点的方位角θ1:
若(Yt-Ys)≥0
若(Yt-Ys)<0
同理计算目标航程点下一航点指向目标航程点的方位角θ2以及目标航程点指向目标航程点下一航点的方位角θ3:
若(Yt-Yn)≥0
若(Yt-Yn)<0
若(Yn-Yt)≥0
若(Yn-Yt)<0
步骤3:由步骤2中计算出的θ1和θ2,根据以下公式确定两条航线之间的夹角θ:
根据以下坐标转换公式,确定两条航线的过渡方向:
D=(Ys-Yt)·cos(θ3)-(Xs-Xt)·sin(θ3)
根据以下公式,计算出虚拟的过渡盘旋中心点位置(Xv,Yv):
Xv=Xt+cos(θl)·L
Yv=Yt+sin(θl)·L
若
若
其中,R为无人机的最小盘旋半径,该数值可以在无人机性能手册上查到;若θ<10,则不再利用上面的公式进行计算,而直接将目标航程点设为虚拟的过渡盘旋中心点位置;
步骤4:引导无人机从源航程点飞往目标航程点:无人机飞行的期望航向根据以下公式计算:
Dd=(Yu-Yt)·cos(θ1)-(Xu-Xt)·sin(θ1)
其中,Kp为比例控制系数,Ki为积分控制系数,Dd为航迹偏差量;将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行;
在引导过程中实时计算飞机至目标航程点的距离St:
步骤5:实时比较无人机距目标航程点的距离与步骤3中所提无人机最小转弯半径,其计算公式如下:
ΔS=St-R-C
其中,C为一个距离常数,取值为无人机2秒钟所能飞行的距离,用于让无人机提前建立倾斜姿态;若ΔS<0,则进入步骤6,否则继续用步骤4的方式引导无人机飞行;
步骤6:若步骤3中所得的过渡方向为顺时针,则引导无人机进入以虚拟中心点为圆心,以R为盘旋半径的顺时针圆形盘旋轨迹,计算无人机到虚拟圆心的距离Dv,方位角θv:
无人机飞行的期望航向根据以下公式计算:
D′d=(Dv-R)
若步骤3中所得的过渡方向为逆时针,则引导无人机进入以虚拟中心点为圆心,以R为盘旋半径的逆时针圆形盘旋轨迹,计算无人机到虚拟圆心的距离Dv,方位角θv:
无人机飞行的期望航向根据以下公式计算:
D′d=(Dv-R)
将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行;
步骤7:实时计算无人机当前航向与θ3的差值,若则转入步骤8,否则继续按步骤7执行引导;
步骤8:引导无人机从目标航程点飞往目标航程点下一航点;无人机飞行的期望航向根据以下公式计算:
D″d=(Yu-Yn)·cos(θ3)-(Xu-Xn)·sin(θ3)
将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行。
所述的Kp为-0.1~-1。
所述的Ki为-0.01~-0.05。
有益效果
本发明提出的一种固定翼无人机航点平滑切换的控制方法,有益效果如下:
1、采用“直线-圆形-直线”的切换方式来控制航线切换,使得两条航线之间的切换过程自然,平滑,避免无人机因调整位置而浪费飞行时间,提高有效任务时间。
2、采用了连续变化的控制量计算方法,根据无人机盘旋能力及航线形状动态调整航线切换时机,使得航线切换以最快速度执行完成,并使得航线的切出及切入过程平滑可控。
3、切换过程中采用圆盘旋控制方式,舵机控制量根据无人机相对盘旋圆心的距离进行计算,使得无人机在有侧风干扰的情况下也能按照预定的航迹进行盘旋飞行。
附图说明
图1现有航点切换飞行实现示意图
图2本发明航点切换飞行实现示意图
图3航点切换实现流程图
图4航点切换控制原理
具体实施方式
现结合实施例、附图对本发明作进一步描述:
步骤1:获得无人机当前飞行的航线段中的源航程点纬度、经度坐标(Bs,Ls),目标航程点纬度、经度坐标(Bt,Lt)及目标航程点下一航点纬度、经度坐标(Bn,Ln),并根据卫星定位结果获得无人机的纬度、经度坐标(Bu,Lu),所有坐标均取WGS-84坐标系下的数值。
步骤2:对参心空间直角坐标系进行高斯-吕克投影,转为高斯平面直角坐标系,将步骤1中的四个位置坐标转换为直角坐标下的位置,依次定义为(Xs,Ys),(Xt,Yt),(Xn,Yn),(Xu,Yu)。以下的运算均在平面直角坐标系下进行。
根据前三点位置,依据以下公式计算源航程点指向目标航程点的方位角θ1。
若(Yt-Ys)≥0
若(Yt-Ys)<0
同理计算目标航程点下一航点指向目标航程点的方位角θ2以及目标航程点指向目标航程点下一航点的方位角θ3。
若(Yt-Yn)≥0
若(Yt-Yn)<0
若(Yn-Yt)≥0
若(Yn-Yt)<0
步骤3:根据步骤2中计算出的θ1和θ2,根据以下公式确定两条航线之间的夹角θ。
依据上文计算的数据,并根据以下坐标转换公式,确定两条航线的过渡方向。
D=(Ys-Yt)·cos(θ3)-(Xs-Xt)·sin(θ3)
依据上文计算的数据,并根据以下公式,计算出虚拟的过渡盘旋中心点位置(Xv,Yv):
Xv=Xt+cos(θl)·L
Yv=Yt+sin(θl)·L
若
若
其中,R为无人机最小转弯半径,取值800。若θ<10,则不再利用上面的公式进行计算,而直接将虚拟的过渡盘旋中心点位置设为目标点位置。
步骤4:引导无人机从源航程点飞往目标航程点。无人机飞行的期望航向根据以下公式计算:
Dd=(Yu-Yt)·cos(θ1)-(Xu-Xt)·sin(θ1)
其中,Kp为比例控制系数,取值为-0.5,Ki为积分控制系数,取值为-0.02,Dd为航迹偏差量。将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行,保证无人机沿给定的航向进行飞行。
在引导过程中实时计算飞机至目标航程点的距离St,根据以下公式计算:
步骤5:实时比较无人机距目标航程点的距离与步骤3中所提无人机盘旋半径,其计算公式如下:
ΔS=St-R-C
其中C为一个距离常数,该飞机巡航速度为150km/h,距离常数取80,用于让无人机提前建立倾斜姿态。若ΔS<0,则进入步骤6,否则继续用步骤4的方式引导无人机飞行。
步骤6:若步骤3中所得的过渡方向为顺时针,则引导无人机进入以虚拟中心点为圆心,以R为盘旋半径的顺时针圆形盘旋轨迹,计算无人机到虚拟圆心的距离Dv,方位角θv:
无人机飞行的期望航向根据以下公式计算:
Dd=(Dv-R)
若步骤3中所得的过渡方向为逆时针,则引导无人机进入以虚拟中心点为圆心,以R为盘旋半径的逆时针圆形盘旋轨迹,计算无人机到虚拟圆心的距离Dv,方位角θv:
无人机飞行的期望航向根据以下公式计算:
Dd=(Dv-R)
其中,Kp为比例控制系数,取值为-0.5,Ki为积分控制系数,取值为-0.02,将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行,保证无人机沿给定的航向进行飞行。
步骤7:依据上文计算的数据,实时计算无人机当前航向与θ3的差值,若则转入步骤8,否则继续按步骤7执行引导。
步骤8:引导无人机从目标航程点飞往目标航程点下一航点。无人机飞行的期望航向根据以下公式计算:
Dd=(Yu-Yn)·cos(θ3)-(Xu-Xn)·sin(θ3)
其中,Kp为比例控制系数,取值为-0.5,Ki为积分控制系数,取值为-0.02,将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行,保证无人机沿给定的航向进行飞行。
从而实现无人机航线平滑切换。
Claims (3)
1.一种固定翼无人机航点平滑切换的控制方法,其特征在于步骤如下:
步骤1:获得固定翼无人机当前飞行的航线段中的源航程点纬度、经度坐标(Bs,Ls),目标航程点纬度、经度坐标(Bt,Lt)及目标航程点下一航点纬度、经度坐标(Bn,Ln),并根据卫星定位结果获得无人机的纬度、经度坐标(Bu,Lu);
步骤2:根据高斯坐标转换公式,将步骤1中的四个位置坐标依次转换为直角坐标(Xs,Ys),(Xt,Yt),(Xn,Yn),(Xu,Yu);由前三点位置,依据以下公式计算源航程点指向目标航程点的方位角θ1:
若(Yt-Ys)≥0
<mrow>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mi>arccos</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>s</mi>
</msub>
</mrow>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>s</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>s</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
若(Yt-Ys)<0
<mrow>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mn>360</mn>
<mo>-</mo>
<mi>arccos</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>s</mi>
</msub>
</mrow>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>s</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>s</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
同理计算目标航程点下一航点指向目标航程点的方位角θ2以及目标航程点指向目标航程点下一航点的方位角θ3:
若(Yt-Yn)≥0
<mrow>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mi>arccos</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>n</mi>
</msub>
</mrow>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>n</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>n</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
若(Yt-Yn)<0
<mrow>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mn>360</mn>
<mo>-</mo>
<mi>arccos</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>n</mi>
</msub>
</mrow>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>n</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>n</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
若(Yn-Yt)≥0
<mrow>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mi>arccos</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>X</mi>
<mi>n</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
</mrow>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>n</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>n</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
若(Yn-Yt)<0
<mrow>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mn>360</mn>
<mo>-</mo>
<mi>arccos</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>X</mi>
<mi>n</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
</mrow>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>n</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>n</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
步骤3:由步骤2中计算出的θ1和θ2,根据以下公式确定两条航线之间的夹角θ:
根据以下坐标转换公式,确定两条航线的过渡方向:
D=(Ys-Yt)·cos(θ3)-(Xs-Xt)·sin(θ3)
根据以下公式,计算出虚拟的过渡盘旋中心点位置(Xv,Yv):
Xv=Xt+cos(θl)·L
Yv=Yt+sin(θl)·L
<mrow>
<mi>L</mi>
<mo>=</mo>
<mfrac>
<mi>R</mi>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mi>&theta;</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
</mrow>
若D≥0,
若D<0,
其中,R为无人机的最小盘旋半径,该数值可以在无人机性能手册上查到;若θ<10,则不再利用上面的公式进行计算,而直接将目标航程点设为虚拟的过渡盘旋中心点位置;
步骤4:引导无人机从源航程点飞往目标航程点:无人机飞行的期望航向根据以下公式计算:
Dd=(Yu-Yt)·cos(θ1)-(Xu-Xt)·sin(θ1)
其中,Kp为比例控制系数,Ki为积分控制系数,Dd为航迹偏差量;将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行;
在引导过程中实时计算飞机至目标航程点的距离St:
<mrow>
<msub>
<mi>S</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
步骤5:实时比较无人机距目标航程点的距离与步骤3中所提无人机最小转弯半径,其计算公式如下:
ΔS=St-R-C
其中,C为一个距离常数,取值为无人机2秒钟所能飞行的距离,用于让无人机提前建立倾斜姿态;若ΔS<0,则进入步骤6,否则继续用步骤4的方式引导无人机飞行;
步骤6:若步骤3中所得的过渡方向为顺时针,则引导无人机进入以虚拟中心点为圆心,以R为盘旋半径的顺时针圆形盘旋轨迹,计算无人机到虚拟圆心的距离Dv,方位角θv:
<mrow>
<msub>
<mi>D</mi>
<mi>v</mi>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>v</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>v</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
<mrow>
<msub>
<mi>&theta;</mi>
<mi>v</mi>
</msub>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>g</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>Y</mi>
<mi>u</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>v</mi>
</msub>
</mrow>
<mrow>
<msub>
<mi>X</mi>
<mi>u</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>v</mi>
</msub>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
无人机飞行的期望航向根据以下公式计算:
D′d=(Dv-R)
若步骤3中所得的过渡方向为逆时针,则引导无人机进入以虚拟中心点为圆心,以R为盘旋半径的逆时针圆形盘旋轨迹,计算无人机到虚拟圆心的距离Dv,方位角θv:
<mrow>
<msub>
<mi>D</mi>
<mi>v</mi>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>v</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>v</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
<mrow>
<msub>
<mi>&theta;</mi>
<mi>v</mi>
</msub>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>g</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>Y</mi>
<mi>u</mi>
</msub>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>v</mi>
</msub>
</mrow>
<mrow>
<msub>
<mi>X</mi>
<mi>u</mi>
</msub>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>v</mi>
</msub>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
无人机飞行的期望航向根据以下公式计算:
D′d=(Dv-R)
将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行;
步骤7:实时计算无人机当前航向与θ3的差值,若则转入步骤8,否则继续按步骤7执行引导;
步骤8:引导无人机从目标航程点飞往目标航程点下一航点;无人机飞行的期望航向根据以下公式计算:
D″d=(Yu-Yn)·cos(θ3)-(Xu-Xn)·sin(θ3)
将计算得出的期望航向输出至横侧向控制器并得出舵机控制量,最后送至舵机进行执行。
2.根据权利要求1所述的固定翼无人机航点平滑切换的控制方法,其特征在于所述的Kp为-0.1~-1。
3.根据权利要求1所述的固定翼无人机航点平滑切换的控制方法,其特征在于所述的Ki为-0.01~-0.05。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710694409.1A CN107515617B (zh) | 2017-08-15 | 2017-08-15 | 一种固定翼无人机航线平滑切换控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710694409.1A CN107515617B (zh) | 2017-08-15 | 2017-08-15 | 一种固定翼无人机航线平滑切换控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107515617A true CN107515617A (zh) | 2017-12-26 |
CN107515617B CN107515617B (zh) | 2020-08-07 |
Family
ID=60723156
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710694409.1A Active CN107515617B (zh) | 2017-08-15 | 2017-08-15 | 一种固定翼无人机航线平滑切换控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107515617B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109582035A (zh) * | 2018-11-29 | 2019-04-05 | 沈阳无距科技有限公司 | 一种飞行器航迹导航方法、装置及电子设备 |
CN109945888A (zh) * | 2019-03-11 | 2019-06-28 | 百度在线网络技术(北京)有限公司 | 导航引导线的生成方法、装置及计算机设备 |
CN109945868A (zh) * | 2019-03-07 | 2019-06-28 | 西安爱生技术集团公司 | 一种无人机目标照射航线自动规划方法 |
CN111240360A (zh) * | 2020-01-19 | 2020-06-05 | 西北工业大学 | 用于导引飞行装置跟踪目标的方法、计算机***和介质 |
CN111324135A (zh) * | 2018-12-17 | 2020-06-23 | 北京京东尚科信息技术有限公司 | 无人机控制方法、装置、电子设备及计算机可读介质 |
CN111474959A (zh) * | 2020-06-02 | 2020-07-31 | 四川省天域航通科技有限公司 | 一种大型货运无人机远程导航实现方法 |
CN111742277A (zh) * | 2019-06-26 | 2020-10-02 | 深圳市大疆创新科技有限公司 | 无人机的控制方法、设备、无人机及存储介质 |
CN111964683A (zh) * | 2020-08-21 | 2020-11-20 | 苏州极目机器人科技有限公司 | 喷洒路径规划方法和装置 |
WO2021244545A1 (zh) * | 2020-06-05 | 2021-12-09 | 深圳市道通智能航空技术股份有限公司 | 一种无人机制导方法、无人机及存储介质 |
CN115512572A (zh) * | 2022-08-16 | 2022-12-23 | 西安爱生技术集团有限公司 | 一种无人机圆弧形跑道航线控制方法 |
WO2023178492A1 (zh) * | 2022-03-21 | 2023-09-28 | 深圳市大疆创新科技有限公司 | 无人机航线的规划方法、规划装置、遥控装置及无人机 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102854888A (zh) * | 2012-09-10 | 2013-01-02 | 北京东进记录科技有限公司 | 飞机航线规划方法及装置 |
CN103700286A (zh) * | 2013-12-11 | 2014-04-02 | 南京航空航天大学 | 一种舰载无人机自动着舰引导方法 |
CN104035446A (zh) * | 2014-05-30 | 2014-09-10 | 深圳市大疆创新科技有限公司 | 无人机的航向生成方法和*** |
US20150276411A1 (en) * | 2014-03-28 | 2015-10-01 | Thales | Method of computing lateral trajectories |
CN106054920A (zh) * | 2016-06-07 | 2016-10-26 | 南方科技大学 | 一种无人机飞行路径规划方法和装置 |
CN106527491A (zh) * | 2016-11-21 | 2017-03-22 | 南京航空航天大学 | 一种固定翼无人机控制***及横侧向飞行轨迹控制方法 |
-
2017
- 2017-08-15 CN CN201710694409.1A patent/CN107515617B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102854888A (zh) * | 2012-09-10 | 2013-01-02 | 北京东进记录科技有限公司 | 飞机航线规划方法及装置 |
CN103700286A (zh) * | 2013-12-11 | 2014-04-02 | 南京航空航天大学 | 一种舰载无人机自动着舰引导方法 |
US20150276411A1 (en) * | 2014-03-28 | 2015-10-01 | Thales | Method of computing lateral trajectories |
CN104035446A (zh) * | 2014-05-30 | 2014-09-10 | 深圳市大疆创新科技有限公司 | 无人机的航向生成方法和*** |
CN106054920A (zh) * | 2016-06-07 | 2016-10-26 | 南方科技大学 | 一种无人机飞行路径规划方法和装置 |
CN106527491A (zh) * | 2016-11-21 | 2017-03-22 | 南京航空航天大学 | 一种固定翼无人机控制***及横侧向飞行轨迹控制方法 |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109582035A (zh) * | 2018-11-29 | 2019-04-05 | 沈阳无距科技有限公司 | 一种飞行器航迹导航方法、装置及电子设备 |
CN111324135A (zh) * | 2018-12-17 | 2020-06-23 | 北京京东尚科信息技术有限公司 | 无人机控制方法、装置、电子设备及计算机可读介质 |
CN109945868A (zh) * | 2019-03-07 | 2019-06-28 | 西安爱生技术集团公司 | 一种无人机目标照射航线自动规划方法 |
CN109945868B (zh) * | 2019-03-07 | 2022-09-02 | 西安爱生技术集团公司 | 一种无人机目标照射航线自动规划方法 |
CN109945888A (zh) * | 2019-03-11 | 2019-06-28 | 百度在线网络技术(北京)有限公司 | 导航引导线的生成方法、装置及计算机设备 |
CN111742277A (zh) * | 2019-06-26 | 2020-10-02 | 深圳市大疆创新科技有限公司 | 无人机的控制方法、设备、无人机及存储介质 |
CN111742277B (zh) * | 2019-06-26 | 2024-02-20 | 深圳市大疆创新科技有限公司 | 无人机的控制方法、设备、无人机及存储介质 |
CN111240360A (zh) * | 2020-01-19 | 2020-06-05 | 西北工业大学 | 用于导引飞行装置跟踪目标的方法、计算机***和介质 |
CN111474959A (zh) * | 2020-06-02 | 2020-07-31 | 四川省天域航通科技有限公司 | 一种大型货运无人机远程导航实现方法 |
WO2021244545A1 (zh) * | 2020-06-05 | 2021-12-09 | 深圳市道通智能航空技术股份有限公司 | 一种无人机制导方法、无人机及存储介质 |
CN111964683A (zh) * | 2020-08-21 | 2020-11-20 | 苏州极目机器人科技有限公司 | 喷洒路径规划方法和装置 |
WO2023178492A1 (zh) * | 2022-03-21 | 2023-09-28 | 深圳市大疆创新科技有限公司 | 无人机航线的规划方法、规划装置、遥控装置及无人机 |
CN115512572A (zh) * | 2022-08-16 | 2022-12-23 | 西安爱生技术集团有限公司 | 一种无人机圆弧形跑道航线控制方法 |
CN115512572B (zh) * | 2022-08-16 | 2024-01-09 | 西安爱生技术集团有限公司 | 一种无人机圆弧形跑道航线控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107515617B (zh) | 2020-08-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107515617A (zh) | 一种固定翼无人机航线平滑切换控制方法 | |
CN105045284B (zh) | 一种抗干扰无人飞行器路径跟踪控制方法 | |
CN111306989B (zh) | 一种基于平稳滑翔弹道解析解的高超声速再入制导方法 | |
CN108845588B (zh) | 一种基于非线性制导的四旋翼飞行器轨迹跟踪控制方法 | |
CN101788822B (zh) | 一种无人机侧向控制方法 | |
US20060015247A1 (en) | Bezier curve flightpath guidance using moving waypoints | |
CN108319296B (zh) | 一种融合全局信息与局部信息的编队控制方法 | |
CN106444822B (zh) | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 | |
CN105892487B (zh) | 一种无人机8字形航迹控制方法 | |
CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
CN103149937A (zh) | 一种基于曲率补偿的横侧向曲线航迹跟踪方法 | |
CN108594639A (zh) | 一种基于强化学习的全垫升气垫船航迹跟踪控制方法 | |
CN105425812B (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
CN110687920B (zh) | 无人机集群编队控制方法、装置及储存介质 | |
CN104960674A (zh) | 一种运动目标的指向跟踪控制方法 | |
CN103760908A (zh) | 一种巡视器闭环跟踪控制方法 | |
CN109708639A (zh) | 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 | |
CN113515138A (zh) | 一种固定翼无人机航线重规划方法 | |
CN111338374A (zh) | 无人机集群编队控制方法 | |
CN105094144B (zh) | 一种无人飞艇自适应抗风路径跟踪控制方法 | |
Chen et al. | Formation reconfiguration for fixed-wing UAVs: A coordinated path following approach | |
CN111240362A (zh) | 一种智能引导飞行器转弯的控制方法及装置 | |
CN106200664B (zh) | 一种适应长时间失控的姿态控制方法 | |
CN105045271B (zh) | 一种欠驱动条件下的空间飞行器位置机动方法 | |
CN113093801B (zh) | 一种多无人机协同编队的航路文件制作方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
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 |