CN114322978A - 一种车辆定位方法、计算机设备、计算机可读存储介质 - Google Patents
一种车辆定位方法、计算机设备、计算机可读存储介质 Download PDFInfo
- Publication number
- CN114322978A CN114322978A CN202011078826.1A CN202011078826A CN114322978A CN 114322978 A CN114322978 A CN 114322978A CN 202011078826 A CN202011078826 A CN 202011078826A CN 114322978 A CN114322978 A CN 114322978A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- positioning system
- value
- course angle
- current moment
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 58
- 230000004927 fusion Effects 0.000 claims abstract description 10
- 238000004364 calculation method Methods 0.000 claims description 22
- 230000008569 process Effects 0.000 claims description 19
- 238000004590 computer program Methods 0.000 claims description 11
- 230000004807 localization Effects 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000007499 fusion processing Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Abstract
本发明公开了一种车辆定位方法、计算机设备、计算机可读存储介质,所述方法通过根据GNSS定位系统和UWB定位系统的信号强度选择其中之一作为当前使用的车载定位系统,能够适应室内外不同场地的定位系统信号强弱问题,同时利用车辆行驶里程计算第一航向角偏移以及位置坐标偏移值,提出了位置坐标和航向角的观测值以及预测值的融合来得到最终的位置坐标和航向角,使得最终定位的车辆位置坐标和航向角更为准确,提高车辆室内外定位精度,以适应自动驾驶场景的定位精度要求。所述计算机设备、计算机可读存储介质包括用于执行所述方法的程序指令。
Description
技术领域
本发明涉及车辆定位技术领域,具体涉及一种车辆定位方法、计算机设备、 计算机可读存储介质。
背景技术
传统的车辆定位,主要应用于车辆的导航、追踪,停车场寻车等场合,对 精度要求一般在十米级或者米级,可靠性要求也不高,偶然的信号丢失也能够 接受。但自动驾驶场景下,对定位精度要求在分米级甚至厘米级,位置信号的 输出必须连续稳定,可靠性要求非常高,而且实时性要求也比其他应用场合要 高。这是因为,自动驾驶车辆必须足够精确地获得自身位置用以制定驾驶策略, 在众多场景中实现比人更加精准的操控,定位精度越高,稳定性越好,对自动 驾驶越有利。
发明内容
本发明的目的在于提出一种车辆定位方法、计算机设备、计算机可读存储 介质,以提高车辆室内外定位精度,以适应自动驾驶场景的定位精度要求。
为实现上述目的,根据第一方面,本发明实施例提出一种车辆定位方法, 包括周期性地执行以下步骤:
获取当前时刻所对应的最近一个预设周期内的车辆行驶里程,并根据所述 车辆行驶里程计算当前时刻的第一航向角偏移以及位置坐标偏移值;
获取当前时刻的前轮转角,并根据所述当前时刻的前轮转角计算当前时刻 的第二航向角偏移值;
根据所述第一航向角偏移值与所述第二航向角偏移值计算得到第三航向角 偏移值,将上一时刻的航向角与所述第三航向角偏移值叠加得到当前时刻的航 向角预测值;并将上一时刻的位置坐标与当前时刻的所述位置坐标偏移值叠加 得到当前时刻的位置坐标预测值;
接收当前使用的车载定位系统的帧数据,根据接收到的最近一帧数据及其 接收时间、以及当前时刻所对应的时间计算车辆当前时刻的位置坐标观测值, 并根据所述当前时刻、上一时刻的位置坐标观测值计算当前时刻的航向角观测 值;其中根据GNSS定位系统和UWB定位系统的信号强度选择其中之一作为当 前使用的车载定位系统;
根据所述当前时刻的航向角预测值、航向角观测值计算当前时刻的航向角, 并根据所述当前时刻的位置坐标预测值、位置坐标观测值计算当前时刻的位置 坐标。
可选地,所述方法还包括:
当车辆上电时,对车辆位置坐标进行初始化,根据GNSS定位系统和UWB 定位系统的信号强度选择其中之一作为当前使用的车载定位系统,获取车载定 位系统的当前帧数据,根据该当前帧数据获得对应的车辆绝对位置坐标,并将 该车辆绝对位置坐标作为初始时刻的车辆位置坐标。
可选地,所述GNSS定位系统和UWB定位系统均采用双天线结构,包括设 置于车辆前部的前天线和设置于车辆后部的后天线,所述GNSS定位系统和 UWB定位系统的帧数据包括前、后天线坐标信息;
所述方法还包括:
获取当前使用的车载定位系统的后天线坐标信息,根据所述后天线坐标信 息计算对应的车辆绝对位置坐标,并将该车辆绝对位置坐标作为初始时刻的车 辆位置坐标;
获取当前使用的车载定位系统的前天线坐标信息,根据所述前、后天线坐 标信息计算初始时刻的车辆航向角;
其中,Yaw0为初始时刻的车辆航向角,Δx0和Δy0分别为所述前、后天线坐 标之间的横、纵坐标差值。
可选地,当车辆位于停车场时,如果车辆进入停车场的UWB信号有效覆盖 区域或者车速处于预设低速区间,则选择UWB定位系统作为当前使用的车载定 位系统。
可选地,所述方法还包括:
在车辆上电时,对车辆航向角进行初始化,获取当前时刻的车载电子罗盘 的航向角,将该航向角作为初始时刻的车辆航向角。
可选地,所述当前时刻的位置坐标偏移值的计算过程具体如下:
Δx1=s×cos(Yawt-1)
Δy1=s×sin(Yawt-1)
其中,Δx1为横向坐标偏移值,Δy1为纵向坐标偏移值,s为在最近一个预 设周期内的车辆行驶里程,Yawt-1为上一时刻的航向角;
所述当前时刻的第一航向角偏移的计算过程具体如下:
其中,ΔYaw为第一航向角偏移,d1和d2分别为车辆左、右后轮在最近一个 预设周期内的行驶里程,w为车辆左、右后轮轮距。。
可选地,所述当前时刻的第二航向角偏移值的计算过程具体如下:
其中,ΔYawδ为第二航向角偏移值,s为在最近一个预设周期内的车辆行驶 里程,δ为前轮转角,L为车辆轴距。
可选地,所述第三航向角偏移值的计算过程具体如下:
ΔYaw′t=KY×ΔYawt+(1-KY)×ΔYawδ
其中,ΔYaw′t为第二航向角偏移值,KY为第一融合系数,0<KY<1。
可选地,所述车辆当前时刻的位置坐标观测值的计算过程具体如下:
Δt=t-t1
可选地,所述当前时刻的航向角观测值的具体计算过程如下:
其中,Yawob为当前时刻的航向角观测值,Δx2和Δy2分别为所述当前时刻 和上一时刻的位置坐标观测值之间的横、纵坐标偏移。
可选地,所述当前时刻的航向角的计算过程具体如下:
Yawt=KP×Yawob+(1-KP)×Yawpr
其中,Yawt为当前时刻的航向角,Yawob为当前时刻的航向角观测值, Yawpr为当前时刻的航向角预测值,KP为第二融合系数,0<KP<1;
所述当前时刻的位置坐标的计算过程具体如下:
(xt,yt)=KP×(xob,yob)+(1-KP)×(xpr,ypr)
其中,(xt,yt)为当前时刻的位置坐标,(xob,yob)为当前时刻的位置坐标观 测值,(xpr,ypr)为当前时刻的位置坐标预测值。
根据第二方面,本发明实施例提出一种计算机设备,包括:存储器和处理 器,所述存储器中存储有计算机可读指令,所述计算机可读指令被所述处理器 执行时,使得所述处理器执行根据第一方面实施例所述车辆定位方法的步骤。
根据第三方面,本发明实施例提出一种计算机可读存储介质,其上存储有 计算机程序,所述计算机程序被处理器执行时实现第一方面实施例所述车辆定 位方法。
本发明实施例提出一种车辆定位方法、计算机设备、计算机可读存储介质, 通过根据最近一个预设时间周期的车辆行驶里程来计算当前时刻的第一航向角 偏移以及位置坐标偏移值;根据所述当前时刻的前轮转角计算当前时刻的第二 航向角偏移值;根据所述第一航向角偏移值与所述第二航向角偏移值计算得到 第三航向角偏移值;将上一时刻的航向角与所述第三航向角偏移值叠加得到当 前时刻的航向角预测值;并将上一时刻的位置坐标与当前时刻的所述位置坐标 偏移值叠加得到当前时刻的位置坐标预测值;根据接收到的车载定位系统最近 一帧数据及其接收时间、以及当前时刻所对应的时间计算车辆当前时刻的位置 坐标观测值,并根据所述当前时刻、上一时刻的位置坐标观测值计算当前时刻 的航向角观测值;最终,根据所述当前时刻的航向角预测值、航向角观测值计 算当前时刻的航向角,并根据所述当前时刻的位置坐标预测值、位置坐标观测 值计算当前时刻的位置坐标。本发明实施例根据GNSS定位系统和UWB定位系 统的信号强度选择其中之一作为当前使用的车载定位系统,能够适应室内外不 同场地的定位系统信号强弱问题,同时利用车辆行驶里程计算第一航向角偏移 以及位置坐标偏移值,提出了位置坐标和航向角的观测值以及预测值的融合来 得到最终的位置坐标和航向角,使得最终定位的车辆位置坐标和航向角更为准 确,提高车辆室内外定位精度,以适应自动驾驶场景的定位精度要求。
本发明的其它特征和优点将在随后的说明书中阐述。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施 例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述 中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付 出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明一实施例中一种车辆定位方法的流程图。
图2为本发明一实施例中车辆CTRV恒定转率和速度模型示意图。
图3为本发明一实施例中根据所述前、后天线坐标信息计算初始时刻的车 辆航向角的原理示意图。
图4为本发明一实施例中停车场示例图。
具体实施方式
以下将参考附图详细说明本公开的各种示例性实施例、特征和方面。另外, 为了更好的说明本发明,在下文的具体实施例中给出了众多的具体细节。本领 域技术人员应当理解,没有某些具体细节,本发明同样可以实施。在一些实例 中,对于本领域技术人员熟知的手段未作详细描述,以便于凸显本发明的主旨。
参阅图1,本发明的一实施例提出一种车辆定位方法,包括周期性地执行以 下步骤S1~S5:
步骤S1、获取当前时刻所对应的最近一个预设周期内的车辆行驶里程,并 根据所述车辆行驶里程计算当前时刻的第一航向角偏移以及位置坐标偏移值。
具体而言,本实施中周期性地读取车轮编码器数据,分别计算车辆左后轮 和右后轮在一个周期内的累积行程,假设车轮半径为r,车轮转动一圈编码器输 出脉冲数为1,n为一个周期内的车轮编码器输出的脉冲数,对应累积行程为d, 则有如下关系:
据此可以计算出左、右后轮的在一个周期内的累积行程d1和d2,则最近一 个预设周期内的车辆行驶里程s为:
可选地,本实施例中所述当前时刻的位置坐标偏移值的计算过程具体如下:
Δx1=s×cos(Yawt-1)
Δy1=s×sin(Yawt-1)
其中,Δx1为横向坐标偏移值,Δy1为纵向坐标偏移值,Yawt-1为上一时刻 的航向角;如果是首次运算,则对应初始时刻的航向角。
可选地,本实施例中所述当前时刻的第一航向角偏移的计算过程具体如下:
其中,ΔYaw为第一航向角偏移,d1和d2分别为车辆左、右后轮在最近一个 预设周期内的行驶里程,w为车辆左、右后轮轮距。
步骤S2、获取当前时刻的前轮转角,并根据所述当前时刻的前轮转角计算 当前时刻的第二航向角偏移值。
可选地,本实施例中所述当前时刻的第二航向角偏移值的计算过程具体如 下:
其中,ΔYawδ为第二航向角偏移值,s为在最近一个预设周期内的车辆行驶 里程,δ为前轮转角,L为车辆轴距。
示例性地,步骤中可以周期性地读取当前方向盘转角传感器数据,结合车 辆CTRV模型,如图2所示,通过预先对车身建立的标定即可计算出对应的前 轮转角δ;当然,前轮转角δ也可以通过其他方式获得。
需说明的是,步骤S1和步骤S2之间没有先后执行顺序上的限定。
步骤S3、根据所述第一航向角偏移值与所述第二航向角偏移值计算得到第 三航向角偏移值,将上一时刻的航向角与所述第三航向角偏移值叠加得到当前 时刻的航向角预测值;并将上一时刻的位置坐标与当前时刻的所述位置坐标偏 移值叠加得到当前时刻的位置坐标预测值;
可选地,本实施例中将第二航向角偏移值ΔYawδ作为先验估计预测值,将第 第一航向偏移值ΔYawt作为观测值,运用贝叶斯定理进行后验修正融合,融合过 程可简化为二者根据方差的加权,假设融合系数为KY,其中0<KY<1,该值可通 过计算ΔYawδ和ΔYawt各自的均方差Eδ和Et得到,均方差越大代表数据抖动越大, 越不可靠,权重越低:
从而得到更精确的航向角偏移ΔYawt′:
ΔYaw′t=KY×ΔYawt+(1-KY)×ΔYawδ
本步骤中,将上一时刻的航向角与所述第三航向角偏移值叠加得到当前时 刻的航向角预测值,即:
Yawpr=Yawt-1+ΔYaw′t
其中,Yawpr为当前时刻的航向角预测值,Yawt-1为上一时刻的航向角。
本步骤中,将上一时刻的位置坐标与当前时刻的所述位置坐标偏移值叠加 得到当前时刻的位置坐标预测值,即:
xpr=xt-1+Δx1
ypr=yt-1+Δy1
其中,xpr,ypr分别为当前时刻的横、纵位置坐标预测值,xt-1,yt-1分别为 上一时刻的横、纵位置坐标值。
步骤S4、接收当前使用的车载定位系统的帧数据,根据接收到的最近一帧 数据及其接收时间、以及当前时刻所对应的时间计算车辆当前时刻的位置坐标 观测值,并根据所述当前时刻、上一时刻的位置坐标观测值计算当前时刻的航 向角观测值;其中根据GNSS定位系统和UWB定位系统的信号强度选择其中之 一作为当前使用的车载定位系统。
具体而言,根据当前时间和车载定位系统最近一帧数据,估算出其当前绝 对坐标,以此作为当前时刻的位置坐标的观测值,同时把该观测值保存下来作 为下个处理周期的历史数值。
其中,GNSS定位系统和UWB定位系统周期性输出数据的帧率为10Hz, 系统通过串口接收,数据内容包含世界坐标系下的绝对坐标信息,相邻数据帧 之间有100ms的间隔,处理周期和数据帧输出周期并不同步,这就意味着程序 读到的最近一帧数据不一定是代表当前的实际位置,因此需要对数据进行时间 轴上的平移,所述车辆当前时刻的位置坐标观测值的计算过程具体如下:
Δt=t-t1
其中,(xob,yob)为车辆当前时刻的位置坐标观测值的横、纵坐标,t为当前 时刻所对应的时间,t1为接收最近一帧数据的时间,为当前时刻的车速, (x1,y1)为最近一帧数据所对应的车辆位置横、纵坐标。
步骤中,根据所述当前时刻、上一时刻的位置坐标观测值计算当前时刻的 航向角观测值具体如下:
其中,Yawob为当前时刻的航向角观测值,Δx2和Δy2分别为所述当前时刻 和上一时刻的位置坐标观测值之间的横、纵坐标偏移。
步骤S5、根据所述当前时刻的航向角预测值、航向角观测值计算当前时刻 的航向角,并根据所述当前时刻的位置坐标预测值、位置坐标观测值计算当前 时刻的位置坐标。
可选地,步骤S5运用贝叶斯定理进行后验修正,假设融合系数为KP, 0<KP<1,KP值可通过计算位资预测值和位资观测值各自的均方差Epr和 Eob得到,均方差越大代表数据抖动越大,越不可靠,权重越低:
本实施例中所述当前时刻的航向角的计算过程具体如下:
Yawt=KP×Yawob+(1-KP)×Yawpr
其中,Yawt为当前时刻的航向角,Yawob为当前时刻的航向角观测值, Yawpr为当前时刻的航向角预测值,KP为第二融合系数,0<KP<1;
所述当前时刻的位置坐标的计算过程具体如下:
(xt,yt)=KP×(xob,yob)+(1-KP)×(xpr,ypr)
其中,(xt,yt)为当前时刻的位置坐标,(xob,yob)为当前时刻的位置坐标观 测值,(xpr,ypr)为当前时刻的位置坐标预测值。
保存计算得到的当前时刻的位置坐标以及航向角,用于下一时刻的位置坐 标以及航向角计算。
可选地,本实施例所述方法还包括:
当车辆上电时,对车辆位置坐标进行初始化,根据GNSS定位系统和UWB 定位系统的信号强度选择其中之一作为当前使用的车载定位系统,获取车载定 位系统的当前帧数据,根据该当前帧数据获得对应的车辆绝对位置坐标,并将 该车辆绝对位置坐标作为初始时刻的车辆位置坐标。
具体而言,根据信号状况决定从GNSS定位系统还是UWB定位系统获取绝 对位置坐标信息,对绝对位置坐标进行初始化。读取GNSS定位系统的接收卫 星数和RTK解算的定位状态,根据信号质量的好坏决定是否屏蔽GNSS的信号; 读取UWB定位系统的数据有效标志位判断是否处于UWB定位系统覆盖的有效 区域;综合GNSS定位系统和UWB定位系统信号强弱有效情况,只有当二者满 足其一的时候才对系统进行初始化。一般情况下在室外空旷处会通过GNSS定 位系统进行初始化,而室内则会通过预先部署的UWB定位系统初始化。
基于上述实施例方法,在一种示例中:
所述GNSS定位系统和UWB定位系统均采用双天线结构,包括设置于车辆 前部的前天线和设置于车辆后部的后天线,所述GNSS定位系统和UWB定位系 统的帧数据包括前、后天线坐标信息。
所述方法还包括:
获取当前使用的车载定位系统的后天线坐标信息,根据所述后天线坐标信 息计算对应的车辆绝对位置坐标,并将该车辆绝对位置坐标作为初始时刻的车 辆位置坐标;
其中,所述方法还包括:
获取当前使用的车载定位系统的前天线坐标信息,根据所述前、后天线坐 标信息计算初始时刻的车辆航向角;计算方法参阅图3,通过车辆行驶过程中前 后相邻的两个坐标点on(xn,yn)与on-1(xn-1,yn-1)所确定的向量算出其相对世界坐标 系横坐标的夹角α,即:
其中,Yaw0为初始时刻的车辆航向角,Δx0和Δy0分别为所述前、后天线坐 标之间的横、纵坐标差值。
可选地,参阅图4,当车辆位于停车场时,如果车辆进入停车场的UWB信 号有效覆盖区域或者车速处于预设低速区间,例如图中圈出的矩形方框区域, 则选择UWB定位系统作为当前使用的车载定位系统。
基于上述实施例方法,在另一种示例中:
在车辆上电时,对车辆航向角进行初始化,获取当前时刻的车载电子罗盘 的航向角,将该航向角作为初始时刻的车辆航向角。
可选地,参阅图4,当车辆位于停车场时,如果车辆进入停车场的UWB信 号有效覆盖区域或者车速处于预设低速区间,例如图中圈出的矩形方框区域, 则选择UWB定位系统作为当前使用的车载定位系统。
具体而言,与前面的示例不同的是,本示例中使用车载电子罗盘来初始化 车辆航向角。航向角的初始化对系统收敛时间有相当大的影响,因此在车辆刚 刚上电的时候就可以对其进行初始化;又由于电子罗盘信号有延时并且容易受 干扰影响,因此只把其作为航向角的粗略初始化,后续根据航向角偏移情况进 行修正。
本发明实施例还提出一种计算机设备,包括:存储器和处理器,所述存储 器中存储有计算机可读指令,所述计算机可读指令被所述处理器执行时,使得 所述处理器执行根据上述实施例所述车辆定位方法的步骤。
当然,所述计算机设备还可以具有有线或无线网络接口、键盘以及输入输 出接口等部件,以便进行输入输出,该计算机设备还可以包括其他用于实现设 备功能的部件,在此不做赘述。
示例性的,所述计算机程序可以被分割成一个或多个单元,所述一个或者 多个单元被存储在所述存储器中,并由所述处理器执行,以完成本发明。所述 一个或多个单元可以是能够完成特定功能的一系列计算机程序指令段,该指令 段用于描述所述计算机程序在所述计算机设备中的执行过程。
所述处理器可以是中央处理单元(Central Processing Unit,CPU),还可以是 其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电 路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管 逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以 是任何常规的处理器等,所述处理器是所述计算机设备的控制中心,利用各种 接口和线路连接整个所述计算机设备的各个部分。
所述存储器可用于存储所述计算机程序和/或单元,所述处理器通过运行或 执行存储在所述存储器内的计算机程序和/或单元,以及调用存储在存储器内的 数据,实现所述计算机设备的各种功能。此外,存储器可以包括高速随机存取 存储器,还可以包括非易失性存储器,例如硬盘、内存、插接式硬盘,智能存 储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)、至少一个磁盘存储器件、闪存器件、或其他易失性固态存储器件。
本发明实施例还提出一种计算机可读存储介质,其上存储有计算机程序, 所述计算机程序被处理器执行时实现上述实施例所述车辆定位方法。
示例性地,所述计算机可读存储介质可以包括:能够携带所述计算机程序 代码的任何实体或装置、记录介质、U盘、移动硬盘、磁碟、光盘、计算机存 储器、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM, Random Access Memory)、电载波信号、电信信号以及软件分发介质等。
以上已经描述了本发明的各实施例,上述说明是示例性的,并非穷尽性的, 并且也不限于所披露的各实施例。在不偏离所说明的各实施例的范围和精神的 情况下,对于本技术领域的普通技术人员来说许多修改和变更都是显而易见的。 本文中所用术语的选择,旨在最好地解释各实施例的原理、实际应用或对市场 中的技术改进,或者使本技术领域的其它普通技术人员能理解本文披露的各实 施例。
Claims (13)
1.一种车辆定位方法,其特征在于,包括周期性地执行以下步骤:
获取当前时刻所对应的最近一个预设周期内的车辆行驶里程,并根据所述车辆行驶里程计算当前时刻的第一航向角偏移以及位置坐标偏移值;
获取当前时刻的前轮转角,并根据所述当前时刻的前轮转角计算当前时刻的第二航向角偏移值;
根据所述第一航向角偏移值与所述第二航向角偏移值计算得到第三航向角偏移值,将上一时刻的航向角与所述第三航向角偏移值叠加得到当前时刻的航向角预测值;并将上一时刻的位置坐标与当前时刻的所述位置坐标偏移值叠加得到当前时刻的位置坐标预测值;
接收当前使用的车载定位系统的帧数据,根据接收到的最近一帧数据及其接收时间、以及当前时刻所对应的时间计算车辆当前时刻的位置坐标观测值,并根据所述当前时刻、上一时刻的位置坐标观测值计算当前时刻的航向角观测值;其中根据GNSS定位系统和UWB定位系统的信号强度选择其中之一作为当前使用的车载定位系统;
根据所述当前时刻的航向角预测值、航向角观测值计算当前时刻的航向角,并根据所述当前时刻的位置坐标预测值、位置坐标观测值计算当前时刻的位置坐标。
2.根据权利要求1所述的车辆定位方法,其特征在于,所述方法还包括:
当车辆上电时,对车辆位置坐标进行初始化,根据GNSS定位系统和UWB定位系统的信号强度选择其中之一作为当前使用的车载定位系统,获取车载定位系统的当前帧数据,根据该当前帧数据获得对应的车辆绝对位置坐标,并将该车辆绝对位置坐标作为初始时刻的车辆位置坐标。
4.根据权利要求2所述的车辆定位方法,其特征在于,当车辆位于停车场时,如果车辆进入停车场的UWB信号有效覆盖区域或者车速处于预设低速区间,则选择UWB定位系统作为当前使用的车载定位系统。
5.根据权利要求2所述的车辆定位方法,其特征在于,所述方法还包括:
在车辆上电时,对车辆航向角进行初始化,获取当前时刻的车载电子罗盘的航向角,将该航向角作为初始时刻的车辆航向角。
8.根据权利要求7所述的车辆定位方法,其特征在于,所述第三航向角偏移值的计算过程具体如下:
ΔYaw′t=KY×ΔYawt+(1-KY)×ΔYawδ
其中,ΔYaw′t为第二航向角偏移值,KY为第一融合系数,0<KY<1。
11.根据权利要求9所述的车辆定位方法,其特征在于,所述当前时刻的航向角的计算过程具体如下:
Yawt=KP×Yawob+(1-KP)×Yawpr
其中,Yawt为当前时刻的航向角,Yawob为当前时刻的航向角观测值,Yawpr为当前时刻的航向角预测值,KP为第二融合系数,0<KP<1;
所述当前时刻的位置坐标的计算过程具体如下:
(xt,yt)=KP×(xob,yob)+(1-KP)×(xpr,ypr)
其中,(xt,yt)为当前时刻的位置坐标,(xob,yob)为当前时刻的位置坐标观测值,(xpr,ypr)为当前时刻的位置坐标预测值。
12.一种计算机设备,包括:存储器和处理器,所述存储器中存储有计算机可读指令,所述计算机可读指令被所述处理器执行时,使得所述处理器执行根据权利要求1-11中任一项所述车辆定位方法的步骤。
13.一种计算机可读存储介质,其上存储有计算机程序,其特征在于:所述计算机程序被处理器执行时实现权利要求1-11中任一项所述车辆定位方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011078826.1A CN114322978B (zh) | 2020-10-10 | 2020-10-10 | 一种车辆定位方法、计算机设备、计算机可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011078826.1A CN114322978B (zh) | 2020-10-10 | 2020-10-10 | 一种车辆定位方法、计算机设备、计算机可读存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114322978A true CN114322978A (zh) | 2022-04-12 |
CN114322978B CN114322978B (zh) | 2024-03-15 |
Family
ID=81032741
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011078826.1A Active CN114322978B (zh) | 2020-10-10 | 2020-10-10 | 一种车辆定位方法、计算机设备、计算机可读存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114322978B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115508875A (zh) * | 2022-09-21 | 2022-12-23 | 中国第一汽车股份有限公司 | 目标车辆的定位方法、装置及车辆 |
Citations (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB8501012D0 (en) * | 1985-01-16 | 1985-02-20 | Gen Electric Co Plc | Automated vehicle drift correction |
JPH08194535A (ja) * | 1995-01-18 | 1996-07-30 | Hitachi Cable Ltd | 位置検出システム |
DE102005018834A1 (de) * | 2005-04-22 | 2006-10-26 | Daimlerchrysler Ag | System und Verfahren zur Bestimmung einer aktuellen Kraftfahrzeugposition und einer aktuellen Ausrichtung eines Kraftfahrzeugs |
KR101428376B1 (ko) * | 2013-04-02 | 2014-08-07 | 현대자동차주식회사 | 차량의 위치 산출 장치 및 그 방법 |
CN104316059A (zh) * | 2014-11-05 | 2015-01-28 | 中国科学院嘉兴微电子与系统工程中心 | 由里程计获得车辆经纬度的航位推算导航定位方法及系统 |
CN105172793A (zh) * | 2015-09-25 | 2015-12-23 | 广州橙行智动汽车科技有限公司 | 自动驾驶汽车的位姿估算方法 |
CN106153042A (zh) * | 2015-03-31 | 2016-11-23 | 日本电气株式会社 | 航向角获取方法和装置 |
CN206479647U (zh) * | 2017-01-25 | 2017-09-08 | 北京经纬恒润科技有限公司 | 定位系统及汽车 |
CN108827292A (zh) * | 2018-06-27 | 2018-11-16 | 四川大学 | 基于gnss和地面基站的组合式导航精确测速定位方法及系统 |
CN110274589A (zh) * | 2018-03-15 | 2019-09-24 | 高德信息技术有限公司 | 一种定位方法及装置 |
US20200033146A1 (en) * | 2018-07-26 | 2020-01-30 | Trimble Inc. | Vehicle manual guidance systems with steering wheel angle sensors and road wheel angle sensors |
CN110823224A (zh) * | 2019-10-18 | 2020-02-21 | 中国第一汽车股份有限公司 | 一种车辆定位方法及车辆 |
CN110850455A (zh) * | 2019-10-18 | 2020-02-28 | 浙江天尚元科技有限公司 | 一种基于差分gps和车辆运动学模型的轨迹录制方法 |
CN110865403A (zh) * | 2019-10-18 | 2020-03-06 | 浙江天尚元科技有限公司 | 一种基于神经网络预学习和轮式里程计融合的定位方法 |
CN111572551A (zh) * | 2020-05-19 | 2020-08-25 | 安徽江淮汽车集团股份有限公司 | 泊车工况下的航向角计算方法、装置、设备及存储介质 |
CN111610780A (zh) * | 2019-02-25 | 2020-09-01 | 广州汽车集团股份有限公司 | 一种自动驾驶车路径跟踪控制方法及其装置 |
CN111624990A (zh) * | 2019-02-28 | 2020-09-04 | 富华科精密工业(深圳)有限公司 | 自动导航方法、服务器及存储介质 |
CN111751857A (zh) * | 2020-07-08 | 2020-10-09 | 中国第一汽车股份有限公司 | 一种车辆位姿的估算方法、装置、存储介质及系统 |
US20210078586A1 (en) * | 2018-03-28 | 2021-03-18 | Hitachi Automotive Systems, Ltd. | Vehicle control device |
-
2020
- 2020-10-10 CN CN202011078826.1A patent/CN114322978B/zh active Active
Patent Citations (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB8501012D0 (en) * | 1985-01-16 | 1985-02-20 | Gen Electric Co Plc | Automated vehicle drift correction |
JPH08194535A (ja) * | 1995-01-18 | 1996-07-30 | Hitachi Cable Ltd | 位置検出システム |
DE102005018834A1 (de) * | 2005-04-22 | 2006-10-26 | Daimlerchrysler Ag | System und Verfahren zur Bestimmung einer aktuellen Kraftfahrzeugposition und einer aktuellen Ausrichtung eines Kraftfahrzeugs |
KR101428376B1 (ko) * | 2013-04-02 | 2014-08-07 | 현대자동차주식회사 | 차량의 위치 산출 장치 및 그 방법 |
CN104316059A (zh) * | 2014-11-05 | 2015-01-28 | 中国科学院嘉兴微电子与系统工程中心 | 由里程计获得车辆经纬度的航位推算导航定位方法及系统 |
CN106153042A (zh) * | 2015-03-31 | 2016-11-23 | 日本电气株式会社 | 航向角获取方法和装置 |
CN105172793A (zh) * | 2015-09-25 | 2015-12-23 | 广州橙行智动汽车科技有限公司 | 自动驾驶汽车的位姿估算方法 |
CN206479647U (zh) * | 2017-01-25 | 2017-09-08 | 北京经纬恒润科技有限公司 | 定位系统及汽车 |
CN110274589A (zh) * | 2018-03-15 | 2019-09-24 | 高德信息技术有限公司 | 一种定位方法及装置 |
US20210078586A1 (en) * | 2018-03-28 | 2021-03-18 | Hitachi Automotive Systems, Ltd. | Vehicle control device |
CN108827292A (zh) * | 2018-06-27 | 2018-11-16 | 四川大学 | 基于gnss和地面基站的组合式导航精确测速定位方法及系统 |
US20200033146A1 (en) * | 2018-07-26 | 2020-01-30 | Trimble Inc. | Vehicle manual guidance systems with steering wheel angle sensors and road wheel angle sensors |
CN111610780A (zh) * | 2019-02-25 | 2020-09-01 | 广州汽车集团股份有限公司 | 一种自动驾驶车路径跟踪控制方法及其装置 |
CN111624990A (zh) * | 2019-02-28 | 2020-09-04 | 富华科精密工业(深圳)有限公司 | 自动导航方法、服务器及存储介质 |
CN110823224A (zh) * | 2019-10-18 | 2020-02-21 | 中国第一汽车股份有限公司 | 一种车辆定位方法及车辆 |
CN110850455A (zh) * | 2019-10-18 | 2020-02-28 | 浙江天尚元科技有限公司 | 一种基于差分gps和车辆运动学模型的轨迹录制方法 |
CN110865403A (zh) * | 2019-10-18 | 2020-03-06 | 浙江天尚元科技有限公司 | 一种基于神经网络预学习和轮式里程计融合的定位方法 |
CN111572551A (zh) * | 2020-05-19 | 2020-08-25 | 安徽江淮汽车集团股份有限公司 | 泊车工况下的航向角计算方法、装置、设备及存储介质 |
CN111751857A (zh) * | 2020-07-08 | 2020-10-09 | 中国第一汽车股份有限公司 | 一种车辆位姿的估算方法、装置、存储介质及系统 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115508875A (zh) * | 2022-09-21 | 2022-12-23 | 中国第一汽车股份有限公司 | 目标车辆的定位方法、装置及车辆 |
Also Published As
Publication number | Publication date |
---|---|
CN114322978B (zh) | 2024-03-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106840179B (zh) | 一种基于多传感器信息融合的智能车定位方法 | |
Goldbeck et al. | Lane following combining vision and DGPS | |
US11525682B2 (en) | Host vehicle position estimation device | |
CN110361008B (zh) | 地下车库自动泊车的定位方法及装置 | |
Monaco et al. | Radarodo: Ego-motion estimation from doppler and spatial data in radar images | |
KR102331312B1 (ko) | 차량 내부 센서, 카메라, 및 gnss 단말기를 이용한 3차원 차량 항법 시스템 | |
JP6776202B2 (ja) | 車載カメラのキャリブレーション装置及び方法 | |
CN112415548B (zh) | 无人集卡的定位方法、装置、系统、电子装置和存储介质 | |
CN112433531A (zh) | 一种自动驾驶车辆的轨迹跟踪方法、装置及计算机设备 | |
Kellner et al. | Road curb detection based on different elevation mapping techniques | |
CN110637209B (zh) | 估计机动车的姿势的方法、设备和具有指令的计算机可读存储介质 | |
CN114322978B (zh) | 一种车辆定位方法、计算机设备、计算机可读存储介质 | |
US8031908B2 (en) | Object recognizing apparatus including profile shape determining section | |
TWM617479U (zh) | 車輛自動定位管理系統 | |
CN115629386B (zh) | 一种用于自动泊车的高精度定位系统及方法 | |
KR20200107382A (ko) | 차량용 센서의 보정 정보 획득 장치 및 방법 | |
CN111580066A (zh) | 转向角度检测方法、装置及系统 | |
CN112415516B (zh) | 一种车辆前方障碍区域感知方法及装置 | |
CN115523929B (zh) | 一种基于slam的车载组合导航方法、装置、设备及介质 | |
CN114705121B (zh) | 车辆位姿测量方法、装置及电子设备、存储介质 | |
US20240118435A1 (en) | Post-processing of global navigation satellite system (gnss) data | |
RU2781373C1 (ru) | Способ коррекции собственного местоположения и устройство коррекции собственного местоположения | |
CN115471520A (zh) | 测量方法及装置 | |
CN114578342A (zh) | 车载雷达的目标跟踪方法、车载雷达及存储介质 | |
CN116381755A (zh) | 定位方法、装置及可读存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |