CN103454614B - 基于粒子滤波的车辆间相对定位方法 - Google Patents

基于粒子滤波的车辆间相对定位方法 Download PDF

Info

Publication number
CN103454614B
CN103454614B CN201310382644.7A CN201310382644A CN103454614B CN 103454614 B CN103454614 B CN 103454614B CN 201310382644 A CN201310382644 A CN 201310382644A CN 103454614 B CN103454614 B CN 103454614B
Authority
CN
China
Prior art keywords
vehicle
particle
relative
particle filter
signal strength
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.)
Active
Application number
CN201310382644.7A
Other languages
English (en)
Other versions
CN103454614A (zh
Inventor
郑晓军
刘儿兀
张正清
刘富强
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai ainuoweixin Intelligent Technology Co.,Ltd.
Original Assignee
SHANGHAI YONGCHANG INFORMATION TECHNOLOGY CO LTD
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by SHANGHAI YONGCHANG INFORMATION TECHNOLOGY CO LTD filed Critical SHANGHAI YONGCHANG INFORMATION TECHNOLOGY CO LTD
Priority to CN201310382644.7A priority Critical patent/CN103454614B/zh
Publication of CN103454614A publication Critical patent/CN103454614A/zh
Application granted granted Critical
Publication of CN103454614B publication Critical patent/CN103454614B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明公开了基于粒子滤波的车辆间相对定位方法,该方法根据待定位车辆之间的定位信号强度和车辆间的相对速度,通过粒子滤波算法来实现车辆间相对动态位置的定位。该方法能够使得具有通信能力的车辆在无需增加任何额外装置的前提下实现车辆间的精确定位。

Description

基于粒子滤波的车辆间相对定位方法
技术领域
本发明涉及车辆定位技术,具体涉及车辆间相对动态定位技术。
背景技术
在交通控制领域中,车辆定位是普遍要用到的一种服务,可分为绝对位置定位和相对位置定位。车辆在行驶过程中,绝对位置通常用于车辆的导航,而相对位置对安全性显得更为重要。尤其车辆在高速道路上的运行过程中,车辆间相对位置定位显得尤为重要。
在现有的技术中,GPS定位是一种非常常见的定位技术。但是在室外基于无线的GPS的单点定位误差在5~10米,转换为相对位置后,很明显会带来更大的误差。
再者,车辆之间相对定位也有采用声纳装置和激光装置来实现定位,这对两辆原本具有通信能力的车辆来说是额外的装置,这将大大增加车辆实现定位的成本。
发明内容
本发明针对现有车辆相对定位技术实施时误差大或成本高等问题,而提供一种基于粒子滤波的车辆间相对定位方法。该方法能够使得具有通信能力的车辆在无需增加任何额外装置的前提下实现车辆间的精确定位。
为了达到上述目的,本发明采用如下的技术方案:
基于粒子滤波的车辆间相对定位方法,该定位方法根据待定位车辆之间的定位信号强度和车辆间的相对速度,通过粒子滤波算法来实现车辆间相对动态位置的定位。
在本发明的优选方案中,所述定位方法具体包括如下步骤:
(1)建立待定位车辆之间的相互通信,使车辆之间具备通信功能,并实现车辆间的身份鉴别和相互数据交换;
(2)获取定位信号强度和车辆间的相对速度;
(3)结合定位信号强度和车辆间的相对速度,并通过粒子滤波算法实现车辆间相对动态位置的定位。
进一步的,所述步骤(1)中待定位车辆间通过无线局域网WIFI方式或者ZigBee无线网络的方式建立相互的无线通信,并进行身份鉴别和相互数据交换。
进一步的,所述步骤(2)中的车辆间相对速度的获取是通过车辆各自获取自身速度,并由无线通信过程交换速度信息,从而得到车辆间的相对速度。
进一步的,所述步骤(3)中通过定位信号强度建立粒子滤波算法的定位信号强度感知模型,通过车辆间的相对速度建立粒子滤波算法的运动模型,且定位过程如下:
(31)将所有粒子均匀分布于对方车辆可能出现的所有位置上;
(32)根据建立的运动模型得出所有粒子下一刻的位置;
(33)根据建立的定位信号强度感知模型确定每一个粒子的权重;
(34)对粒子进行重采样;
(35)经过多次迭代,对所有粒子的位置取平均值,并输出作为车辆间相对动态位置。
再进一步的,所述步骤(34)中如果要采样相同的粒子数目,那么权重值大的粒子将会被多次采样。
本发明通过检测车辆之间无线信号的强度和相对速度,并引入粒子滤波算法实现精确定位。
本方案相对于现有基于GPS的相对于定位方案,能够实现更为精确的车辆之间的相对定位;相对于采用声纳装置和激光装置来实现定位的方案,其实现定位成本低且实现简单。
附图说明
以下结合附图和具体实施方式来进一步说明本发明。
图1是本发明的一个具体实施场景的示意图;
图2是车辆间相对定位过程的流程图;
图3是通过粒子滤波实现定位算法的流程图。
具体实施方式
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体图示,进一步阐述本发明。
本实例中的方案基于粒子滤波实现车辆间的相对精确定位,具体根据待定位车辆之间的定位信号强度和车辆间的相对速度,通过粒子滤波算法来实现车辆间相对动态位置的定位。
基于上述原理,本实例的具体定位方案通过如下步骤实现:
(1)建立待定位车辆之间的相互通信,使车辆之间具备通信功能,并实现车辆间的身份鉴别和相互数据交换。
为了能够达到快速稳定的建立两车之间的无线通信,具体可采用无线局域网WIFI方式在两车之间建立相互的无线通信,并进行身份鉴别和相互数据交换。
作为替代方案,也可采用ZigBee无线网络的方式在两车之间建立相互的无线通信。
对于在两车之间建立无线相互通信的方式并不限于上述两种方案,根据需要也可以采用其他方式,只要能够快速、精确以及稳定的实现两车之间无线通信即可。
(2)在两车之间完成相互无线通信的建立后,获取对方发送的定位信号强度以及车辆间的相对速度。
对车辆间相对速度的获取,具体通过车辆各自获取自身速度,并由无线通信过程交换速度信息,根据自身速度以及通过无线通信获取的对方车辆的速度得到车辆间的相对速度。
(3)结合定位信号强度和车辆间的相对速度,并通过粒子滤波算法实现车辆间相对动态位置的定位。
以下通过一具体应用实例来进一步说明本实例的方案。
参见图1,其所示为本实例的实施场景。如图所示,该场景中展示了两辆车:A车和B车,在高速公路上同向行驶的场景。行驶方向如图中标记,其中A车和B车同向行驶,B车在行驶过程中希望获取与前车A的相对位置信息,而对自身的绝对位置并不感兴趣。
再者,A车上设置有WIFI的发射和接收装置,B车上也设置有WIFI的发射和接收装置,同时接收装置具备测量信号强度的功能,而且两车各具有唯一的SSID,以实现车辆间的识别、数据交换以及信号强度的测量。
同时,A车和B车上都搭载车辆相对定位装置,通过与WIFI接收装置交互数据并执行粒子滤波算法,实现A车和B车之间的相对位置定位。
由此,A车和B车间进行相对定位的过程如下(参见图2):
第一步,建立车辆间的相互通信。通过车载的无线WIFI装置,并交互车辆的身份等验证信息,建立两车间的通信。假设B车接收到了多个WIFI信号,其中有一个是A车发出的信号,其他的信号认为是干扰信号,通过识别SSID,确定出A车的信号,之后就可以和A车建立通信。
第二步,获取定位信号强度。A车和B车建立了通信之后,B车测量A车所发出的信号的强度。这里的测量可以是单次的测量,也可以是多次的测量取平均。然后将测量到的强度信息传送到车辆相对定位装置。
获取车辆间的相对速度。A车和B车分别测量自身的速度,通过已建立的无线通信交互速度信息。B车在获取了A车的速度之后就可以方便的计算出两车的相对速度,并将获取得到的相对速度信息传送到车辆相对定位装置。
第三步,车辆相对定位装置根据所获取的定位信号强度和车辆间相对速度,就可以通过粒子滤波算法来实现定位。
由于第二步中,定位信号强度的测量值可以认为是服从正态分布的,会在准确值的附近产生一定的偏差。由于这样的定位信号强度的测量并不是一个准确的量,通常还具有较大的误差。进而直接映射到距离上也会是一个不准确的量,所以这样直接由接收信号强度映射得到的距离是不能直接作为定位结果的。为了保证测量结果的精确度,车辆相对定位装置利用获得的定位信号强度值来建立粒子滤波算法的感知模型。
同时在第二步中,车辆间的相对速度由于自身测量的不准确以及通信过程带来的延时也会存在误差。所以速度的测量值也可认为是服从正态分布的,但是其方差较小。同样为了保证测量结果的精确度,车辆相对定位装置利用所获得的相对速度来建立粒子滤波算法的运动模型。
在此基础上,再通过进一步的粒子滤波算法来实现更为精确的定位。
本实例中利用粒子滤波算法来进行车辆间动态相对定位,即由粒子来模拟车辆的位置,通常粒子的数量较多。具体定位运算时,如果B车要实现与A车的相对位置的定位,那么每一个粒子就表示B车相对于A车的可能位置,由此定位的流程如下(参见图3):
初始阶段,由于不存在关于两车位置的任何先验信息,就认为B车可能出现在相对与A车的任意位置,那么就将所有的粒子均匀地分布在B车可能出现的所有位置上。
接着,根据车辆间相对速度由之前建立的运动模型得出所有粒子下一时刻的位置。该运动模型就是描述当前时刻车辆的位置相对与上一时刻车辆的位置的变化,变化的依据就是获取的车辆间相对速度。当前时刻车辆的位置就是上一时刻的位置加上由此刻测得的车辆间相对速度造成的位移变化。这样就更新了当前一代粒子的相对位置向量。
再接着,由之前建立的感知模型对每一个粒子进行赋权。
该感知模型,就是车辆在每一次循环迭代中,感知该时刻的定位信号强度,通过该强度值和由运动模型得到的粒子位置,可以确定每个粒子与前车的当前相对位置与实际相对位置的接近程度。这样就能为每个粒子的重采样提供依据,即为粒子在下一时刻定位上的修正提供依据。接近程度就由粒子的权值来反映。程序中为当前一代粒子维持一个权重值向量,刚更新或者重采样后的粒子的权重值为空,每一次迭代根据接收信号的传播模型,由粒子在当前位置能感知到当前所测信号强度的概率。然后将概率经过的归一化运算后的值作为当前这一代粒子的权重值。具体的赋权原理和重采样过程如下所述。
由上一步骤得到了每一个粒子当前时刻的位置,同时这时车辆已经测得了此刻的定位信号强度,而每一个粒子能测量到该已知定位信号强度值的概率是不一样的。且可知,当粒子的位置越接近车辆的真实位置时,其能够测到该定位信号强度值的概率就越大;相反,当粒子的位置越远离车辆的真实位置时,能够测到该定位信号强度值的概率就越小。这样的话就可以用概率的归一化值作为粒子的权重,这个权重值就反映了粒子的位置与车辆的实际位置的接近程度。这样离B车辆真实位置越近的粒子就具有越大的权重值,反之,权重值越小,这就为下一步的重采样过程提供了依据。
再接着,对粒子进行重采样。由上一步可以知道,每一个粒子都具有了不同权重,权重值越大就表明粒子的位置与车辆的实际位置较为接近,反之,则粒子的位置与车辆的实际位置差距较大。这样的话就可以根据粒子的权重值来确定粒子的重采样过程。也就是说,权重值较大的粒子在重采样的过程中被选中的概率就越大,权重值较小的粒子在重采样过程中被选中的概率就小,甚至有可能被直接淘汰。如果生成同样数目的下一代粒子,那么权重值大的粒子将会被多次采样,被采样的粒子的位置信息将会得到继承,但是新一代粒子的权值向量将被置为空值。这样新一代的粒子中,就会有较多接近车辆实际位置的粒子。然后再由运动模型开始,进行下一次的粒子滤波过程。
最后,对上面的过程经过多次迭代,那么粒子的位置就会集中到车辆的实际位置的附近。达到一定的迭代次数后,粒子的位置就能较为准确的反映车辆的实际位置,通过对所有粒子的位置取平均值,最后得到的这个值就作为对车辆实际位置的估计值,这样得到的估计值就会具有较好的精度。在之后的迭代中,粒子就会对车辆的位置实现动态跟踪的过程。
至此,完成基于粒子滤波的车辆间相对位置定位过程。
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。

Claims (5)

1.基于粒子滤波的车辆间相对定位方法,其特征在于,所述定位方法,
首先获取待定位车辆之间的定位信号强度和车辆间的相对速度;
接着,通过定位信号强度建立粒子滤波算法的定位信号强度感知模型,用于确定每一个粒子的权重,首先为当前一代粒子维持一个权重值向量,刚更新或者重采样后的粒子的权重值为空,每一次迭代根据接收信号的传播模型,由粒子在当前位置能感知到当前所测信号强度的概率,然后将概率经过的归一化运算后的值作为当前这一代粒子的权重值;
同时通过车辆间的相对速度建立粒子滤波算法的运动模型,用于确定所有粒子下一刻的位置;
最后,通过粒子滤波算法来实现车辆间相对动态位置的定位,该定位过程如下:
(11)将所有粒子均匀分布于对方车辆可能出现的所有位置上;
(12)根据建立的运动模型得出所有粒子下一刻的位置;
(13)根据建立的定位信号强度感知模型确定每一个粒子的权重;
(14)对粒子进行重采样;
(15)经过多次迭代,对所有粒子的位置取平均值,并输出作为车辆间相对动态位置。
2.根据权利要求1所述的基于粒子滤波的车辆间相对定位方法,其特征在于,所述定位方法具体包括如下步骤:
(1)建立待定位车辆之间的相互通信,使车辆之间具备通信功能,并实现车辆间的身份鉴别和相互数据交换;
(2)获取定位信号强度和车辆间的相对速度;
(3)结合定位信号强度和车辆间的相对速度,并通过粒子滤波算法实现车辆间相对动态位置的定位。
3.根据权利要求2所述的基于粒子滤波的车辆间相对定位方法,其特征在于,所述步骤(1)中待定位车辆间通过无线局域网WIFI方式或者ZigBee无线网络的方式建立相互的无线通信,并进行身份鉴别和相互数据交换。
4.根据权利要求2所述的基于粒子滤波的车辆间相对定位方法,其特征在于,所述步骤(2)中的车辆间相对速度的获取是通过车辆各自获取自身速度,并由无线通信过程交换速度信息,从而得到车辆间的相对速度。
5.根据权利要求1所述的基于粒子滤波的车辆间相对定位方法,其特征在于,所述步骤(14)中如果要采样相同的粒子数目,那么权重值大的粒子将会被多次采样。
CN201310382644.7A 2013-08-28 2013-08-28 基于粒子滤波的车辆间相对定位方法 Active CN103454614B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310382644.7A CN103454614B (zh) 2013-08-28 2013-08-28 基于粒子滤波的车辆间相对定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310382644.7A CN103454614B (zh) 2013-08-28 2013-08-28 基于粒子滤波的车辆间相对定位方法

Publications (2)

Publication Number Publication Date
CN103454614A CN103454614A (zh) 2013-12-18
CN103454614B true CN103454614B (zh) 2016-02-17

Family

ID=49737190

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310382644.7A Active CN103454614B (zh) 2013-08-28 2013-08-28 基于粒子滤波的车辆间相对定位方法

Country Status (1)

Country Link
CN (1) CN103454614B (zh)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103987043A (zh) * 2014-06-03 2014-08-13 上海安车信信息技术有限公司 一种利用无线wifi信号进行车辆自动识别的方法
CN105911518A (zh) * 2016-03-31 2016-08-31 山东大学 机器人定位方法
CN108897026A (zh) * 2018-08-28 2018-11-27 北京讯腾智慧科技股份有限公司 卫星导航信号受遮挡情况下的合作车辆定位方法及装置
CN111174777A (zh) * 2018-11-09 2020-05-19 阿里巴巴集团控股有限公司 定位方法、装置以及电子设备
CN109974690B (zh) * 2019-03-18 2021-07-09 汉海信息技术(上海)有限公司 车辆定位方法、设备及系统
CN113050140A (zh) * 2019-12-27 2021-06-29 中移智行网络科技有限公司 一种定位方法、装置、存储介质和服务器
CN111356228A (zh) * 2020-03-03 2020-06-30 上海万位数字技术有限公司 一种交通出行设备的蓝牙定位系统以及蓝牙定位方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102595309A (zh) * 2012-01-19 2012-07-18 辉路科技(北京)有限公司 一种基于无线传感器网络的穿墙跟踪方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102595309A (zh) * 2012-01-19 2012-07-18 辉路科技(北京)有限公司 一种基于无线传感器网络的穿墙跟踪方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
"Vehicle Tracking Using Particle Filter in Wi-Fi Network";Henghui Lu et al.;《Vehicular Technology Conference Fall (VTC 2010-Fall), 2010 IEEE 72nd》;20100909;第1-5页 *
"基于相对观测量的机器人合作FastSLAM算法";张莉莉 等;《华中科技大学学报(自然科学版)》;20081031;第36卷;第171-173页 *
"基于粒子滤波的ZigBee无线定位跟踪方法";张科;《华中科技大学硕士学位论文》;20121225;第21-32页 *

Also Published As

Publication number Publication date
CN103454614A (zh) 2013-12-18

Similar Documents

Publication Publication Date Title
CN103454614B (zh) 基于粒子滤波的车辆间相对定位方法
KR101206634B1 (ko) 참조 포지션과의 포지션 일치 결정 장치 및 그 방법
CN103162689B (zh) 辅助车载定位系统及车辆的辅助定位方法
CN104796866A (zh) 室内定位方法和装置
US20130151140A1 (en) Apparatus and method for performing map matching
TWI506293B (zh) Method, device and system for vehicle positioning
GB2536846A (en) Position measurement method, own position measurement device, and in-vehicle device
CN105091911A (zh) 一种pos系统动态定位精度检测系统及方法
CN105004340A (zh) 结合惯性导航技术和指纹定位技术的定位误差修正方法
CN105704652A (zh) 一种wlan/蓝牙定位中的指纹库采集和优化方法
CN102340806B (zh) 一种确定天线方向角的方法和设备
CN104780605A (zh) 一种终端的定位方法和装置
JP2015090285A (ja) 車両位置同定システム及び車両位置同定方法
CN105636201A (zh) 基于稀疏信号指纹数据库的室内定位方法
CN104507097A (zh) 一种基于WiFi位置指纹的半监督训练方法
CN104851291A (zh) 一种实时车道拥堵指数分析系统及其分析方法
CN104135766A (zh) 一种基于网格划分的无线网络间的协作定位方法
KR101749098B1 (ko) 기지국 위치추정 시스템 및 이의 기지국 위치추정 방법
CN102012231A (zh) 数据更新方法和装置
CN105866731A (zh) 车辆定位方法及车载终端设备
CN106971601A (zh) 一种基于WiFi的智能泊车及找回的系统与方法
CN102472810A (zh) 用于校准基于传播时间的定位系统的方法
CN204537445U (zh) 一种实时车道拥堵指数分析系统
KR20180110392A (ko) 스마트기기 기반의 실내 위치 측정을 위한 하이브리드 위치 측위 방법
Clausen et al. Assessment of positioning accuracy of vehicle trajectories for different road applications

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C41 Transfer of patent application or patent right or utility model
TR01 Transfer of patent right

Effective date of registration: 20160624

Address after: 200092 209D room, No. two, 1121 North Road, Zhongshan, Shanghai, Yangpu District

Patentee after: Shanghai Yongchang Information Technology Co.,Ltd.

Patentee after: Suzhou Ainuoxin Information Technology Co., Ltd.

Address before: 200092 209D room, No. two, 1121 North Road, Zhongshan, Shanghai, Yangpu District

Patentee before: Shanghai Yongchang Information Technology Co.,Ltd.

TR01 Transfer of patent right

Effective date of registration: 20181207

Address after: 215505 Jiangsu Changzhou high tech Industrial Development Zone, 333 Hu Shan Road 1 Tongji Science and Technology Square 2302

Patentee after: Suzhou Ainuoxin Information Technology Co., Ltd.

Address before: Room 209D, 1121 North Zhongshan Road, Yangpu District, Shanghai, 200092

Co-patentee before: Suzhou Ainuoxin Information Technology Co., Ltd.

Patentee before: Shanghai Yongchang Information Technology Co.,Ltd.

TR01 Transfer of patent right
CP02 Change in the address of a patent holder

Address after: 215558 Tongji Science and Technology Plaza, 333 Hushan Road, Changshu High-tech Industrial Development Zone, Suzhou City, Jiangsu Province, 2302

Patentee after: Suzhou Ainuoxin Information Technology Co., Ltd.

Address before: 215505 Jiangsu Changzhou high tech Industrial Development Zone, 333 Hu Shan Road 1 Tongji Science and Technology Square 2302

Patentee before: Suzhou Ainuoxin Information Technology Co., Ltd.

CP02 Change in the address of a patent holder
CP03 Change of name, title or address

Address after: 201804 room 1, floor 2, No. 82, Lane 1221, Hanggui Road, Anting Town, Jiading District, Shanghai

Patentee after: Shanghai ainuoweixin Intelligent Technology Co.,Ltd.

Address before: 215558 Tongji Science and Technology Plaza, 333 Hushan Road, Changshu High-tech Industrial Development Zone, Suzhou City, Jiangsu Province, 2302

Patentee before: Suzhou Ainuoxin Information Technology Co.,Ltd.

CP03 Change of name, title or address