一种基于语义信息的停车场粒子滤波定位方法与流程

文档序号:26836055发布日期:2021-10-03 11:53阅读:来源:国知局

技术特征:

1.一种基于语义信息的停车场粒子滤波定位方法,其特征在于,包括步骤:

S100判断第一语义目标在语义地图中出现的数量是否小于预设的数量阈值;

S200当所述第一语义目标出现的数量小于预设的所述数量阈值时,在每个所述第一语义目标对应的位置播撒粒子;

S300对所有的所述粒子的位姿求平均,获得车辆在所述语义地图上的定位结果。

2.根据权利要求1所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,在所述的S200当所述第一语义目标出现的数量小于预设的所述数量阈值时,在每个所述第一语义目标对应的位置播撒粒子与所述的S300对所有的所述粒子的位姿求平均,获得车辆在所述语义地图上的定位结果之间包括步骤:

S210获取车辆CAN数据,根据所述车辆CAN数据计算所述粒子的位姿预测;

S220获取第二语义目标,将所述第二语义目标与语义地图匹配,得到匹配数据,根据所述匹配数据更新粒子权重并重采样,直至粒子收敛。

3.根据权利要求1所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,在所述的S100判断第一语义目标在语义地图中出现的数量是否小于预设的数量阈值之前包括步骤:

S10预先设定一语义目标出现的数量阈值。

4.根据权利要求1所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,在所述的S100判断第一语义目标在语义地图中出现的数量是否小于预设的数量阈值之前包括步骤:

S20构建所述语义地图。

5.根据权利要求1所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,在所述的S100判断第一语义目标在语义地图中出现的数量是否小于预设的数量阈值之前包括步骤:

S30获取所述第一语义目标。

6.根据权利要求5所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,在所述的S30获取所述第一语义目标之后包括步骤:

S301判断第一语义目标是否包含唯一语义元素;

S302当所述第一语义目标包含所述唯一语义元素时,直接在这个时刻完成粒子初始化以快速收敛。

7.根据权利要求2所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,所述的S210获取车辆CAN数据,根据所述车辆CAN数据计算所述粒子的位姿预测具体包括步骤:

S2101根据所述车辆CAN数据计算车辆的相对位移量,从而获得每个粒子的位姿预测。

8.根据权利要求2所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,所述的S220获取第二语义目标,将所述第二语义目标与语义地图匹配,得到匹配数据,根据所述匹配数据更新粒子权重并重采样,直至粒子收敛具体包括步骤:

S2201遍历所有的所述粒子,根据所述粒子的位姿预测,获得位姿预测中语义目标;

S2202换算所述语义目标在语义地图中的位置;

S2203将所述语义目标在语义地图中的位置与车辆当前观察到的第二语义目标的位置进行匹配,得到匹配结果。

9.根据权利要求8所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,所述的S2203将所述语义目标在语义地图中的位置与车辆当前观察到的第二语义目标的位置进行匹配,得到匹配结果之后包括步骤:

S2204根据所述匹配结果更新所述粒子的权重。

10.根据权利要求9所述的一种基于语义信息的停车场粒子滤波定位方法,其特征在于,所述的S2204根据所述匹配结果更新所述粒子的权重之后包括步骤:

S2205根据粒子的权重进行序贯重要性重采样;

S2206附加高斯噪声保持粒子多样性。


技术总结
本发明属于车辆定位技术领域,公开了一种基于语义信息的停车场粒子滤波定位方法,包括步骤:判断第一语义目标在语义地图中出现的数量是否小于预设的数量阈值;当所述第一语义目标出现的数量小于预设的所述数量阈值时,在每个所述第一语义目标对应的位置播撒粒子;对所有的所述粒子的位姿求平均,获得车辆在所述语义地图上的定位结果。本发明在车辆行进至看到某些地图中数量小的语义目标时再选择播撒粒子,减小粒子数量并加快收敛速度,实现停车场区域内的高精度定位;利用车辆自带的摄像头传感器实现低成本的实时高精度定位;适用于自动驾驶场景。

技术研发人员:张祎;蒋如意;马光林;于萌萌;田钧;
受保护的技术使用者:上海追势科技有限公司;
技术研发日:2021.06.02
技术公布日:2021.10.01
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1