利索能及
我要发布
收藏
专利号: 2021110061904
申请人: 亿咖通(湖北)技术有限公司
专利类型:发明专利
专利状态:已下证
更新日期:2026-06-16
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种设备定位方法,其特征在于,包括:根据预先确定的多种道路元素类型,将第一地图分割为多个第二地图,其中,所述多个第二地图和所述多种道路元素类型一一对应;

采集得到目标设备的第一传感信息,其中,所述第一传感信息为所述目标设备当前所处位置的道路传感信息;

根据所述多种道路元素类型,将所述第一传感信息分割为多组第二传感信息,其中,所述多组第二传感信息和所述多种道路元素类型一一对应;

根据所述多种道路元素类型,分别将同一道路元素类型对应的第二地图和第二传感信息进行配准,得到多个局部最优位姿,其中,所述多个局部最优位姿分别与所述多个道路元素类型一一对应;

融合所述多个局部最优位姿,得到所述目标设备当前的全局最优位姿。

2.根据权利要求1所述的方法,其特征在于,根据预先确定的多种道路元素类型,将第一地图分割为多个第二地图,包括:分割所述第一地图,得到所述第一地图包括的多个第一物体的信息,其中,所述第一地图根据所述目标设备的历史位姿信息和历史传感信息建立,所述历史位姿信息为所述目标设备在世界坐标系中的位姿;

根据所述多种道路元素类型,识别所述多个第一物体,得到所述多个第一物体中每个第一物体对应的道路元素类型;

根据所述多个第一物体的信息和所述多个第一物体对应的道路元素类型,生成与所述多个道路元素类型对应的所述多个第二地图。

3.根据权利要求1所述的方法,其特征在于,根据所述多种道路元素类型,将所述第一传感信息分割为多组第二传感信息,包括:分割所述第一传感信息,得到所述第一传感信息包括的多个第二物体的信息;

根据所述多种道路元素类型,识别所述多个第二物体,得到所述多个第二物体中每个第二物体对应的道路元素类型;

根据所述多个第二物体对应的道路元素类型,归类所述多个第二物体的信息,得到与所述多个道路元素类型对应的所述多组第二传感信息。

4.根据权利要求1所述的方法,其特征在于,根据所述多种道路元素类型,分别将同一道路元素类型对应的第二地图和第二传感信息进行配准,得到多个局部最优位姿,包括:确定目标道路元素类型对应的配准方法,其中,所述目标道路元素类型为所述多种道路元素类型中的任意一种道路元素类型;

采用所述配准方法配准所述目标道路元素类型分别对应的所述第二地图和所述第二传感信息,得到目标局部最优位姿,其中,所述目标局部最优位姿为所述多个局部最优位姿中与所述目标道路元素类型对应的位姿。

5.根据权利要求4所述的方法,其特征在于,在所述配准方法包括迭代优化方法的情况下,采用所述配准方法配准所述目标道路元素类型分别对应的所述第二地图和所述第二传感信息,得到目标局部最优位姿,包括:获取初始预测位姿,其中,所述初始预测位姿为全球导航卫星系统提供的所述目标设备的位姿;

根据与所述目标道路元素类型分别对应的所述第二地图和所述第二传感信息,求解代价函数得到所述目标局部最优位姿,其中,所述代价函数如下:Cost Function=|wPm‑Twb×bPp|Cost Function表示所述代价函数的函数值,wPm表示所述目标道路元素类型对应的第二地图,bPp表示所述目标道路元素类型对应的第二传感信息,Twb表示所述目标设备的位姿矩阵,且当该代价函数取到最小值时,Twb取到所述目标局部最优位姿。

6.根据权利要求1至5中任意一项所述的方法,其特征在于,还包括:采集所述目标设备在多个时刻的位姿信息和道路传感信息,得到所述历史位姿信息和所述历史传感信息,其中,所述历史传感信息为采用本体坐标系表达的信息;

根据所述历史位姿信息,将所述历史传感信息变换为采用所述世界坐标系表达的信息;

拼接所述历史传感信息,得到所述第一地图。

7.根据权利要求6所述的方法,其特征在于,采集得到所述目标设备的第一传感信息,包括:

使用多个传感器采集得到所述目标设备的原始传感信息,其中,所述原始传感信息为采用传感器坐标系表达的信息,所述多个传感器的类型包括以下至少之一:相机,激光雷达,毫米波雷达;

根据所述多个传感器的外参,将所述原始传感信息转换为所述第一传感信息,其中,所述第一传感信息为采用所述本体坐标系表达的信息。

8.一种设备定位装置,其特征在于,包括:第一分割模块,用于根据预先确定的多种道路元素类型,将第一地图分割为多个第二地图,其中,所述多个第二地图和所述多种道路元素类型一一对应,所述第一地图根据目标设备的历史位姿信息和历史传感信息建立,所述历史位姿信息为所述目标设备在世界坐标系中的位姿;

采集模块,用于采集得到所述目标设备的第一传感信息,其中,所述第一传感信息为所述目标设备当前所处位置的道路传感信息;

第二分割模块,用于根据所述多种道路元素类型,将所述第一传感信息分割为多组第二传感信息,其中,所述多组第二传感信息和所述多种道路元素类型一一对应;

配准模块,用于根据所述多种道路元素类型,分别将同一道路元素类型对应的第二地图和第二传感信息进行配准,得到多个局部最优位姿,其中,所述多个局部最优位姿分别与所述多个道路元素类型一一对应;

融合模块,用于融合所述多个局部最优位姿,得到所述目标设备当前的全局最优位姿。

9.一种非易失性存储介质,其特征在于,所述非易失性存储介质包括存储的程序,其中,在所述程序运行时控制所述非易失性存储介质所在设备执行权利要求1至7中任意一项所述设备定位方法。

10.一种处理器,其特征在于,所述处理器用于运行程序,其中,所述程序运行时执行权利要求1至7中任意一项所述设备定位方法。