利索能及
我要发布
收藏
专利号: 2018115195937
申请人: 东软集团股份有限公司
专利类型:发明专利
专利状态:已下证
更新日期:2025-04-10
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种消除航向抖动的滤波方法,其特征在于,包括:获取航向采样值;

将本次获取到的所述航向采样值,输入一阶低通滤波模型,获得本次航向采样值对应的航向滤波输出值;

若确定连续m次航向变化方向相同,则根据在所述连续m次同向的航向变化期间航向采样值的变化值、与预设的转动角度阈值,确定滤波系数增量,其中,m为大于1的正整数,所述变化值为第m次航向变化对应的航向采样值与第1次航向变化对应的航向采样值之差,所述滤波系数具有预设上限值,所述滤波系数被增大而不超过所述预设上限值;

若当前滤波系数与所述滤波系数增量之和不超过所述预设上限值,则将所述当前滤波系数与所述滤波系数增量之和确定为新的滤波系数;

若当前滤波系数与所述滤波系数增量之和超过所述预设上限值,则将所述预设上限值确定为新的滤波系数。

2.根据权利要求1所述的方法,其特征在于,所述一阶低通滤波模型中的滤波系数具有预设下限值,所述预设下限值用于提供滤波性;

所述方法还包括:

若确定连续n次航向变化方向不同,则将所述滤波系数设定为所述预设下限值,其中n为大于1的正整数。

3.根据权利要求1或2所述的方法,其特征在于,所述航向变化方向通过以下方式确定:根据所述本次航向采样值与上一次航向采样值对应的航向滤波输出值,确定本次航向变化方向。

4.根据权利要求3所述的方法,其特征在于,所述根据所述本次航向采样值与上一次航向采样值对应的航向滤波输出值,确定本次航向变化方向,包括:若所述本次航向采样值大于上一次航向采样值对应的航向滤波输出值、且所述本次航向采样值与所述上一次航向采样值对应的航向滤波输出值的差值的绝对值未超过预设阈值,则确定本次航向变化方向为第一方向;

若所述本次航向采样值小于上一次航向采样值对应的航向滤波输出值、且所述本次航向采样值与所述上一次航向采样值对应的航向滤波输出值的差值的绝对值超过预设阈值,则确定本次航向变化方向为所述第一方向;

若所述本次航向采样值大于上一次航向采样值对应的航向滤波输出值、且所述本次航向采样值与所述上一次航向采样值对应的航向滤波输出值的差值的绝对值超过预设阈值,则确定本次航向变化方向为第二方向;

若所述本次航向采样值小于上一次航向采样值对应的航向滤波输出值,且所述本次航向采样值与所述上一次航向采样值对应的航向滤波输出值的差值的绝对值未超过预设阈值,则确定本次航向变化方向为所述第二方向,其中,所述第二方向为与所述第一方向相反的方向。

5.根据权利要求1所述的方法,其特征在于,所述滤波系数具有预设下限值,所述预设下限值用于提供滤波性,所述滤波系数的初始值为所述预设下限值,所述预设上限值用于提供跟踪性。

6.根据权利要求1所述的方法,其特征在于,所述一阶低通滤波模型为:其中,Y(i)表征第i次航向采样值对应的航向滤波输出值,Y(i‑1)表征第i‑1次航向采样值对应的航向滤波输出值,X(i)表征第i次航向采样值,α表征所述一阶低通滤波模型中的滤波系数;

所述根据在所述连续m次同向的航向变化期间航向采样值的变化值、与预设的转动角度阈值,确定滤波系数增量,包括:通过以下公式确定所述滤波系数增量:其中,αa表征所述滤波系数增量,W表征在所述连续m次同向的航向变化期间,第m次航向变化对应的航向采样值和第1次航向变化对应的航向采样值的变化值,w表征所述预设的转动角度阈值。

7.根据权利要求1所述的方法,其特征在于,所述方法还包括:若确定连续m次航向变化方向相同、且在连续m次同向的航向变化期间航向采样值的变化值大于或等于预设的转动角度阈值,则将所述一阶低通滤波模型中的滤波系数设定为所述预设上限值。

