一种轨迹纠偏方法、装置、终端设备及存储介质与流程

文档序号:20933394发布日期:2020-06-02 19:12阅读:来源:国知局

技术特征:

1.一种轨迹纠偏方法,其特征在于,包括:

获取待处理的目标轨迹;

对所述目标轨迹中的各个位置点分别进行滤波纠偏,得到第一纠偏轨迹;

计算所述第一纠偏轨迹中相邻时刻两点之间的实际距离,并计算所述第一纠偏轨迹中相邻时刻两点之间的极限距离;

根据所述实际距离和所述极限距离从所述第一纠偏轨迹中剔除异常位置点,得到第二纠偏轨迹;

对所述第二纠偏轨迹中的各个位置点分别进行滤波纠偏,得到第三纠偏轨迹。

2.如权利要求1所述的一种轨迹纠偏方法,其特征在于,所述对所述目标轨迹中的各个位置点分别进行滤波纠偏,还包括:

以所述位置点为中心,对预设范围内的位置点进行拉取;

若所述预设范围内的位置点的数量大于或等于预设的阈值,则进行所述位置点的滤波纠偏;

若所述预设范围内的位置点的数量小于所述预设的阈值,则增大范围继续拉取增大范围后的位置点。

3.如权利要求2所述的一种轨迹纠偏方法,其特征在于,所述增大范围继续拉取增大范围后的位置点,步骤之后包括:

若所述增大范围后的位置点的数量大于等于所述预设的阈值,则进行所述位置点的滤波纠偏;

若达到预设的最大范围后,判断出所述位置点为奇点,则查询所述奇点前一位置点的位置;

将查询到的所述奇点前一位置点的位置设置为所述奇点的位置。

4.如权利要求3所述的一种轨迹纠偏方法,其特征在于,所述查询所述奇点前一位置点的位置,步骤之后还包括:

若所述奇点没有查询到前一位置点的位置,则保留所述奇点不进行纠偏。

5.如权利要求1所述的一种轨迹纠偏方法,其特征在于,所述根据所述实际距离和所述极限距离从所述第一纠偏轨迹中剔除异常位置点,得到第二纠偏轨迹,包括:

从所述第一纠偏轨迹中获取所述异常位置点,所述异常位置点为与前一时刻位置点之间的所述实际距离大于所述极限距离的位置点;

对所述异常位置点进行剔除操作,得到所述第二纠偏轨迹。

6.如权利要求1所述的一种轨迹纠偏方法,其特征在于,所述计算所述第一纠偏轨迹中相邻时刻两点之间的极限距离,包括:

获取预设的最大速度,并计算所述相邻时刻两点之间的时间差;

根据所述时间差以及所述最大速度计算出所述相邻时刻两点之间的极限距离。

7.一种轨迹纠偏装置,其特征在于,包括:

获取模块,用于获取待处理的目标轨迹;

第一滤波纠偏模块,用于对所述目标轨迹中的各个位置点分别进行滤波纠偏,得到第一纠偏轨迹;

计算模块,用于计算所述第一纠偏轨迹中相邻时刻两点之间的实际距离,并计算所述第一纠偏轨迹中相邻时刻两点之间的极限距离;

剔除异常点模块,用于根据所述实际距离和所述极限距离从所述第一纠偏轨迹中剔除异常位置点,得到第二纠偏轨迹;

第二滤波纠偏模块,用于对所述第二纠偏轨迹中的各个位置点分别进行滤波纠偏,得到第三纠偏轨迹。

8.如权利要求7所述的一种轨迹纠偏装置,其特征在于,包括:

拉取模块,用于以所述位置点为中心,对预设范围内的位置点进行拉取;

第三滤波纠偏模块,用于若所述预设范围内的位置点的数量大于或等于预设的阈值,则进行所述位置点的滤波纠偏;

继续拉取模块,用于若所述预设范围内的位置点的数量小于所述预设的阈值,则增大范围继续拉取增大范围后的位置点。

9.一种终端设备,包括处理器,与所述处理器连接的存储器,以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至6任一项所述的一种轨迹纠偏方法的步骤。

10.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至6任一项所述的一种轨迹纠偏方法的步骤。


技术总结
本发明属于轨迹纠偏领域,尤其涉及一种轨迹纠偏方法、装置、终端设备及存储介质。本发明实施例通过获取待处理的目标轨迹;对所述目标轨迹中的各个位置点分别进行滤波纠偏,得到第一纠偏轨迹;计算所述第一纠偏轨迹中相邻时刻两点之间的实际距离,并计算所述第一纠偏轨迹中相邻时刻两点之间的极限距离;根据所述实际距离和所述极限距离从所述第一纠偏轨迹中剔除异常位置点,得到第二纠偏轨迹;对所述第二纠偏轨迹中的各个位置点分别进行滤波纠偏,得到第三纠偏轨迹,整个过程可以解决车辆运行过程中轨迹误差大的问题。

技术研发人员:韩朋
受保护的技术使用者:深圳猛犸电动科技有限公司
技术研发日:2019.12.24
技术公布日:2020.06.02
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1