买专利,只认龙图腾
首页 专利交易 科技果 科技人才 科技服务 商标交易 会员权益 IP管家助手 需求市场 关于龙图腾
 /  免费注册
到顶部 到底部
清空 搜索

【发明授权】无人机高度信号的峰值跟踪方法_大连楼兰科技股份有限公司_201610723451.7 

申请/专利权人:大连楼兰科技股份有限公司

申请日:2016-08-25

公开(公告)日:2021-04-27

公开(公告)号:CN107783102B

主分类号:G01S13/70(20060101)

分类号:G01S13/70(20060101)

优先权:

专利状态码:有效-授权

法律状态:2021.04.27#授权;2018.04.03#实质审查的生效;2018.03.09#公开

摘要:无人机高度信号的峰值跟踪方法,属于雷达领域,解决植保旋翼无人机雷达高度的解算的稳定性的问题,技术要点是:包括过门限峰值点跟踪的步骤;及距离跟踪的步骤。效果是:提高了稳定性以及实时性。

主权项:1.一种无人机高度信号的峰值跟踪方法,其特征在于,具有:过门限峰值点跟踪的步骤;及高度跟踪的步骤;所述的过门限峰值点跟踪的方法是:设置一个峰值点阈值因子α,其用于限制检测出的过门限最大峰值点与上一周期出现的最大峰值点的差值绝对值,使得该差值绝对值不得大于该峰值点阈值因子α:表达式如下:|L_maxk-L_maxk-1|≤α; 其中:L_maxk为k周期的过门限最大峰值,L_maxk-1为上一周期的最大峰值,k表示第k时刻;vmax为无人机最大飞行速度,λ为毫米波雷达波长,fs为采样率,N为FFT的点数;如果k时刻的过门限最大峰值与k-1时刻的过门限最大峰值差值的绝对值在所设置的峰值点阈值因子α范围内,则认为第k周期的峰值点有效;如果k时刻的过门限最大峰值与k-1时刻的过门限最大峰值差值的绝对值超过所设置的峰值点阈值因子α,则k时刻输出的峰值点用k-1时刻的峰值点进行替换。

全文数据:无人机高度信号的峰值跟踪方法技术领域[0001]本发明属于雷达领域,涉及一种无人机高度信号的峰值跟踪方法。背景技术[0002]植保无人机,顾名思义是用于农林植物保护作业的无人驾驶飞机,该型无人飞机有飞行平台(固定翼、单旋翼、多旋翼)、GPS飞控、喷洒机构三部分组成,通过地面遥控或GPS飞控,来实现喷洒作业,可以喷洒药剂、种子、粉剂等。[0003]无人机植保作业与传统植保作业相比,具有精准作业、高效环保、智能化、操作简单等特点,为农户节省大型机械和大量人力的成本。植保无人机具有作业高度低,飘移少,可空中悬停等特点,喷洒农药时旋翼产生的向下气流有助于增加气流对农作物的穿透性,如果能够稳定的控制植保无人机与地面植被之间的高度,在农药喷洒作业过程中,则可以更好的使得农药高效率的喷洒到植被上,从而提高农药的防治效果等,使得农药达到最大的利用率。[0004]目前主要用于无人机高度跟踪主要有kalman跟踪以及α-β跟踪等方式,kalman方法以及方法,都可以达到很好地跟踪效果,但是kalman方法在计算过程中存在大量的矩阵变化,将会消耗大量的硬件资源,导致系统实时性下降。α-β方法相比kalman要快很多,但是对于植保无人机要求的高实时性,可能还是需要进一步减少计算时间,本发明采用了一种更简洁的目标跟踪方法,同样可以达到更好的目标跟踪效果。[0005]Kalman方法以及α-β方法都是对解算出的高度进行一次跟踪,即仅采用数据处理的方法,而忽略了信号处理部分。因此本发明为了更好的提高目标的跟踪效果,在峰值搜索时进行了一次峰值跟踪算法,以及对高度进行二次跟踪算法。峰值跟踪算法以及高度跟踪算法的实现过程相比Kalman方法以及α-β方法会更简单有效。发明内容[0006]为了解决现有的无人机高度信号跟踪存在实时性低的技术问题,本发明提出如下技术方案:[0007]—种无人机高度信号的峰值跟踪方法,具有:过门限峰值点跟踪的步骤;及距离跟踪的步骤。[0008]有益效果:本发明在峰值搜索时进行了一次峰值跟踪,对解算出的高度进行了二次跟踪。峰值跟踪算法以及高度跟踪算法的配合使用,大大降低了硬件的运算时间,从而更好地提高高度数据的实时性,同时提高高度数据的刷新率。同时采用峰值跟踪算法和高度跟踪算法,可以有效避免由于单次或是多次峰值搜索的错误而导致一次或是多次高度数据解算的异常现象,如峰值跳变引起的高度发生很大的跳变,即该周期内高度的跳变已经远远大于由无人机速度引起的一个周期所产生的距离变化范围则认为是跳变高度。由此峰值跟踪以及高度跟踪可以有效避免这种异常峰值导致的异常高度值,从而有效地的提高跟踪的高度数据的稳定度。附图说明[0009]图1线性调频锯齿波FMCW在一个扫频周期内的频率变化图;[0010]图2实施例2中植被旋翼无人机雷达高度表系统信号处理方法流程图。具体实施方式[0011]实施例1:一种植保旋翼无人机雷达高度表系统雷达信号处理方法,包括如下步骤:[0012]SI.AD数据采集;[0013]所述AD数据采集,通过AD采样进行数字化处理,AD采集到的数据点数N,去除掉部分数据后,剩余点数的个数为N_s。[0014]S2.去直流,该步骤为可选步骤;[0015]1分别计算I路、Q路各自N_s个数据的均值Ijnean和Qjnean;[0016][0017]2其中I为I路的时域数据,Q为Q路的时域数据,I_mean为I路的均值,Q_mean为Q路的均值;[0018]3将I路、Q路的每一个数据减掉各路的均值;[0019]⑷IQ数据去直流计算公式为:,其中,V为去直流后的数据,Q为去直流后的数据。[0020]S3.FFT变换;[0021]优选是去直流后的I、Q数据,合并成I+jQ的数据形式,锯齿波I+jQ数据进行FFT变换,将时域数据转换成频率数据,当然,AD采集数据,也可以直接进行FFT变换,将I、Q数据,合并成I+jQ的数据形式,锯齿波I+jQ数据进行FFT变换。[0022]S4.CFAR门限检测;[0023]将FFT变换后的各个点的复数模值进行CFAR门限检测。[0024]S5.峰值处理;[0025]所述峰值处理:在经过CFAR门限检测后,选择最大点作为输出峰值,在进行过门限峰值提取时,执行如下方法:[0026]设置一个峰值点阈值因子α,其用于限制检测出的过门限最大峰值点与上一周期出现的最大峰值点的差值绝对值,使得该差值绝对值不得大于该峰值点阈值因子α:[0027]表达式如下:[0028]L_maxk-L_maxk~l|;[0029][0030]其中:L_max⑹为k周期的过门限最大峰值点坐标,L_maxk_l为上一周期的最大峰值点坐标,k表示第k时刻;vmax为无人机最大飞行速度,λ为毫米波雷达波长,fs为采样率,N为FFT的点数;[0031]如果k时刻,过门限最大峰值点与k-Ι时刻过门限最大峰值点的绝对值差值在所设置的峰值点阈值因子α范围内,则认为第k周期的峰值点有效;如果k时刻,过门限最大峰值点超过所设置的峰值点阈值因子α,则k时刻输出的峰值点用k-Ι时刻的峰值点进行替换。[0032]作为一种优选方案,设置一个峰值点突变累计因子Φ,该峰值点突变累计因子Φ的定义为,如果从k时刻开始,连续b个周期,b的取值范围为5〜10,过门限最大峰值点与前一周期的过门限最大峰值点相比,都超过阈值门限因子a,则第k+b时刻,将当前时刻解算出的过门限最大峰值点作为当前时刻的过门限最大峰值点。[0033]S6.谱最大估计,该步骤为可选步骤:[0034]得到过门限最大峰值点进行谱最大估计:设过门限最大峰值点Al的坐标为(al,kl,其中,al表示过门限最大峰值点的值,kl表示过门限峰值点对应的幅度值;最大峰值点左右两边,次峰值点坐标为A3a3,k3,设所求的中央峰值点A为amax,kmax,贝lje=amax-al,则Al点,关于A点对称点A2坐标为a2,kl=al+2e,kl,复包络的零点A4为a4,kl=a3+e,0;[0035]其中:a2、a3、a4是对应点的过门限最大峰值点的值,k3、k4是对应点的过门限峰值点对应的幅度值;[0036]A2、A3和A4近似为一条直线,其线性关系为:[0037][0038]4贝1J[0039]设定误差E与偏差e进行比对,如果IeI〈E,则此时的过门限峰值点的值则为所要求的中央峰值点的值,如果偏差e大于所设定的误差E时:,β为修正因子,取值范围为1.5〜1.9,改变修正因子计算出e的值,以计算得到中央峰值点的值amax=al+e。[0040]S7.高度结算;[0041]中央峰值点的值amax,其对应的频率值f_amax,根据公式.计算得到高度;其中,T为调制周期,B为调频带宽,c为光速。[0042]设置一个高度阈值因子ε,其用于限制当前高度数据H⑹与上一周期出现的高度数据Hk-Ι的差值绝对值,使得该差值绝对值不得大于该高度阈值因子ε;[0043]表达式如下:[0044]|Η⑹-Hk-lI彡ε,ε取值范围为0.8〜1.3;[0045]如果k时刻的高度数据与k_1时刻的绝对值差值,在所设置的高度阈值因子ε范围内,则认为第k周期的峰值点有效;如果k时刻,高度数据超过所设置的高度阈值因子εJjJk时刻输出的高度数据用k-1时刻的高度数据进行替换。[0046]设置一个高度突变累计因子Θ,该高度突变累计因子Θ的定义为,如果从k时刻开始,连续b个周期,高度数据与前一周期的高度数据相比,都超过阈值门限因子Θ,则第k+b时亥IJ,将当前时刻解算出的高度数据作为当前时刻的高度数据。[0047]高度值输出,对于单次输出的高度数据,采用滑窗算法进行高度值的输出;第k时刻的高度数据等于滑窗中的N。个高度值去掉最大高度值和最小高度值后的均值,作为最后的高度数据输出,其计算公式为[0048]其中N。表示滑窗所采用的高度数据点数。[0049]本实施例作出的改进,如峰值点处理的时候增加了一个峰值阈值算法和高度阈值算法,通过这两个步骤,一起配合提高数据的稳定度,设计的谱最大估计算法,可以提高测距精度。[0050]实施例2:申请公布号CN104678397A的专利申请,公开了一种用于小型无人机的超声波高度表,采用了超声波的方式测量无人机近地时的离地高度,实现无人机的自主起降功能,但是该专利中所描述的超声波高度表最大测距为IIm,这对于植保无人机在喷洒农药使用过程中,是远远不够得。所以,为了提高无人机高度表的测距范围在30到40m之间,同时保障测距精度在0.2m左右,所以发明提出了一种基于毫米波雷达实现的无人机高度表。而且由于毫米波雷达与其他的探测方式相比,还具有探测性能稳定、环境适应良好、尺寸小、价格低,可以在相对恶劣的雨雪天气使用等优点。[0051]作为实施例1的技术方案的补充,本实施例所设计的毫米波雷达的工作频率在24GHz或77GHz,采用FMCW连续波体制,主要是由于线性调频方式,其距离分辨率高。波形可以采用线性调频三角波FMCW、锯齿波以及恒频波或是这几种波形的组合波形。采用单一的三角波发射波形,可以对目标进行相对距离的检测,通过检测出的无人机与植被之间的相对速度,假设植被静止,则该速度为无人机上下飞行速度。采用单一的三角波就可以完成目标相对距离的准确结算。锯齿波仅能对目标相对距离的检测,恒频波仅能对目标速度检测。由于无人机垂直飞行产生的多普勒频移,会造成一定的距离的偏差,所以可以采用锯齿波与恒频波的组合波形,通过恒频波段对速度的测量实现对锯齿波段距离检测的补偿,从而提高无人机与植被之间的距离精度。三角波以及锯齿波与恒频波的组合波形都可以作为发射波形实现植被无人机高度表,可根据不同的应用场景选择发射波形,从而更好地应用到不同的植被的应用领域,以达到更好地距离检测精度。[0052]本实施例设计的植被旋翼无人机雷达高度表系统的测距范围为1〜50m,测距精度为0.2m。[0053]本实施例主要是给出基于毫米波雷达的植被旋翼无人机防撞信号处理部分的设计以及信号处理方法。[0054]本实施例设计的雷达中心频率f为24.128GHz。发射波形选择单一锯齿波,周期为Ims,带宽为250MHz,采样率fs=320KHz。发射波形如图1所示。[0055]本实施例仅需要通过单路IQ数据实现对目标距离速度的解算。如下给出植被旋翼无人机防撞毫米波雷达信号处理流程图,如图2所示;[0056]具体实现步骤如下:[0057]I、AD数据采集,即数据处理[0058]将带有高度信息的连续IQ数据,通过AD采样进行数字化处理,AD采集到的数据点数N,跟系统的采样频率fs和扫频周期T相关,S卩N=fs*T。由于采集到的数据前部分数据由于系统原因存在异常,不能用于后续数据处理,所以需要去除掉部分数据后,将剩余的点的时域数据进行后续处理。设需要去掉的点的个数为N_q,则剩余点数的个数为N_s,则N_s=N_N_q。后续进行处理的数据则为N_s个的数据。[0059]2、去直流[0000]1分别计算I路、Q路,各自N_s个数据的均值Ijnean和Q_mean,[0061]艮P;[0062]其中I为I路的时域数据,Q为Q路的是与数据,Ijnean为I路的均值,Qjnean为Q路的均值。[0063]2将I路、Q路的每一个数据减掉上一步计算得到的均值M,从而完成去直流的目的,降低直流部分对目标门限检测的影响。[0064]3IQ数据去直流计算公式为:,其中,V为去直流后的数据,Q为去直流后的数据。[0065]3、窗函数处理[0066]去直流后的I、Q数据,合并成I+jQ的数据形式,然后进行加窗处理,可以选择汉宁窗或是海明窗等,降低旁瓣,从而提高目标的检测性能;汉宁窗会导致主瓣加宽并降低,但是旁瓣会显著减小。[0067]4、FFT变换[0068]加窗后的锯齿波I+jQ数据进行FFT变换,将时域数据转换成频率数据。[0069]5、CFAR门限检测[0070]将FFT变换后的各个点的复数模值进行CFAR门限检测。CFAR门限检测可以选择单元平均选小的门限检测方法S0-CFAR,保护单元可以选择1到2个点,窗点数可以选择15〜20个。[0071]6、峰值处理算法设计[0072]考虑到毫米波雷达高度表在进行FFT后的模值数据中,每一个峰值点对应相应的高度值。在经过CFAR门限检测后,选择最大点作为输出峰值。对于采用单峰值点输出的特点,很容易导致,峰值点发生大范围的跳变,比如前一周期输出峰值点为M=5,当前周期输出峰值变成M=30,则距离发生了15个点的跳变,则距离将会发生相应的跳变。为了提高旋翼无人机高度数据输出的稳定性,下面在进行过门限峰值提取的时候提出以下新的算法设计。[0073]设置一个峰值点阈值因子α,其用于限制检测出的过门限最大峰值点与上一周期出现的最大峰值点的差值绝对值,使得该差值绝对值不得大于该峰值点阈值因子α:[0074]表达式如下:[0075]IL_maxk_L_maxk_lI;[0076][0077]其中:L_max⑹为k周期的过门限最大峰值点坐标,L_maxk_l为上一周期的最大峰值点坐标,k表示第k时刻;vmax为无人机最大飞行速度,λ为毫米波雷达波长,fs为采样率,N为FFT的点数;[0078]如果k时刻,过门限最大峰值点与k-Ι时刻过门限最大峰值点的绝对值差值在所设置的峰值点阈值因子α范围内,则认为第k周期的峰值点有效;如果k时刻,过门限最大峰值点超过所设置的峰值点阈值因子α,则k时刻输出的峰值点用k-Ι时刻的峰值点进行替换。[0079]如果k时刻,过门限最大峰值点与k-Ι时刻过门限最大峰值点的绝对值差值在所设计的阈值因子范围内,则认为第k周期的峰值点有效,进行后续计算,如果k时刻,过门限最大峰值点超过所设计的阈值因子,则k时刻输出的峰值点用k-Ι时刻的峰值点进行替换。[0080]作为上述技术手段的解释,在相邻周期的一个时间单元内,当前周期解算出的峰值点,与上个周期的峰值点,如果在相邻周期内,速度没有发生变化,则峰值点在相邻周期内也会保持不变,但是如果在相邻周期时间内,无人机垂直飞行速度发生变化这里是针对高度表的,如果是防撞的话是无人机水平飞行速度),会导致当前周期的峰值点在上一周期的峰值点发生一定的变化,如果是无人机靠近地面,则当前周期的点数会大于上一周期的点数,如果无人机与地面进行远离,则当前周期的点数会小于上一周期的点数,该峰值点的变化范围即是所设计的峰值点阈值因子α,该因子选取的取值范围,主要取决于在相邻周期内,无人机的最大飞行速度,即公式其中vmax为无人机最大飞行速度,λ为毫米波雷达波长,fs为采样率,N为FFT的点数。[0081]但是如果植保旋翼无人机下方飞行环境发生突变后,高度值发生变化,对应的过门限的峰值点数也可能会连续发生超出所设计的阈值因子。如果不进行修正,高度发生突变后,每个周期检测到的过门限最大峰值点都会超过设置的阈值因子,每次过门限最大峰值点坐标都会被修正为上一时刻的峰值点坐标,即同理高度值也会保持高度突变前的高度值,不能适应突变后的高度值。为了提高无人机雷达高度表对各种环境的适应能力,为此引入一个峰值点突变累计因子Φ。[0082]该峰值点突变累计因子Φ的定义为,如果从k时刻开始,过门限最大峰值点的坐标值,连续b个周期发生突变,即连续b个周期出现的过门限最大峰值点与前一周期的过门限最大峰值点相比,都超过阈值门限因子a,则第k+b时刻,最大峰值点将不用上一周期的过门限最大峰值点进行替换,而是直接将当前时刻解算出的过门限最大峰值点作为当前时刻的过门限最大峰值点,从而完成高度发生突变场景的过门限最大峰值点的切换任务。b的取值范围为5〜10。[0083]7、谱最大估计算法[0084]通过上一步得出过门限最大峰值点后,为了提高植保旋翼无人机高度表系统高度值测量的精度,提出提高测距精度的谱最大估计算法。[0085]理想情况下,回波差频信号的频谱只有一个谱线,但是实际在使用过程中,由于采样存在栅栏效应,离散频谱最大幅值谱线必然会发生偏移谱峰位置,从而通过峰值点计算出的距离值与实际距离将会存在一定的误差。当谱峰发生偏移的时候,相对于主瓣峰值所对应的中央谱线将会两种情况,即左偏或是右偏。如果过门限最大值峰值点的左右峰值中,左边峰值大于右边峰值,则中央谱线所在的位置,在最大峰值点与左边峰值点之间,反之,则在最大峰值点与右边峰值点之间。[0086]由于FFT计算得到的频谱对连续距离普等间距采样,其频谱幅值最大点必定位于其曲线的主瓣内,主瓣内有且仅有两个采样点。得到过门限最大峰值点进行谱最大估计:设过门限最大峰值点Al的坐标为al,kl,其中,al表示过门限最大峰值点的值,kl表示过门限峰值点对应的幅度值;最大峰值点左右两边,次峰值点坐标为A3a3,k3,设所求的中央峰值点A为amax,kmax,则e=amax_al,贝IjAl点,关于A点对称点A2坐标为a2,kl=al+2e,kl,复包络的零点A4为a4,kl=a3+e,0;[0087]其中:a2、a3、a4是对应点的过门限最大峰值点的值,k3、k4是对应点的过门限峰值点对应的幅度值;[0088]A2、A3和A4近似为一条直线,其线性关系为:[0089][0090]令,则[0091]设定误差E与偏差e进行比对,如果IeI〈E,则此时的过门限峰值点的值则为所要求的中央峰值点的值,如果偏差e大于所设定的误差E时,,β为修正因子,取值范围为1.5〜1.9,改变修正因子计算出e的值,以计算得到中央峰值点的值amax=al+e。[0092]上述修正因子的选取理由是:由于初始的时候4点对称点A2坐标为a2,kl=al+2e,kl,初始条件时A点横轴坐标点与A2横轴坐标是关于最大峰值点对称的,即A2的坐标点是al+2e,如果偏差e大于所设定的误差E时,说明A2的坐标选取过大,也即是最大峰值点在al+2e之间,2倍的偏差e需要进行取小,本发明采用的修正方法是,通过改变修正因子β的大小从而改变1值,然后进行e的不断迭代,直到e小于设定的误差E为止。修正因子β的取值原则可以根据所需求达到的E值进行选取,如果E需求精度不高,修正因子β可以选择1.9进行修正,如果E需求精度很高,可能需要多次迭代达到要求,则需要修正因子β尽量选择小一点,可以选择1.5进行修正,本发明给出了一个快速解算出最大峰值点的修正因子的区间范围值,即修正因子β=1.5〜1.9。[0093]8、高度结算[0094]计算上一步得出的中央峰值点的值amaX,其对应的频率值f_amaX,根据公式,其中,T为调制周期,了=11118,8为调频带宽,8=2601取,3为光速,〇=3.0\1〇8。由于本实施例采用周期非常快的锯齿波,由于无人机垂直升降产生的最大速度所引起的差频频率基本上可以忽略,所以本实施例并没有涉及对相对速度的解算。[0095]至此,完成单次检测完成植保旋翼无人机雷达高度表系统高度信息的解算功能。[0096]9、为了提高高度表计算得出的高度信息的更加准确,进一步减少数据大范围波动等,因此采用以下数据处理算法进行进一步计算。[0097]具体实现方法如第6步的思想。[0098]首先设计一个高度阈值因子ε,该因子主要是用于限制当检测出当前高度数据H00与上一周期出现的高度数据Hk-Ι的差值绝对值不得大于该高度阈值因子ε。[0099]SP|Η⑹-Hk-lI彡ε,ε—般取值范围为0.8〜1.3。[0100]如果k时刻,高度数据与上一时刻k-l的绝对值差值在所设计的阈值因子范围内,则认为第k周期的峰值点有效,进行后续计算,如果k时刻,高度数据超过所设计的阈值因子,则k时刻输出的高度数据用k-l时刻的高度数据进行替换。[0101]同理但是如果植保旋翼无人机下方飞行环境发生突变后,高度值发生变化,对应的高度数据也可能会连续发生超出所设计的阈值因子。如果不进行修正,高度发生突变后,每个周期检测到的高度数据都会超过设置的阈值因子,每次高度数据都会被修正为上一时刻的高度数据,不能很好地适应突变后的高度值。为了提高高度输出的进一步稳定性,为此引入一个高度突变累计因子Θ。[0102]该高度突变累计因子Θ的定义为,如果从k时刻开始,高度数据连续b个周期发生突变,即连续b个周期出现高度数据与前一周期的高度数据相比,都超过阈值门限因子Θ,则第k+b时刻,高度数据将不用上一周期的高度数据进行替换,而是直接将当前时刻解算出的高度数据作为当前时刻的高度数据,从而完提高高度数据的稳定性。[0103]对于单次输出的高度数据,为了输出的平滑性,采用滑窗算法进行高度值的输出。即第k时刻的高度数据等于滑窗中的N。个高度值去掉最大高度值和最小高度值后的均值,作为最后的高度数据输出,其计算公式为[0104]其中N。表示滑窗所采用的高度数据点数。[0105]实施例3:由上述两个实施例中的技术方案中,可以发现,该两个实施例所公开的技术方案中,还包括了一种无人机高度信号的峰值跟踪方法,本实施例对该跟踪方法进行整理,明显的,本实施例中的跟踪方法,可以由上述两个实施例支持得到,然而,其是一种可以独立应用于无人机的无人机高度信号的峰值跟踪方法,并不局限于上述两个实施例中的技术方案,该跟踪方法具有:过门限峰值点跟踪的步骤;及距离跟踪的步骤。[0106]其中:所述的过门限峰值点跟踪的方法是:[0107]设置一个峰值点阈值因子α,其用于限制检测出的过门限最大峰值点与上一周期出现的最大峰值点的差值绝对值,使得该差值绝对值不得大于该峰值点阈值因子α:[0108]表达式如下:[0109]IL_maxk_L_maxk_lI;[0110][0111]其中:L_max⑹为k周期的过门限最大峰值点坐标,L_maxk-1为上一周期的最大峰值点坐标,k表示第k时刻;vmax为无人机最大飞行速度,λ为毫米波雷达波长,fs为采样率,N为FFT的点数;[0112]如果k时刻,过门限最大峰值点与k-Ι时刻过门限最大峰值点的绝对值差值在所设置的峰值点阈值因子α范围内,则认为第k周期的峰值点有效;如果k时刻,过门限最大峰值点超过所设置的峰值点阈值因子α,则k时刻输出的峰值点用k-Ι时刻的峰值点进行替换。[0113]作为上述技术手段的解释,在相邻周期的一个时间单元内,当前周期解算出的峰值点,与上个周期的峰值点,如果在相邻周期内,速度没有发生变化,则峰值点在相邻周期内也会保持不变,但是如果在相邻周期时间内,无人机垂直飞行速度发生变化这里是针对高度表的,如果是防撞的话是无人机水平飞行速度),会导致当前周期的峰值点在上一周期的峰值点发生一定的变化,如果是无人机靠近地面,则当前周期的点数会大于上一周期的点数,如果无人机与地面进行远离,则当前周期的点数会小于上一周期的点数,该峰值点的变化范围即是所设计的峰值点阈值因子α,该因子选取的取值范围,主要取决于在相邻周期内,无人机的最大飞行速度,即公式其中vmax为无人机最大飞行速度,λ为毫米波雷达波长,fs为采样率,N为FFT的点数。[0114]但是如果植保旋翼无人机下方飞行环境发生突变后,高度值发生变化,对应的过门限的峰值点数也可能会连续发生超出所设计的阈值因子。如果不进行修正,高度发生突变后,每个周期检测到的过门限最大峰值点都会超过设置的阈值因子,每次过门限最大峰值点坐标都会被修正为上一时刻的峰值点坐标,即同理高度值也会保持高度突变前的高度值,不能适应突变后的高度值。为了提高无人机雷达高度表对各种环境的适应能力,为此引入一个峰值点突变累计因子Φ。[0115]设置一个峰值点突变累计因子Φ,该峰值点突变累计因子Φ的定义为,如果从k时刻开始,连续b个周期,b的取值范围为5〜10,过门限最大峰值点与前一周期的过门限最大峰值点相比,都超过阈值门限因子a,则第k+b时刻,将当前时刻解算出的过门限最大峰值点作为当前时刻的过门限最大峰值点。为了保证跟踪的实时性,建议b的取值为5〜10个。[0116]通过上一步得出过门限最大峰值点后,为了提高高度表系统高度值测量的精度,提出提高测距精度的谱最大估计算法。[0117]理想情况下,回波差频信号的频谱只有一个谱线,但是实际在使用过程中,由于采样存在栅栏效应,离散频谱最大幅值谱线必然会发生偏移谱峰位置,从而通过峰值点计算出的距离值与实际距离将会存在一定的误差。当谱峰发生偏移的时候,相对于主瓣峰值所对应的中央谱线将会两种情况,即左偏或是右偏。如果过门限最大值峰值点的左右峰值中,左边峰值大于右边峰值,则中央谱线所在的位置,在最大峰值点与左边峰值点之间,反之,则在最大峰值点与右边峰值点之间。[0118]由于FFT计算得到的频谱对连续距离普等间距采样,其频谱幅值最大点必定位于其曲线的主瓣内,主瓣内有且仅有两个采样点。设过门限最大峰值点Al的坐标为al,kl,其中,al表示过门限最大峰值点的值,kl表示过门限峰值点对应的幅度值;最大峰值点左右两边,次峰值点坐标为A3a3,k3,设所求的中央峰值点A为amax,kmax,贝lje=amax_al,则Al点,关于A点对称点A2坐标为a2,kl=al+2e,kl,复包络的零点A4为a4,kl=a3+e,〇;[0119]其中:a2、a3、a4是对应点的过门限最大峰值点的值,k3、k4是对应点的过门限峰值点对应的幅度值;[0120]A2、A3和A4近似为一条直线,其线性关系为:[0121][0122]令,则[0123]设定误差E与偏差e进行比对,如果IeI〈E,则此时的过门限峰值点的值则为所要求的中央峰值点的值,如果偏差e大于所设定的误差E时必为修正因子,取值范围为1.5〜1.9,该修正因子的选取理由是:由于初始的时候,4点对称点Α2坐标为a2,kl=al+2e,kl,初始条件时A点横轴坐标点与Α2横轴坐标是关于最大峰值点对称的,即A2的坐标点是al+2e,如果偏差e大于所设定的误差E时,说明A2的坐标选取过大,也即是最大峰值点在al+2e之间,2倍的偏差e需要进行取小,本发明采用的修正方法是,通过改变修正因子β的大小从而改变1值,然后进行e的不断迭代,直到e小于设定的误差E为止。修正因子邱勺取值原则可以根据所需求达到的E值进行选取,如果E需求精度不高,修正因子β可以选择1.9进行修正,如果E需求精度很高,可能需要多次迭代达到要求,则需要修正因子β尽量选择小一点,可以选择1.5进行修正,本发明给出了一个快速解算出最大峰值点的修正因子的区间范围值,即修正因子β=1.5〜1.9。改变修正因子计算出e的值,以计算得到中央峰值点的值amax=aI+e。[0124]所述距离跟踪:设置一个高度阈值因子ε,其用于限制当前高度数据H⑹与上一周期出现的高度数据Hk-Ι的差值绝对值,使得该差值绝对值不得大于该高度阈值因子ε;[0125]表达式如下:[0126]|Η⑹-Hk-lI彡ε,ε取值范围为0.8〜1.3;[0127]如果k时刻的高度数据与k_1时刻的绝对值差值,在所设置的高度阈值因子ε范围内,则认为第k周期的峰值点有效;如果k时刻,高度数据超过所设置的高度阈值因子εJjJk时刻输出的高度数据用k_l时刻的高度数据进行替换。[0128]设置一个高度突变累计因子Θ,该高度突变累计因子Θ的定义为,如果从k时刻开始,连续b个周期,高度数据与前一周期的高度数据相比,都超过阈值门限因子Θ,则第k+b时亥IJ,将当前时刻解算出的高度数据作为当前时刻的高度数据。[0129]高度输出时,对于单次输出的高度数据,采用滑窗算法进行高度值的输出;[0130]第k时刻的高度数据等于滑窗中的N。个高度值去掉最大高度值和最小高度值后的均值,作为最后的高度数据输出,其计算公式为[0131]其中N。表示滑窗所采用的高度数据点数。[0132]采用峰值跟踪算法和高度跟踪算法,可以有效避免由于单次或是多次峰值搜索的错误而导致一次或是多次高度数据解算的异常现象,如在单次峰值搜索过程中,发生峰值跳变,相邻周期之间的峰值差值很大,同时由与峰值的跳变,而引起的高度发生很大的跳变,即该周期内,峰值跳变引起的高度的跳变范围,已经远远大于由无人机速度引起的一个周期所产生的距离变化范围。由此峰值跟踪以及高度跟踪可以有效避免这种异常峰值导致的异常高度值,从而有效地的提高跟踪的高度数据的稳定度。[0133]以上所述,仅为本发明创造较佳的具体实施方式,但本发明创造的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明创造披露的技术范围内,根据本发明创造的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明创造的保护范围之内。

