一种基于时间最优的无人机前飞速度计算方法技术

本发明专利技术公开了一种基于时间最优的无人机前飞速度计算方法，能够解决手动模式过渡到自动模式或者自动模式给定速度变化时的速度、加速度连续性问题。该算法依据初始状态和目标状态进行计算将过渡过程划分为若干阶段，计算出每个阶段对应的运动状态参数，显著提高了计算效率并且简化了过渡过程，且不会产生影响飞行效果的不良影响。

A time optimal flight speed calculation method for UAVs

The invention discloses a method for calculating the forward flight speed of UAV based on the optimal time, which can solve the problem of the continuity of velocity and acceleration when the manual mode transits to the automatic mode or the automatic mode has a given speed change. The algorithm divides the transition process into several stages according to the initial state and the target state, and calculates the corresponding motion state parameters of each stage, which greatly improves the computational efficiency and simplifies the transition process without any adverse effects on the flight effectiveness.

【技术实现步骤摘要】
一种基于时间最优的无人机前飞速度计算方法
本专利技术涉及一种基于时间最优的无人机前飞速度计算方法，特别适用于解决无人机速度模式切换和自动模式下变化速度时的速度和加速度保持连续。
技术介绍
在无人机的使用过程中，从手动模式切换到自动模式以及在自动模式的情况下给定速度变化时，速度和加速度的连续性是影响飞行效果的关键性因素。但是由于影响速度和加速度连续性的因素过多，如何有效解决连续性问题一直是行业内一个难点。尽管近几年来基于控制量突变部分的消除和利用现有数控技术规划算法让速度和加速度的连续性问题得到解决，但是前者计算过程复杂，而后者则不能保证过渡过程时间最优。因此需要采用一种算法既能基于时间最优解决速度和加速度的连续性问题，又能不产生影响飞行效果的负面影响。
技术实现思路
为解决上述问题，本专利技术的目的在于采用一种基于时间最优的无人机前飞速度计算方法，解决手动模式过渡到自动模式或者自动模式给定速度变化时的速度、加速度保持连续。本专利技术解决其问题所采取的技术方案是：一种基于时间最优的无人机前飞速度计算方法，其特征在于：在速度、加速度发生变化时，执行以下步骤：A、将速度、加速度变化的过渡过程分为若干时间段；B、根据初始状态和目标状态确定时间分段点；C、利用步骤B根据初始状态和目标状态确定的时间分段点，计算出每个时间段所对应的运动状态参数；D、利用步骤C所得的运动状态参数，控制无人机完成速度、加速度连续的过渡过程。进一步，所述步骤B中时间分段点为t1,t2,t3。进一步，步骤C中所述无人机运动过程的时间段分为以下3个阶段：t≤t1，t1<t≤t2，t2<t≤t3，其中t为无人机运动过程中所处的时间点。进一步：当初始速度v0和目标速度ve满足时，时间分段点的计算方法如下：ωm＝ωmax其中，g为重力加速度，ωmax为无人机的最大角速度，θ0为初始俯仰角，且满足amax为给定的最大加速度。进一步，当初始速度v0和目标速度ve满足时，时间分段点的计算方法如下：ωm＝-ωmax其中，g为重力加速度，ωmax为无人机的最大角速度，θ0为初始俯仰角，且满足amax为给定的最大加速度。进一步，当初始速度v0和目标速度ve满足且θ0≥0；或者满足且θ0≤0时，时间分段点的计算方法如下：ωm＝ωmaxt2＝t1其中，g为重力加速度，ωmax为无人机的最大角速度，θ0为初始俯仰角，且满足amax为给定的最大加速度。进一步，当初始速度v0和目标速度ve满足且θ0≤0；或者满足时，时间分段点的计算方法如下：ωm＝-ωmaxt2＝t1其中，g为重力加速度，ωmax为无人机的最大角速度，θ0为初始俯仰角，且满足amax为给定的最大加速度。进一步，步骤C计算运动状态参数由以下公式求得：其中，ωm为给定的最大角速度，g为重力加速度，v0为初始速度，θ0为初始俯仰角，且满足θr为过渡过程俯仰角，ar为过渡过程加速度，vr为过渡过程速度，ωr为过渡过程角速度。本专利技术的有益效果是：一种基于时间最优的无人机前飞速度计算方法，依据初始状态和目标状态进行计算将过渡过程划分为若干阶段，计算出每个阶段对应的运动状态参数，显著提高了计算效率，简化了过渡过程并且避免了超调现象的出现。利用该计算方法得出的速度、加速度保持了连续性。附图说明下面结合附图和实例对本专利技术作进一步说明。图1是本专利技术计算过渡过程运动状态参数的流程图；图2是本专利技术过渡过程的速度曲线；图3是本专利技术过渡过程的加速度曲线；图4是本专利技术过渡过程的角速度曲线；图5是本专利技术随机调速过程的速度曲线；图6是本专利技术随机调速过程的加速度曲线；图7是本专利技术随机调速过程的角速度曲线。具体实施方式参照图1，本专利技术为一种基于时间最优的无人机前飞速度计算方法，计算给定条件下无人机的运动状态参数，从手动模式过渡到自动模式或者在自动模式下调整速度时，执行以下步骤：A、将速度、加速度变化的过渡过程分为三个时间段t≤t1，t1<t≤t2，t2<t≤t3。B、根据初始状态和目标状态确定时间分段点；C、根据步骤B利用初始状态和目标状态确定的时间值计算出每个时间段所对应的运动状态参数；进一步，步骤B中确定时间分段点根据初始状态和目标状态分以下四种情况计算，方法如下：则取：ωm＝ωmax则取：ωm＝-ωmax且θ0≥0或者且θ0<0，则取：ωm＝ωmaxt2＝t1且θ0≤0或者且θ0>0，则取：ωm＝-ωmaxt2＝t1其中当从手动过渡到自动时，取v0，θ0为切换时无人机真实速度和俯仰角，当自动调速时，取v0，θ0为调速时的给定速度和俯仰角。结束条件(ve,0)，表明结束条件为匀速；g为重力加速度，ωmax为无人机的最大角速度，且满足进一步，根据步骤B所得出的结果，步骤C中计算运动过程状态参数的计算步骤如下：C1：当t≤t1时，ωr＝ωmθr＝θ0+ωmtar＝gtan(θr)C2.当t1<t≤t2时，ωr＝0θr＝θ0+ωmt1ar＝gtan(θr)C3.当t2<t≤t3时，ωr＝-ωmθr＝θ0+ωmt1-ωm(t-t2)ar＝gtan(θr)C4.当t>t3时，ωr＝0θr＝0ar＝0vr＝ve其中，ωm为给定的最大角速度，g为重力加速度，v0为初始速度，θ0为初始俯仰角，且满足θr为过渡过程俯仰角，ar为过渡过程加速度，vr为过渡过程速度，ωr为过渡过程角速度。其中，无人机所处时间点t满足0<t≤t3时，表示无人机处于过渡过程；无人机所处时间点t满足t>t3时，表示无人机已经完成了过渡过程，达到了设定的目标状态。其中，过渡过程中加速度的ar满足ar＝gtan(θr)，即加速度ar并非恒定值，所述无人机的过渡过程属于变加速运动，；其中ωm＝ωmax表示无人机先加加速，再匀加速，最后减加速，即加速度ar的曲线符合附图3中的曲线1或曲线3所示；ωm＝-ωmax表示先减加速，再匀减速，最后加减速，即加速度ar的曲线符合附图3中的曲线2或曲线4所示。当无人机从不同初值过渡到悬停效果时，参考附图2－4，当v0和ve满足步骤B的条件B1时，过渡过程速度vr的曲线如附图2中曲线1所示，过渡过程加速度ar的曲线如附图3中曲线1所示，过渡过程角速度ωr的曲线如附图4中曲线1所示；当v0和ve满足步骤B的条件B2时，过渡过程速度vr的曲线如附图2中曲线2所示，过渡过程加速度ar的曲线如附图3中曲线2所示，过渡过程角速度ωr的曲线如附图4中曲线2所示；当v0和ve满足步骤B的条件B3时，过渡过程速度vr的曲线如附图2中曲线3所示，过渡过程加速度ar的曲线如附图3中曲线3所示，过渡过程角速度ωr的曲线如附图4中曲线3所示；当v0和ve满足步骤B的条件B4时，过渡过程速度vr的曲线如附图2中曲线4所示，过渡过程加速度ar的曲线如附图3中曲线4所示，过渡过程角速度ωr的曲线如附图4中曲线4所示。可以看出，速度和加速度在整个过渡过程中连续。从附图2可以看出，在过渡过程中，过渡过程的速度变化至0后不再变化，即未产生超调现象。当无人机进行随机调速时，过渡过程速度vr和与ve的关系如附图5所示；加速度ar的曲线图如附本文档来自技高网...