8.一种消除航向抖动的滤波装置,其特征在于,包括:获取模块,用于获取航向采样值;

滤波模块,用于将所述获取模块本次获取到的所述航向采样值,输入一阶低通滤波模型,获得本次航向采样值对应的航向滤波输出值;

调整模块,用于若确定连续m次航向变化方向相同,根据在所述连续m次同向的航向变化期间航向采样值的变化值、与预设的转动角度阈值,确定滤波系数增量,其中,m为大于1的正整数,所述变化值为第m次航向变化对应的航向采样值与第1次航向变化对应的航向采样值之差,所述滤波系数具有预设上限值,所述滤波系数被增大而不超过所述预设上限值;

若当前滤波系数与所述滤波系数增量之和不超过所述预设上限值,则将所述当前滤波系数与所述滤波系数增量之和确定为新的滤波系数;

若当前滤波系数与所述滤波系数增量之和超过所述预设上限值,则将所述预设上限值确定为新的滤波系数。

9.根据权利要求8所述的装置,其特征在于,所述一阶低通滤波模型中的滤波系数具有预设下限值,所述预设下限值用于提供滤波性;

所述装置还包括:

第一确定模块,用于若确定连续n次航向变化方向不同,则将所述滤波系数设定为所述预设下限值,其中n为大于1的正整数。

10.根据权利要求8或9所述的装置,其特征在于,所述装置还包括:第二确定模块,用于根据所述本次航向采样值与上一次航向采样值对应的航向滤波输出值,确定本次航向变化方向。

11.根据权利要求10所述的装置,其特征在于,所述第二确定模块包括:第一确定子模块,用于若所述本次航向采样值大于上一次航向采样值对应的航向滤波输出值、且所述本次航向采样值与所述上一次航向采样值对应的航向滤波输出值的差值的绝对值未超过预设阈值,则确定本次航向变化方向为第一方向;

第二确定子模块,用于若所述本次航向采样值小于上一次航向采样值对应的航向滤波输出值、且所述本次航向采样值与所述上一次航向采样值对应的航向滤波输出值的差值的绝对值超过预设阈值,则确定本次航向变化方向为所述第一方向;

第三确定子模块,用于若所述本次航向采样值大于上一次航向采样值对应的航向滤波输出值、且所述本次航向采样值与所述上一次航向采样值对应的航向滤波输出值的差值的绝对值超过预设阈值,则确定本次航向变化方向为第二方向;

第四确定子模块,用于若所述本次航向采样值小于上一次航向采样值对应的航向滤波输出值,且所述本次航向采样值与所述上一次航向采样值对应的航向滤波输出值的差值的绝对值未超过预设阈值,则确定本次航向变化方向为所述第二方向,其中,所述第二方向为与所述第一方向相反的方向。

12.根据权利要求8所述的装置,其特征在于,所述滤波系数具有预设下限值,所述预设下限值用于提供滤波性;所述滤波系数的初始值为所述预设下限值,所述预设上限值用于提供跟踪性。

13.根据权利要求8所述的装置,其特征在于,所述一阶低通滤波模型为:其中,Y(i)表征第i次航向采样值对应的航向滤波输出值,Y(i‑1)表征第i‑1次航向采样值对应的航向滤波输出值,X(i)表征第i次航向采样值,α表征所述一阶低通滤波模型中的滤波系数;

第五确定子模块包括:

第八确定子模块,用于通过以下公式确定所述滤波系数增量:其中,αa表征所述滤波系数增量,W表征在所述连续m次同向的航向变化期间,第m次航向变化对应的航向采样值和第1次航向变化对应的航向采样值的变化值,w表征所述预设的转动角度阈值。

14.根据权利要求8所述的装置,其特征在于,所述调整模块还用于:若确定连续m次航向变化方向相同、且在连续m次同向的航向变化期间航向采样值的变化值大于或等于预设的转动角度阈值,则将所述一阶低通滤波模型中的滤波系数设定为所述预设上限值。

15.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1‑7中任一项所述方法的步骤。

16.一种电子设备,其特征在于,包括:存储器,其上存储有计算机程序;

处理器,用于执行所述存储器中的所述计算机程序,以实现权利要求1‑7中任一项所述方法的步骤。