权利要求:1.一种无人机高度信号的峰值跟踪方法,其特征在于,具有:过门限峰值点跟踪的步骤;及距离跟踪的步骤。2.如权利要求1所述的无人机防撞信号的峰值跟踪方法,其特征在于,所述的过门限峰值点跟踪的方法是:设置一个峰值点阈值因子α,其用于限制检测出的过门限最大峰值点与上一周期出现的最大峰值点的差值绝对值,使得该差值绝对值不得大于该峰值点阈值因子α:表达式如下:其中:L_maxk为k周期的过门限最大峰值点坐标,L_maxk-1为上一周期的最大峰值点坐标,k表示第k时刻;vmax为无人机最大飞行速度,λ为毫米波雷达波长,fs为采样率,N为FFT的点数;如果k时刻,过门限最大峰值点与k-Ι时刻过门限最大峰值点的绝对值差值在所设置的峰值点阈值因子α范围内,则认为第k周期的峰值点有效;如果k时刻,过门限最大峰值点超过所设置的峰值点阈值因子α,则k时刻输出的峰值点用k-Ι时刻的峰值点进行替换。3.如权利要求2所述的无人机防撞信号的峰值跟踪方法,其特征在于,设置一个峰值点突变累计因子Φ,该峰值点突变累计因子Φ的定义为,如果从k时刻开始,连续b个周期,b的取值范围为5〜10,过门限最大峰值点与前一周期的过门限最大峰值点相比,都超过阈值门限因子a,则第k+b时刻,将当前时刻解算出的过门限最大峰值点作为当前时刻的过门限最大峰值点。4.如权利要求2所述的无人机防撞信号的峰值跟踪方法,其特征在于,得到过门限最大峰值点进行谱最大估计:设过门限最大峰值点Al的坐标为al,kl,其中,al表示过门限最大峰值点的值,kl表示过门限峰值点对应的幅度值;最大峰值点左右两边,次峰值点坐标为A3a3,k3,设所求的中央峰值点A为amax,kmax,贝Ije=amax_al,则Al点,关于A点对称点A2坐标为a2,kl=al+2e,kl,复包络的零点A4为a4,kl=a3+e,0;其中:a2、a3、a4是对应点的过门限最大峰值点的值,k3、k4是对应点的过门限峰值点对应的幅度值;A2、A3和A4近似为一条直线,其线性关系为:令设定误差E与偏差e进行比对,如果IeI〈E,则此时的过门限峰值点的值则为所要求的中央峰值点的值,如果偏差e大于所设定的误差E时,,β为修正因子,取值范围为1.5〜1.9,改变修正因子计算出e的值,以计算得到中央峰值点的值amax=al+e。5.如权利要求1所述的无人机防撞信号的峰值跟踪方法,其特征在于,所述距离跟踪:设置一个高度阈值因子ε,其用于限制当前高度数据Hk与上一周期出现的高度数据Hk-1的差值绝对值,使得该差值绝对值不得大于该高度阈值因子ε;表达式如下:Hk-Hk_lI彡ε,ε取值范围为0.8〜1.3;如果k时刻的高度数据与k-Ι时刻的绝对值差值,在所设置的高度阈值因子ε范围内,则认为第k周期的峰值点有效;如果k时刻,高度数据超过所设置的高度阈值因子ε,则k时刻输出的高度数据用k-Ι时刻的高度数据进行替换。6.如权利要求5所述的无人机防撞信号的峰值跟踪方法,其特征在于,设置一个高度突变累计因子Θ,该高度突变累计因子Θ的定义为,如果从k时刻开始,连续b个周期,高度数据与前一周期的高度数据相比,都超过阈值门限因子Θ,则第k+b时刻,将当前时刻解算出的高度数据作为当前时刻的高度数据。7.如权利要求1所述的无人机防撞信号的峰值跟踪方法,其特征在于:高度输出时,对于单次输出的高度数据,采用滑窗算法进行高度值的输出;第k时刻的高度数据等于滑窗中的N。个高度值去掉最大高度值和最小高度值后的均值,作为最后的高度数据输出,其计算公式为其中N。表示滑窗所采用的高度数据点数。

百度查询: 大连楼兰科技股份有限公司 无人机高度信号的峰值跟踪方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。