【技术保护点】
1.一种基于时间最优的无人机前飞速度计算方法，其特征在于：在速度、加速度发生变化时，执行以下步骤：A、将速度、加速度变化的过渡过程分为若干时间段；B、根据初始状态和目标状态确定时间分段点；C、利用步骤B根据初始状态和目标状态确定的时间分段点，计算出每个时间段所对应的运动状态参数；D、利用步骤C所得的运动状态参数，控制无人机完成速度、加速度连续的过渡过程。

【技术特征摘要】
1.一种基于时间最优的无人机前飞速度计算方法，其特征在于：在速度、加速度发生变化时，执行以下步骤：A、将速度、加速度变化的过渡过程分为若干时间段；B、根据初始状态和目标状态确定时间分段点；C、利用步骤B根据初始状态和目标状态确定的时间分段点，计算出每个时间段所对应的运动状态参数；D、利用步骤C所得的运动状态参数，控制无人机完成速度、加速度连续的过渡过程。2.根据权利要求1所述的一种基于时间最优的无人机前飞速度计算方法，其特征在于：所述步骤B中时间分段点为t1,t2,t3，过渡过程的时间段分为以下3个阶段：t≤t1，t1<t≤t2，t2<t≤t3，其中t为无人机运动过程中所处的时间点。3.根据权利要求2所述的一种基于时间最优的无人机前飞速度计算方法，其特征在于：当初始速度v0和目标速度ve满足时，时间分段点的计算方法如下：ωm＝ωmax其中，g为重力加速度，ωmax为无人机的最大角速度，θ0为初始俯仰角，且满足amax为给定的最大加速度。4.根据权利要求2所述的一种基于时间最优的无人机前飞速度计算方法，其特征在于：当初始速度v0和目标速度ve满足时，时间分段点的计算...

【专利技术属性】
技术研发人员：贺跃帮，陈浩森，
申请(专利权)人：五邑大学，
类型：发明
国别省市：广东,44