Range gate algorithm, which mainly includes the setting of boundary conditions; point distance input is to input data according to the format required by the algorithm to ensure the correctness of the data used by the algorithm; range construction includes the first speed matching navigation and the residual point rebuilding recursion; now point distance matching output includes filtering The distance matching point and the optimal matching distance, the output and storage of the optimal route distance, the failure judgment of the distance route and the output of the first mismatching distance make the current route distance of the algorithm output the best; the future point distance recursive calculation includes calculating the recursive speed of the distance route, calculating the recursive distance and storing the future point distance. The algorithm can match the future point distance more quickly by modifying the distance from the gate. According to the distance gate algorithm realized by the invention, the cyclic operation realized by the algorithm can analyze the correctness of all the point distances from all the distance routes and improve the accuracy of the route construction.
【技术实现步骤摘要】
一种距离波门算法
本专利技术属于剔除距离杂波算法,具体涉及工程实际嵌入式环境中将距离曲线降阶为速度直线进行距离递推,用于剔除干扰距离、优选测距过程中的输出值。适用于频率不大于200Hz的重频测距机。
技术介绍
激光测距技术有很广泛的应用,包括机载、车载、舰载和手持式等多种用途。在工程环境中测距机多使用嵌入式系统作为其控制载体。测距值的有效性随测距机性能、目标动态位置、测距机载体动态位置、云层或其它飞行物遮挡和其它环境因素等波动,形成了测距回波的错回、漏回和多回等情况。数据处理因嵌入式系统运行环境限制,传统测距结果反馈或以第一回波为输出、或以简单算法结果为输出,从而使得测距机的回波率及准测率受到影响,使测距机的使用范围受到了限制。
技术实现思路
本专利技术为了解决现有技术中的测距机的使用范围受限的技术问题,提出了一种距离波门算法,距离波门算法,其特征在于,该算法包括如下步骤:边界条件设置,初始化设置距离波门算法的边界条件,包括目标最大速度Vmax,目标最大速率变换倍数,航路预失效点数及失效点数,以及自适应距离波门初始值,包括距离波门最大值BMmax及最小值BMmin;接 ...
【技术保护点】
1.一种距离波门算法,其特征在于,该算法包括如下步骤:边界条件设置,初始化设置距离波门算法的边界条件,包括目标最大速度Vmax,目标最大速率变换倍数,航路预失效点数及失效点数,以及自适应距离波门初始值,包括距离波门最大值BMmax及最小值BMmin;接收测距机的点距离信息Ln,其中n为接收的有效点距离的序号,每个点距离信息中包含N个距离值,记为Ln1,Ln2,Ln3…LnN,其中N可根据算法头文件中的常量进行设置,最大不能大于10;利用所述Ln进行首次点距离建航,包括如下过程:当连续接收到3个点距离信息L1、L2、L3时执行首次匹配建航,依次计算相邻2点的差分速度记为V1= ...
【技术特征摘要】
1.一种距离波门算法,其特征在于,该算法包括如下步骤:边界条件设置,初始化设置距离波门算法的边界条件,包括目标最大速度Vmax,目标最大速率变换倍数,航路预失效点数及失效点数,以及自适应距离波门初始值,包括距离波门最大值BMmax及最小值BMmin;接收测距机的点距离信息Ln,其中n为接收的有效点距离的序号,每个点距离信息中包含N个距离值,记为Ln1,Ln2,Ln3…LnN,其中N可根据算法头文件中的常量进行设置,最大不能大于10;利用所述Ln进行首次点距离建航,包括如下过程:当连续接收到3个点距离信息L1、L2、L3时执行首次匹配建航,依次计算相邻2点的差分速度记为V1=L2m2-L1m1和V2=L3m3-L2m2,其中L1m1,L2m2,L3m3分别为L1,L2,L3中的某个距离值,如果V1及V2满足如下条件时认为当前3个距离值可以建航,存入第一空航路中,若L1、L2、L3中的距离值均不满足建航条件则建航失败,等待下一个点距离信息:|V1|<=Vmax/fand|V2|<=Vmax/fand|V2-V1|<=Vmax/f,其中f为所述测距机的重频频率;建航后将已参与建航的所述有效点距离值L1m1,L2m2,L3m3分别从L1,L2,L3中删除形成{L1′,L2′,L3′},并计算存储所述第一航路的最小二乘法参数及当前航路信息,具体为:所述第一航路当前点速度Vd(1)=V2及未来点距离Ld(1)=L3,航路点数Nd(1)=3,距离波门BM(1)=BMmax;最小二乘法参数V0(1)=V1,T0(1)=2,VT(1)=2*V1,T2(1)=T02,其中所述最小二乘法参数用于计算建航方程y=kx+b的系数,其中:k(1)=((Nd(1)-1)*VT(1)-V0(1)*T0(1))/((Nd(1)-1)*T2(1)-T0(1)2)b(1)=(V0(1)*T2(1)-VT(1)*T0(1))/((Nd(1)-1)*T2(1)-T0(1)2),由此完成了首次建航,建航方...
【专利技术属性】
技术研发人员:赵永计,皮雳,傅振宇,李庆远,祝开奕,李海龙,
申请(专利权)人:湖北华中光电科技有限公司,
类型:发明
国别省市:湖北,42
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。