北京经纬恒润科技股份有限公司卞进冬获国家专利权
买专利卖专利找龙图腾,真高效! 查专利查商标用IPTOP,全免费!专利年费监控用IP管家,真方便!
龙图腾网获悉北京经纬恒润科技股份有限公司申请的专利车辆位姿确定方法及装置获国家发明授权专利权,本发明授权专利权由国家知识产权局授予,授权公告号为:CN114241049B 。
龙图腾网通过国家知识产权局官网在2025-06-06发布的发明授权授权公告中获悉:该发明授权的专利申请号/专利号为:202111543164.5,技术领域涉及:G06T7/73;该发明授权车辆位姿确定方法及装置是由卞进冬;陆嘉伟;万国强;张斯怡设计研发完成,并于2021-12-16向国家知识产权局提交的专利申请。
本车辆位姿确定方法及装置在说明书摘要公布了:本申请公开一种车辆位姿确定方法及装置。该方法包括:确定车辆所在的目标车道;获取目标车道中车道线点列在车辆坐标系下的位置信息;对目标车道中车道线点列在车辆坐标系下的位置信息进行曲线拟合,得到目标车道的左车道线第一方程和右车道线第一方程;根据图像采集装置采集的包含目标车道的环境图像,确定目标车道的左车道线第二方程和右车道线第二方程;利用左车道线第一方程、右车道线第一方程、左车道线第二方程和右车道线第二方程,对基于RTK信号得到的车辆的初始位姿进行修正。本申请公开的方案,能够在全工况下准确地确定车辆位姿。
本发明授权车辆位姿确定方法及装置在权利要求书中公布了:1.一种车辆位姿确定方法,其特征在于,包括:确定车辆所在的目标车道;获取所述目标车道中车道线点列在车辆坐标系下的位置信息;对所述目标车道中车道线点列在车辆坐标系下的位置信息进行曲线拟合,得到所述目标车道的左车道线第一方程和右车道线第一方程;根据图像采集装置采集的包含所述目标车道的环境图像,确定所述目标车道的左车道线第二方程和右车道线第二方程;利用所述左车道线第一方程、所述右车道线第一方程、所述左车道线第二方程和所述右车道线第二方程,对基于RTK信号得到的所述车辆的初始位姿进行修正,将修正后的位姿作为所述车辆的位姿求解结果;所述左车道线第一方程为f1leftx=P0left+P1left*x+P2left*x2;所述右车道线第一方程为f1rightx=P0right+P1right*x+P2right*x2;所述左车道线第二方程为f2leftx=C0left+C1left*x+C2left*x2;所述右车道线第二方程为f2rightx=C0right+C1right*x+C2right*x2;其中,下标left代表左车道线;下标right代表右车道线;x为车道线点列在车辆坐标系下的X轴坐标;P0left、P1left分别为左车道线第一方程的常数项、一次项系数,分别是基于高精度地图确定出的所述车辆与所述目标车道中左车道线之间的距离、夹角;P2left为左车道线第一方程的二次项系数;P0right、P1right为右车道线第一方程的常数项、一次项系数,分别是基于所述高精度地图确定出的所述车辆与目标车道中右车道线之间的距离、夹角;P2right为右车道线第一方程的二次项系数;C0left、C1left为左车道线第二方程的常数项、一次项系数,分别是基于所述环境图像确定出的所述车辆与所述目标车道中左车道线之间的距离、夹角;C2left为左车道线第二方程的二次项系数;C0right、C1right分别为右车道线第二方程的常数项、一次项系数,分别是基于所述环境图像确定出的所述车辆与所述目标车道中右车道线之间的距离、夹角;C2right为右车道线第二方程的二次项系数;所述利用所述左车道线第一方程、所述右车道线第一方程、所述左车道线第二方程和右车道线第二方程,对基于RTK信号得到的所述车辆的初始位姿进行修正,包括:根据所述左车道线第一方程和所述左车道线第二方程确定出车辆航向角第一修正量;根据所述右车道线第一方程和所述右车道线第二方程确定出车辆航向角第二修正量;根据第一距离、第二距离、第三距离、第四距离、所述车辆航向角第一修正量、车辆航向角第二修正量、以及基于所述RTK信号得到的所述车辆的初始航向角,确定出所述车辆在X方向的第一修正量和第二修正量、以及所述车辆在Y方向的第一修正量和第二修正量,其中,所述第一距离为基于所述高精度地图确定出的所述车辆与所述目标车道中左车道线之间的距离,所述第二距离为基于所述高精度地图确定出的所述车辆与所述目标车道中右车道线之间的距离,所述第三距离为基于所述环境图像确定出的所述车辆与所述目标车道中左车道线之间的距离,所述第四距离为基于所述环境图像确定出的所述车辆与所述目标车道中右车道线之间的距离;根据所述车辆在X方向的第一修正量和第二修正量、所述车辆在Y方向的第一修正量和第二修正量、所述车辆航向角第一修正量、所述车辆航向角第二修正量、以及修正系数,对基于所述RTK信号得到的所述车辆的初始位姿进行修正。
如需购买、转让、实施、许可或投资类似专利技术,可联系本专利的申请人或专利权人北京经纬恒润科技股份有限公司,其通讯地址为:100015 北京市朝阳区酒仙桥路14号1幢4层;或者联系龙图腾网官方客服,联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。