[发明专利]用于车辆定位的方法、设备、存储介质及车辆在审
申请号: | 202110871616.6 | 申请日: | 2021-07-30 |
公开(公告)号: | CN113570672A | 公开(公告)日: | 2021-10-29 |
发明(设计)人: | 戴君义;王鑫健 | 申请(专利权)人: | 蔚来汽车科技(安徽)有限公司 |
主分类号: | G06T7/80 | 分类号: | G06T7/80;G06T7/70;G06F17/16;G06T7/62 |
代理公司: | 中国专利代理(香港)有限公司 72001 | 代理人: | 瞿文慧;陈岚 |
地址: | 230601 安徽省合肥市经济*** | 国省代码: | 安徽;34 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 用于 车辆 定位 方法 设备 存储 介质 | ||
1.一种用于车辆定位的方法,其特征在于,所述方法包括:
接收相机摄取的定位标签的图像,其中,所述相机设置于待定位的车辆上,所述定位标签包括四个预确定的定位点;
建立中间坐标系,其中,所述中间坐标系的xy平面是所述定位标签所在的平面;
针对所述定位点中的每个,确定世界坐标系下的第一坐标和图像坐标系下的第二坐标;以及
基于所述世界坐标系到所述中间坐标系的第一变换矩阵T1、车辆坐标系到相机坐标系的第二变换矩阵T2、所述图像坐标系到所述相机坐标系的映射关系g,以及所述四个定位点的所述第一坐标和所述第二坐标来确定所述世界坐标系到所述车辆坐标系的第三变换矩阵T3,从而定位所述车辆。
2.根据权利要求1所述的用于车辆定位的方法,其中,通过以下步骤确定所述第一坐标:
从所述图像获取所述定位标签的标识信息;以及
利用所述标识信息确定所述定位点中的每个在所述世界坐标系下的所述第一坐标。
3.根据权利要求2所述的用于车辆定位的方法,其中,利用所述标识信息确定所述第一坐标的所述步骤包括:
利用所述标识信息获取与所述定位标签相关联的定位参考点在所述世界坐标系下的第三坐标;以及
基于所述定位参考点的所述第三坐标以及所述定位参考点与所述定位点中的每个之间的位置关系来确定所述定位点中的每个在所述世界坐标系下的所述第一坐标,
其中,所述定位参考点与所述定位点中的每个之间的所述位置关系是预确定的。
4.根据权利要求1所述的用于车辆定位的方法,还包括通过以下步骤对所确定的第三变换矩阵T3进行非线性优化:
确定所述定位标签中的第i个定位点的重投影误差δi,i=1,2,3,4;
计算所述定位标签的第一损失函数Loss:
以及
通过最小化所述第一损失函数Loss来所述第三变换矩阵T3进行非线性优化。
5.根据权利要求4所述的用于车辆定位的方法,其中,所述重投影误差δi是基于曲面角度误差的重投影误差:
其中,是第i个定位点在所述世界坐标系下的第一坐标,
是所述第i个定位点在所述图像坐标系下的第二坐标,
(R,t)是所述世界坐标系到所述相机坐标系的第五变换矩阵T5,
是所述第i个定位点从所述图像坐标系上的所述第二坐标到所述相机的入射光线的映射,
||||表示取模运算,^表示外积运算。
6.根据权利要求1所述的用于车辆定位的方法,还包括通过以下步骤对所确定的第三变换矩阵T3进行非线性优化:
利用所述相机摄取至少两个定位标签的图像;
确定来自所述至少两个定位标签中的n个定位点的重投影误差;
计算所述至少两个定位标签的第二损失函数Loss′:
其中,δi是第i个定位点的重投影误差,wi是所述第i个定位点的加权系数,所述加权系数wi相关联于所述第i个定位点所来自的定位标签被摄取到的图像的面积;以及
通过最小化所述第二损失函数Loss′来对所述第三变换矩阵T3进行非线性优化。
7.根据权利要求1所述的用于车辆定位的方法,还包括通过以下步骤对所确定的第三变换矩阵T3进行非线性优化:
接收至少两个相机摄取的至少两个定位标签的图像,其中,所述至少两个相机均设置于所述车辆上;
确定来自所述至少两个定位标签中的定位点的重投影误差;
计算所述至少两个相机的位姿约束误差;以及
通过所述位姿约束误差来对所述第三变换矩阵T3进行非线性优化。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于蔚来汽车科技(安徽)有限公司,未经蔚来汽车科技(安徽)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110871616.6/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种电缆成圈装置
- 下一篇:一种基于活动轮廓模型的白细胞分割方法