一种车辆室内外定位切换方法及装置制造方法及图纸

技术编号:35690165 阅读:21 留言:0更新日期:2022-11-23 14:38
本公开实施例中提供了一种车辆室内外定位切换方法及装置。所述方法包括:在停车场入口处同时获取全球定位系统的全球坐标系下的坐标数据和无线超宽带UWB坐标系的坐标数据,进一步将全球定位系统的全球坐标系下的坐标数据转换成UTM坐标系下的坐标数据;随后确定UWB坐标系下坐标数据与UTM坐标系下坐标数据的位置关系;获取车辆在停车场内的UWB坐标系下坐标数据,并基于UWB坐标系下坐标数据与UTM坐标系下坐标数据的位置关系将所获取的车辆在停车场内的UWB坐标系下坐标数据转换成UTM坐标系下坐标数据,从而获取车辆的全局坐标。从而获取车辆的全局坐标。从而获取车辆的全局坐标。

【技术实现步骤摘要】
一种车辆室内外定位切换方法及装置


[0001]本专利技术涉及车辆定位
,具体涉及一种车辆室内外定位切换方法及装置。

技术介绍

[0002]随着社会经济的快速发展,追求生活品质的提高成为人民关注的重点,其中,汽车的购置成为提升生活质量的必备资产之一。智能驾驶汽车也成为现在汽车行业的新星,其基于智能化、信息化发展,从一定程度上改变了现有的交通体系,将驾驶员从传统枯燥的驾驶过程中解放出来,提高其幸福感和生产效率。
[0003]智能汽车需要高精度的稳定定位信息,以满足各场景的应用需求,除了常见的室外定位场景外,自动驾驶要求在室内场景也能得到精确的定位,从而全方位实现高精度定位,尤其在于地下停车场中的定位场景尤为常见且重要。
[0004]在现有技术中,智能驾驶车辆进出停车场时全球定位系统定位与UWB定位方式这两个定位方式交替时会产生定位不准确的问题,虽然两种定位方式精度都较高,但是由于两种定位方式进行切换时会出现定位丢失、漂移、不稳定等问题。

技术实现思路

[0005]有鉴于此,本公开实施例提供一种车辆室内外定位切换方法及装置,至少部分解决现有技术中存在的问题。
[0006]第一方面,本公开实施例提供了一种车辆室内外定位切换方法,包括如下步骤:
[0007]在停车场入口处同时获取车辆在全球坐标系下的第一坐标数据和无线超宽带UWB坐标系下的第二坐标数据并对UWB坐标系下的第二坐标数据进行数据处理;
[0008]将所述第一坐标数据转换成通用横墨卡托格网系统UTM坐标系下的第三坐标数据;
[0009]通过旋转平移坐标系的方式,确定所述UWB坐标系下的第二坐标数据与所述UTM坐标系下的第三坐标数据之间的相对位置关系;
[0010]获取车辆在停车场内的UWB坐标系下的第四坐标数据,并基于所述相对位置关系将所述第四坐标数据转换成UTM坐标系下的第五坐标数据;以及
[0011]将所述第五坐标数据转换成全球坐标系下的第六坐标数据。
[0012]进一步地,还包括对UWB坐标系下的第二坐标数据进行卡尔曼滤波处理,处理包括:
[0013](1)通过串口读取到UWB坐标系下的第二坐标数据,根据轮速及方向盘转角信息利用航迹推算计算出理论坐标数据;
[0014](2)将所读取的第二坐标数据当作观测值,将所计算出的理论坐标数据当作估计值,计算协方差矩阵P;以及
[0015](3)以全球坐标系下的数据为真值,离线自适应调整观测噪声矩阵Q和过程噪声矩阵W,并实现在线不断迭代融合。
[0016]进一步地,所述将全球坐标系下的第一坐标数据转换成UTM坐标系下的第三坐标数据的计算方法如下:
[0017]设全球坐标系下的第一坐标数据为单位为弧度,UTM坐标系下的第三坐标数据为(E,N),单位为km。
[0018]首先计算UTM分带:
[0019]ZN=[λ/6]取整+31
[0020][0021]λ0=(ZN

1)*6

180+3(degree)
[0022][0023][0024][0025][0026]其中,k0=0.9996,E0=500km,a=6378.137km,代表赤道半径。
[0027]进一步地,N0根据所在半球选择不同值,具体如下:
[0028][0029]第二方面,本公开实施例提供了一种车辆室内外定位切换装置,包括:
[0030]全球坐标系坐标数据获取模块,被配置为获取全球坐标系下的第一坐标数据;
[0031]无线超宽带UWB坐标系坐标数据获取模块,被配置为获取停车场入口处的UWB坐标系下的第二坐标数据;
[0032]数据处理模块,被配置为:
[0033]对UWB坐标系下的第二坐标数据进行坐标滤波处理;
[0034]将所述第一坐标数据转换成通用横墨卡托格网系统UTM坐标系下的第三坐标数据;
[0035]确定所述UWB坐标系下的第二坐标数据与所述UTM坐标系下的第三坐标数据之间的相对位置关系;
[0036]基于所述相对位置关系,将由UWB坐标获取模块获取的车辆在停车场内的UWB坐标
系下的第四坐标数据转换成UTM坐标系下的第五坐标数据;以及
[0037]将所述第五坐标数据转换成全球坐标系下的第六坐标数据;以及。
[0038]输出模块,被配置为输出所述第六坐标数据。
[0039]第三方面,本公开实施例还提供了一种非暂态计算机可读存储介质,该非暂态计算机可读存储介质存储有计算机指令,该计算机指令当由一个或多个处理器执行时,使得所述一个或多个处理器执行前述第一方面或第一方面的任一实现方式中的车辆室内外定位切换方法。
附图说明
[0040]为了更清楚地说明本公开实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本公开的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
[0041]图1为本公开实施例提供的一种车辆室内外定位切换流程示意图;
[0042]图2示出了通过旋转平移确定UTM坐标系和UWB坐标系两个坐标系的位置关系;以及
[0043]图3示出了根据本公开的实施例的用于车辆室内外定位切换的装置示意图。
具体实施方式
[0044]下面结合附图对本公开实施例进行详细描述。
[0045]以下通过特定的具体实例说明本公开的实施方式,本领域技术人员可由本说明书所揭露的内容轻易地了解本公开的其他优点与功效。显然,所描述的实施例仅仅是本公开一部分实施例,而不是全部的实施例。本公开还可以通过另外不同的具体实施方式加以实施或应用,本说明书中的各项细节也可以基于不同观点与应用,在没有背离本公开的精神下进行各种修饰或改变。需说明的是,在不冲突的情况下,以下实施例及实施例中的特征可以相互组合。基于本公开中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本公开保护的范围。
[0046]需要说明的是,下文描述在所附权利要求书的范围内的实施例的各种方面。应显而易见,本文中所描述的方面可体现于广泛多种形式中,且本文中所描述的任何特定结构及/或功能仅为说明性的。基于本公开,所属领域的技术人员应了解,本文中所描述的一个方面可与任何其它方面独立地实施,且可以各种方式组合这些方面中的两者或两者以上。举例来说,可使用本文中所阐述的任何数目个方面来实施设备及/或实践方法。另外,可使用除了本文中所阐述的方面中的一或多者之外的其它结构及/或功能性实施此设备及/或实践此方法。
[0047]还需要说明的是,以下实施例中所提供的图示仅以示意方式说明本公开的基本构想,图式中仅显示与本公开中有关的组件而非按照实际实施时的组件数目、形状及尺寸绘制,其实际实施时各组件的型态、数量及比例可为一种随意的改变,且其组件布局型态也可能更为复本文档来自技高网
...

【技术保护点】

【技术特征摘要】
1.一种车辆室内外定位切换方法,其特征在于,包括如下步骤:在停车场入口处同时获取车辆在全球坐标系下的第一坐标数据和无线超宽带UWB坐标系下的第二坐标数据并对UWB坐标系下的第二坐标数据进行数据处理;将所述第一坐标数据转换成通用横墨卡托格网系统UTM坐标系下的第三坐标数据;通过旋转平移坐标系的方式,确定所述UWB坐标系下的第二坐标数据与所述UTM坐标系下的第三坐标数据之间的相对位置关系;获取车辆在停车场内的UWB坐标系下的第四坐标数据,并基于所述相对位置关系将所述第四坐标数据转换成UTM坐标系下的第五坐标数据;以及将所述第五坐标数据转换成全球坐标系下的第六坐标数据。2.根据权利要求1所述的车辆室内外定位切换方法,其特征在于,所述方法还包括对UWB坐标系下的第二坐标数据进行卡尔曼滤波处理。3.根据权利要求2所述的车辆室内外定位切换方法,其特征在于,所述卡尔曼滤波处理包括:(1)通过串口读取到UWB坐标系下的第二坐标数据,根据轮速及方向盘转角信息利用航迹推算计算出理论坐标数据;(2)将所读取的第二坐标数据当作观测值,将所计算出的理论坐标数据当作估计值,计算协方差矩阵P;以及(3)以全球坐标系下的数据为真值,离线自适应调整观测噪声矩阵Q和过程噪声矩阵W,并实现在线不断迭代融合。4.根据权利要求1所述的车辆室内外定位切换方法,其特征在于,所述将全球坐标系下的第一坐标数据转换成UTM坐标系下的第三坐标数据的计算方法如下:设全球坐标系下的第一坐标数据为单位为弧度,UTM坐标系下的第三坐标数据为(E,N),单位为km;UTM分带表示为:ZN=[λ/6]+31λ0=(ZN

1)*6

180+3(degree)180+3(degree)180+3(degre...

【专利技术属性】
技术研发人员:魏建程建磊赵锋盛辉
申请(专利权)人:澳克诺上海汽车科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1