CN106772516A - 一种基于模糊理论的复合定位新方法 - Google Patents
一种基于模糊理论的复合定位新方法 Download PDFInfo
- Publication number
- CN106772516A CN106772516A CN201611088423.9A CN201611088423A CN106772516A CN 106772516 A CN106772516 A CN 106772516A CN 201611088423 A CN201611088423 A CN 201611088423A CN 106772516 A CN106772516 A CN 106772516A
- Authority
- CN
- China
- Prior art keywords
- location
- fuzzy
- positioning
- target vehicle
- gps
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/46—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being of a radio-wave signal type
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种基于模糊理论的复合定位新方法,属于车辆定位的技术领域,基于汽车信息物理融合***技术,利用目标车辆以及相邻车辆上的三种定位装置的定位数据,运用模糊理论优化各定位技术的误差并得出各定位技术的定位贡献度,然后以定位贡献度作为权值,模糊加权计算得到目标车辆的复合位置;采用一个模糊可变观测噪声协方差的卡尔曼滤波器对复合位置进行滤波,本发明将多种车辆定位技术进行融合,构建了离群率和绝对误差这两个指标来反映各定位技术的可靠程度,提高了定位技术融合的合理性,同时采用改进的卡尔曼滤波器对融合结果进行滤波,提高了定位的准确性。
Description
技术领域
本发明涉及一种基于模糊理论的复合定位新方法,属于车辆定位的技术领域。
背景技术
信息-物理融合***CPS(Cyber-Physical System)是一个综合计算、网络和物理环境的多维复杂***,通过3C技术(Computing、Communication和Control)的有机融合与深度协作,以实现实时感知、信息服务和动态控制。近年来,人们研究了CPS在电力、医疗、交通等领域的应用,并已取得了一些极具价值的成果。随着城市智能交通***的建设和人们对汽车性能要求的提高,汽车CPS(Vehicular Cyber-Physical System,VCPS)也受到了很多学者的关注。在汽车CPS中,实时传入传感器收集本车的实时信息或其它车辆的信息,通过一个统一的网络完成信息的交互和计算,并根据反馈的信息来完成对汽车的控制,使得汽车更易于驾驶,响应更快,更安全,更智能。由于在汽车CPS的大多数应用中,比如智能路径规划、防碰撞***以及车辆组网等,车辆的位置信息往往假设为一个已知的条件,因此,车辆定位技术在汽车CPS中是一个值得关注的问题。
目前,最常用的车辆定位方法是全球定位***(Global Positioning System,GPS),虽然GPS定位有着自身覆盖范围广,定位迅速,在无遮挡情况下可实现全天候定位的优势。但是,在城市中,高大密集的建筑、立交桥、隧道、无线电干扰等,非常容易地造成GPS定位效果较差,不能准确定位。即使在郊外,定位精度也无法达到安全应用如防碰撞***的定位要求。差分全球定位***(Differential Global Positioning System,DGPS)虽然可以提供很高的定位精度,但其设备价格昂贵,且同样会受城市环境下的多径效应(建筑物和树林等对卫星信号的遮挡)影响,其定位性能大大下降。综合考虑到成本和性能,大多数车辆定位采用将GPS与航位推算(Dead Reckoning,DR)、惯性导航***(Inertial NavigationSystem,INS)等导航技术进行组合的方式。但由于航位推算和惯性导航中所使用的惯性器件存在累积误差,在GPS长时间失效的遮挡环境下定位精度不高。为了进一步提高组合定位***的精度,通常采用卡尔曼滤波进行最优估计。但是在滤波递推过程中通常将观测噪声协方差作为定值处理,降低了滤波的精度和稳定性。除了上述基于GPS的定位技术外,现在还有其他一些定位技术,如射频识别(Radio Frequency Identification,RFID)定位、蜂窝网络(Cellular Network,CN)定位以及无线保真(Wireless-Fidelity,WiFi)定位等,这些定位技术也可用于车辆定位中。但是,这些定位技术在一定程度上受到视距和基站密度的影响。
随着异构无线网络技术的成熟和普及,利用多种定位技术的融合互补是未来车辆定位的一种行之有效的方法。而卡尔曼滤波能够有效修正观测值,抑制异常波动,提高***的精度,因此被广泛应用于车辆定位***中。本申请人致力于如何把融合互补过程和卡尔曼滤波模型有效结合的研究,因此具有很重要的发明意义。
发明内容
本发明针对现有技术在车辆定位方面存在精度不高、成本高昂、缺乏普适性等问题,结合汽车CPS***中实时感知本车或其它车辆的信息,实现信息的交互和计算并根据反馈信息来完成对汽车的控制的特点,提出一种新的基于模糊理论的复合定位技术。
本发明提出一种基于模糊理论的复合定位新方法,首先获取目标车辆以及某相邻车辆上三种定位技术装置(GPS,WiFi和CN)的定位数据和两车之间的精确距离,然后计算出能够反映各定位技术可靠程度的两个指标:离群率和绝对误差,同时运用模糊理论融合这两个指标,得出各定位技术的定位贡献度,接着以定位贡献度作为权值,模糊加权计算得到目标车辆的复合位置;最后采用一个模糊可变观测噪声协方差的卡尔曼滤波器对复合位置进行滤波,从而得到一个更加实时、准确的车辆位置。该方法包括下列操作步骤:
步骤1,利用V2V(汽车-汽车)通信技术和三种定位装置,采集目标车辆以及某相邻车辆的三种定位装置的定位数据和两车之间的精确距离;所述三种定位装置分别为:全球定位***(Global Positioning System,GPS)、无线保真(Wireless-Fidelity,WiFi)定位***和蜂窝网络(Cellular Network,CN)定位***。
步骤2,采集到目标车辆的三种定位装置的定位数据分别为:GPS(X,Y)、WiFi(X,Y)和CN(X,Y),某相邻车辆的三种定位装置的定位数据分别为:GPSnei(X,Y)、WiFinei(X,Y)和CNnei(X,Y),以及两车之间的精确距离为:D,然后计算出目标车辆各定位技术的离群率(s)分别为:
和其中dGW表示GPS(X,Y)与WiFi(X,Y)之间的欧几里得距离,dGC和dWC同理。各定位技术的绝对误差(e)分别为:
eGPS=|DG-D|、eWiFi=|DW-D|和eCN=|DC-D|,其中DG表示GPS(X,Y)与GPSnei(X,Y)之间的欧几里得距离,DW和DC同理。由上述计算可知,离群率表明了某定位技术的定位数据与其它定位数据的背离程度,而绝对误差表明了某定位技术得出的两车距离与实际距离的误差,两者在一定程度上均能反映该定位技术的可靠程度。
步骤3,将目标车辆各定位技术的离群率和绝对误差模糊融合后得到这些定位技术各自对应的定位贡献度。由于离群率(s)、绝对误差(e)和贡献度(w)皆为精确量,因此需要分别为其确定模糊属性。首先确定它们的论域,分别记作S、E和W,然后为各论域确定模糊子集及相应的隶属度函数,最后确定这三个论域之间的关系,即模糊规则。具体确定过程如下:
(1)根据离群率的计算可知,其论域S=(0,1)。为了保证灵敏度的同时尽量减少计算量,本文在论域S上定义了5个模糊子集,分别为:很小、较小、适中、较大、很大。
(2)由于各定位技术的绝对误差一般不会超过3m,若超过3m则按3m进行计算。因此,其论域E=[0,3]。同样可在论域E上定义5个模糊子集,分别为:很小、较小、适中、较大、很大。
(3)由于权重值只是用来标称各定位技术的定位可信度,因此可取其论域W=(0,1)。其论域上的模糊子集同离群率。
(4)根据离群率和绝对误差对定位贡献度的影响程度,作出相应模糊规则。模糊规则的形式可以表示为:如果s等于Ai并且e等于Bj,则w等于Cij,其中Ai是离群率的模糊语言量,Bj为绝对误差的模糊语言量,Cij为定位贡献度的模糊语言量。然后依据制定好的模糊规则和玛达尼推理法,得出GPS、WIFi和CN这三种定位技术的定位贡献度分别为:wGPS、wWiFi和wCN。
步骤4,将目标车辆的三种定位技术的定位贡献度,即wGPS、wWiFi和wCN作为权值,模糊加权计算得到目标车辆的复合位置为:
步骤5,将目标车辆的三种定位技术的定位贡献度之和作为评定复合位置可信程度的指标,记作:Cm=wGPS+wWiFi+wCN。将该指标输入另一个模糊控制器后,得到一个控制量记作:Δr。该控制量用来动态调节卡尔曼滤波器中的观测噪声协方差矩阵。同样的,需要为Cm和Δr确定模糊属性和相应的模糊规则:Cm的论域规定为(0,3),且划分为5个模糊子集:很小、较小、适中、较大、很大;Δr的论域规定为(-2,2),且划分为5个模糊子集:负大、负小、零、正小、正大;根据卡尔曼滤波递推公式,可以得出如下模糊规则:
规则1:如果Cm很小,那么Δr为正大;
规则2:如果Cm较小,那么Δr为正小;
规则3:如果Cm适中,那么Δr为零;
规则4:如果Cm较大,那么Δr为负小;
规则5:如果Cm很大,那么Δr为负大。
步骤6,把目标车辆k时刻的复合位置Targetk(X,Y)作为卡尔曼滤波递推公式中观测量Z(k)的值,同时将k时刻的控制量Δr用于卡尔曼滤波递推公式中观测噪声协方差矩阵R的动态调节,即:Z(k)=Targetk(X,Y),R(k)=(1+Δr(k))R,其中R(k)即为可变观测噪声协方差矩阵。最后,在卡尔曼滤波递推过程中,将公式中的进一步估计值作为目标车辆最终的实时定位结果。
本发明提出一种基于模糊理论的复合定位新方法,其创新技术是:结合CPS***可实现实时感知、信息服务和动态控制的特点,运用模糊理论融合三种车辆定位技术(GPS,WiFi和CN),构建了能反映各定位技术可靠程度的两个指标:离群率和绝对误差,提高了定位技术融合的合理性;同时采用模糊可变噪声协方差卡尔曼滤波器对融合结果进行滤波,提高了定位的准确性。本发明的优点是:操作步骤简单、实时性强,可用于不同环境下,且定位准确率高、计算量小,可适用于多种定位设备,因此,推广容易,应用广泛,具有很好的应用前景。
附图说明
图1是一种基于模糊理论的复合定位新方法示意图。
图2是一种基于模糊理论的复合定位新方法流程示意图。
图3是复合定位新方法和CPS理论融合框架图。
图4是目标车辆的行驶轨迹试验图。
图5是目标车辆的定位累积误差试验图。
图6是目标车辆的定位累积分布函数试验图。
具体实施方式
下面结合附图1至6对本发明作进一步的详细描述。本发明提出一种新的基于模糊理论的复合定位方法:首先获取目标车辆以及相邻车辆上的三种定位技术装置(GPS,WiFi和CN)的定位数据和两车之间的精确距离,然后计算出能够反映各定位技术可靠程度的两个指标:离群率和绝对误差,同时运用模糊理论融合这两个指标,得出各定位技术的定位贡献度,接着以定位贡献度作为权值,模糊加权计算得到目标车辆的复合位置;最后采用一个模糊可变观测噪声协方差的卡尔曼滤波器对复合位置进行滤波,从而得到一个更加实时、准确的车辆位置。
参见图1和图2,具体介绍本发明方法的下列操作步骤:
步骤1,利用V2V(汽车-汽车)通信技术和三种定位装置(GPS,WiFi和CN),采集目标车辆以及某相邻车辆的三种定位装置的定位数据和两车之间的精确距离。如图1所示,本发明的三种定位装置分别为:全球定位***(Global Positioning System,即GPS)、无线保真(Wireless-Fidelity,即WiFi)定位***和蜂窝网络(Cellular Network,即CN)定位***。此外,V2V(汽车-汽车)通信技术用来测量目标车辆与某相邻车辆之间的精确距离并相互共享各自的定位数据。
步骤2,采集到目标车辆以及某相邻车辆的三种定位装置的定位数据和两车之间的精确距离后,计算出目标车辆各定位技术的离群率和绝对误差。如图2所示,采集到目标车辆的三种定位装置的定位数据分别为:GPS(X,Y)、WiFi(X,Y)和CN(X,Y),某相邻车辆的三种定位装置的定位数据分别为:GPSnei(X,Y)、WiFinei(X,Y)和CNnei(X,Y),以及两车之间的精确距离为D。通过离群率计算模块和绝对误差计算模块后,可得到目标车辆各定位技术的离群率分别为:sGPS、sWiFi和sCN,各定位技术的绝对误差分别为:eGPS、eWiFi和eCN。
步骤3,将离群率和绝对误差模糊化后,根据制定好的模糊规则以及玛达尼推理法得到这些定位技术各自对应的定位贡献度。其模糊规则如下表所示:
如图2所示,将目标车辆各定位技术的离群率和绝对误差输入模糊控制器1之后,可得到这些定位技术各自对应的定位贡献度分别为:wGPS、wWiFi和wCN。
步骤4,将定位贡献度作为权值,通过对各定位装置的定位数据进行模糊加权计算,得到目标车辆的复合位置。如图2所示,目标车辆各定位技术的定位贡献度,通过加权平均计算模块后,可得到目标车辆的复合位置为:Target(X,Y)。
步骤5,将各定位技术的定位贡献度之和作为输入,通过另一个模糊控制器2的调节之后,得到一个控制量。如图2所示,目标车辆各定位技术k时刻的定位贡献度之和Cm(k),在输入模糊控制器2后,可以得到一个控制量Δr(k)。
步骤6,把所得到的复合位置作为卡尔曼滤波公式中的观测量,同时将控制量用于卡尔曼滤波公式中观测噪声协方差矩阵的动态调节,然后执行卡尔曼滤波递推过程,最后将卡尔曼滤波公式中的进一步估计值作为目标车辆最终的实时定位结果。如图2所示,把目标车辆k时刻的复合位置Targetk(X,Y)作为卡尔曼滤波公式中观测量Z(k)的值,同时将k时刻的控制量Δr(K)用于卡尔曼滤波公式中观测噪声协方差矩阵R的动态调节,得到可变观测噪声协方差矩阵R(k),然后执行卡尔曼滤波递推过程,最后将卡尔曼滤波公式中的进一步估计值作为目标车辆最终的实时定位结果。
需要说明的是,虽然本发明所述方法是利用上述三种现有的定位技术计算得到准确的目标车辆的实时位置。但是,车载终端在实际应用时,使用三种或三种以上定位装置采集各自定位数据时,对定位技术的种类和数量都没有限制。比如在上述三种定位技术的基础上增加一种射频识别(Radio Frequency Identification,RFID)定位技术,且目标车辆和某相邻车辆的RFID定位数据分别为:RFID(X,Y)和RFIDnei(X,Y),则目标车辆的四种定位技术的离群率改写为:
其中dGW表示GPS(X,Y)与WiFi(X,Y)之间的欧几里得距离,dGC、dGF、dWC、dWF和dCF同理。在各定位技术的绝对误差中,GPS、WiFi和CN的保持不变,只需添加RFID的绝对误差为:eRFID=|DF-D|,其中DF表示RFID(X,Y)和RFIDnei(X,Y)之间的欧几里得距离。然后目标车辆的复合位置改写为:
其中wRFID为RFID定位技术的贡献度,其它变量含义同上。复合位置可信程度的指标改写为:Cm=wGPS+wWiFi+wCN+wRFID,同时Cm的论域改为(0,4),其它参数保持不变。
此外,本发明方法中的复合定位方法与CPS理论融合之后,可更好的服务于大部分的车辆应用场景,比如智能路径规划、防碰撞***以及车辆组网等。现以车辆组网为例,如图3所示,当目标车辆获取到相关数据(定位数据和两车距离)之后,便运行本发明中的复合定位算法;在获取自身定位数据后,可将自身的行驶状态(位置、速度、方向、目的地等)共享至云服务中心,同时可获取周围车辆的行驶状态;然后根据自身的行驶状态和周围车辆的行驶状态来动态决定是否需要组网以及与哪些车辆进行组网,通常情况下,应当选取目的地、速度和方向都比较接近的车辆进行组网,从而增加车载自组织网络的通信链路时间并提高网络服务质量。此过程通过3C技术(Computing、Communication和Control)的有机融合与深度协作,达到了实时感知和动态组网的目的。
本发明在MATLAB平台上进行了仿真实施试验,试验参数如下表所示:
试验结果从目标车辆各定位技术的定位轨迹、累积误差和累积分布函数这三个方面对本发明方法的性能做了对比分析。如图4所示,在前200m的距离内,本发明方法的定位轨迹显然比GPS、WiFi和CN的定位轨迹更加靠近目标车辆的实际轨迹。此外,各定位方法的定位累积误差(前200m内),如图5所示,表明本发明方法能把定位累积误差控制在20m左右,而GPS、WiFi和CN均超过了100m。最后,我们给出了整个试验阶段中目标车辆使用各定位方法产生的定位误差累积分布函数(Cumulative Distribution Function,CDF),如图6所示,表明本发明方法的定位误差能够达到4m的精度要求,相比GPS、WiFi和CN的10m的定位精度,提高了将近%60。
由此可见,实施例中本发明提出的一种新的基于模糊理论的复合定位方法能够有效结合GPS、WiFi和CN这三种定位技术并提高定位精度,且每次定位时间耗时都在50ms以内,因此满足了实时、准确的定位需求。应当指出,凡属于本发明思路下的技术方案均属于本发明的保护范围;对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。车载终端在实际应用时,使用三种或三种以上定位装置采集各自定位数据时,对所述定位装置的种类和数量都没有限制,参见附图1,目标车辆通过三个GPS定位装置、三个WiFi定位装置和三个CN装置共同定位。
Claims (8)
1.一种基于模糊理论的复合定位新方法,其特征在于,通过获取目标车辆以及某相邻车辆上的三种定位技术装置的定位数据,以及两车之间的精确距离,所述三种定位技术装置分别为:全球定位***、无线保真定位***和蜂窝网络定位***;
计算出各定位技术装置的离群率和绝对误差;
并运用模糊理论融合离群率和绝对误差,运用玛达尼推理法得出各定位技术装置的定位贡献度;
再以定位贡献度作为权值,模糊加权计算得到目标车辆的复合位置;
最后采用一个模糊可变观测噪声协方差的卡尔曼滤波器对复合位置进行滤波,从而得到一个更加实时、准确的车辆位置。
2.根据权利要求1所述的一种基于模糊理论的复合定位新方法,其特征在于包括以下步骤,
步骤1:利用车对车通信技术和三种定位技术装置,采集目标车辆以及某相邻车辆之间的精确距离和三种定位技术装置的定位数据;
步骤2:计算出目标车辆各定位技术装置的离群率和绝对误差;
步骤3:运用模糊理论融合离群率和绝对误差,运用玛达尼推理法得到这些定位技术装置各自对应的定位贡献度;
步骤4:将定位贡献度作为权值,通过对各定位技术装置的定位数据进行加权平均计算,得到目标车辆的复合位置;
步骤5:将各定位技术的定位贡献度之和作为输入,通过另一个模糊控制器的调节之后,得到一个控制量;
步骤6:把所得到的复合位置作为卡尔曼滤波公式中的观测量,同时将控制量用于卡尔曼滤波公式中观测噪声协方差矩阵的动态调节;执行卡尔曼滤波递推过程,最后将卡尔曼滤波公式中的进一步估计值作为目标车辆最终的实时定位结果。
3.根据权利要求2所述的一种基于模糊理论的复合定位新方法,其特征在于,
所述步骤2包括,设定目标车辆某时刻获取的三种定位装置的定位数据分别为:GPS(X,Y)、WiFi(X,Y)和CN(X,Y),获取到某相邻车辆的相应定位数据分别为:GPSnei(X,Y)、WiFinei(X,Y)和CNnei(X,Y),且目标车辆与该相邻车辆之间距离的精确计算结果为D;那么各定位技术的离群率(s)分别为:
和
其中dGW表示GPS(X,Y)与WiFi(X,Y)之间的欧几里得距离,dGC和dWC同理;
定位技术的绝对误差(e)分别为:
eGPS=|DG-D|、eWiFi=|DW-D|和eCN=|DC-D|,
其中DG表示GPS(X,Y)与GPSnei(X,Y)之间的欧几里得距离,DW和DC同理;
由上述计算可知,离群率表明了某定位技术的定位数据与其它定位数据的背离程度,而绝对误差表明了某定位技术得出的两车距离与实际距离的误差,两者在一定程度上均能反映该定位技术的可靠程度。
4.根据权利要求2所述的一种基于模糊理论的复合定位新方法,其特征在于,
所述步骤3包括离群率s、绝对误差e和贡献度w皆为精确量,因此需要分别为其确定模糊属性,首先确定它们的论域,分别记作S、E和W,然后为各论域确定模糊子集及相应的隶属度函数,最后确定这三个论域之间的关系,即模糊规则;具体步骤如下:
(1).根据离群率的计算可知,其论域S=(0,1),为了保证灵敏度的同时尽量减少计算量,本文在论域S上定义了5个模糊子集,分别为很小、较小、适中、较大、很大;
(2).由于各定位技术的绝对误差一般不会超过3m,若超过3m则按3m进行计算,因此,其论域E=[0,3],同样可在论域E上定义5个模糊子集,分别为很小、较小、适中、较大、很大;
(3).由于定位贡献度只是用来标称各定位技术的定位可信程度,因此可取其论域W=(0,1),其论域上的模糊子集同离群率。
(4).跟据离群率和绝对误差对定位贡献度的影响程度,相应地模糊规则可以表示为:如果s等于Ai并且e等于Bj,则w等于Cij,其中Ai是离群率的模糊语言量,Bj为绝对误差的模糊语言量,Cij为定位贡献度的模糊语言量;
(5).根据步骤4的模糊规则和玛达尼推理法,得出GPS、WIFi和CN这三种定位技术的定位贡献度分别为:wGPS、wWiFi和wCN。
5.根据权利要求2所述的一种基于模糊理论的复合定位新方法,其特征在于,
所述步骤4包括,将三种定位技术装置的定位贡献度,即wGPS、wWiFi和wCN作为权值,模糊加权计算得到目标车辆的复合位置为:
6.根据权利要求2所述的一种基于模糊理论的复合定位新方法,其特征在于,
所述步骤5包括将三种定位技术装置的定位贡献度之和作为评定复合位置可信程度的指标,记作:Cm=wGPS+wWiFi+wCN;
同时把Cm的论域规定为(0,3),且划分为5个模糊子集:很小、较小、适中、较大、很大;
然后将该指标通过另一个模糊控制器之后得到一个控制量,记作:Δr;
同样的把Δr的论域规定为(-2,2),且划分为5个模糊子集:负大、负小、零、正小、正大;
该控制量用来动态调节卡尔曼滤波器中的观测噪声协方差矩阵,根据卡尔曼滤波递推公式,可以得出如下模糊规则:
规则1:如果Cm很小,那么Δr为正大;
规则2:如果Cm较小,那么Δr为正小;
规则3:如果Cm适中,那么Δr为零;
规则4:如果Cm较大,那么Δr为负小;
规则5:如果Cm很大,那么Δr为负大。
7.根据权利要求2所述的一种基于模糊理论的复合定位新方法,其特征在于,
所述步骤6包括,把目标车辆k时刻的复合位置Targetk(X,Y)作为卡尔曼滤波递推公式中观测量Z(k)的值,同时将k时刻的控制量Δr用于卡尔曼滤波递推公式中观测噪声协方差矩阵R的动态调节,
即:Z(k)=Targetk(X,Y),R(k)=(1+Δr(k))R,其中R(K)即为可变观测噪声协方差矩阵;在卡尔曼滤波递推过程中,将公式中的进一步估计值作为目标车辆最终的实时定位结果。
8.根据权利要求2所述的一种基于模糊理论的复合定位新方法,其特征在于,
所述方法是利用了三种现有定位技术装置和车对车通信技术计算得到实时、准确的目标车辆位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611088423.9A CN106772516B (zh) | 2016-12-01 | 2016-12-01 | 一种基于模糊理论的复合定位新方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611088423.9A CN106772516B (zh) | 2016-12-01 | 2016-12-01 | 一种基于模糊理论的复合定位新方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106772516A true CN106772516A (zh) | 2017-05-31 |
CN106772516B CN106772516B (zh) | 2019-02-05 |
Family
ID=58915209
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611088423.9A Active CN106772516B (zh) | 2016-12-01 | 2016-12-01 | 一种基于模糊理论的复合定位新方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106772516B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108267148A (zh) * | 2017-12-22 | 2018-07-10 | 重庆长安汽车股份有限公司 | 基于v2x车辆定位装置及运用其的位置融合*** |
CN110769373A (zh) * | 2019-09-25 | 2020-02-07 | 杭州电子科技大学 | 基于社团发现的车辆定位方法 |
CN111801549A (zh) * | 2018-02-27 | 2020-10-20 | 雷诺股份公司 | 用于选择出车辆的可能位置的有限或空假设集合的方法 |
CN113405560A (zh) * | 2021-05-28 | 2021-09-17 | 武汉理工大学 | 车辆定位和路径规划统一建模方法 |
CN114245460A (zh) * | 2022-02-25 | 2022-03-25 | 深圳市海豚科技创新有限公司 | 定位方法、定位***、电子***和计算机可读存储介质 |
CN116242410A (zh) * | 2022-09-05 | 2023-06-09 | 浙江智马达智能科技有限公司 | 一种标定方法、终端及计算机存储介质 |
US11943760B2 (en) | 2021-07-22 | 2024-03-26 | Toyota Motor Engineering & Manufacturing North America, Inc. | Deep cooperative feature sharing among connected vehicles |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012009793A1 (en) * | 2010-07-19 | 2012-01-26 | Donghyun Kim | Satellite-based automatic steering system |
CN103268616A (zh) * | 2013-04-18 | 2013-08-28 | 北京工业大学 | 多特征多传感器的移动机器人运动人体跟踪方法 |
CN104977006A (zh) * | 2015-08-11 | 2015-10-14 | 北京纳尔信通科技有限公司 | 一种基于模糊理论和多传感器融合的室内定位方法 |
-
2016
- 2016-12-01 CN CN201611088423.9A patent/CN106772516B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012009793A1 (en) * | 2010-07-19 | 2012-01-26 | Donghyun Kim | Satellite-based automatic steering system |
CN103268616A (zh) * | 2013-04-18 | 2013-08-28 | 北京工业大学 | 多特征多传感器的移动机器人运动人体跟踪方法 |
CN104977006A (zh) * | 2015-08-11 | 2015-10-14 | 北京纳尔信通科技有限公司 | 一种基于模糊理论和多传感器融合的室内定位方法 |
Non-Patent Citations (2)
Title |
---|
A.NOURELDIN等: "Adaptive neuro-fuzzy module for inertial navigation system/global positioning system integration utilising position and velocity updates with real-time cross-validation", 《IET RADAR SONAR NAVIG》 * |
安吉尧: "T-S模糊***理论及在控制论中的应用", 《中国博士学位论文全文数据库基础科学辑》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108267148A (zh) * | 2017-12-22 | 2018-07-10 | 重庆长安汽车股份有限公司 | 基于v2x车辆定位装置及运用其的位置融合*** |
CN111801549A (zh) * | 2018-02-27 | 2020-10-20 | 雷诺股份公司 | 用于选择出车辆的可能位置的有限或空假设集合的方法 |
CN110769373A (zh) * | 2019-09-25 | 2020-02-07 | 杭州电子科技大学 | 基于社团发现的车辆定位方法 |
CN113405560A (zh) * | 2021-05-28 | 2021-09-17 | 武汉理工大学 | 车辆定位和路径规划统一建模方法 |
US11943760B2 (en) | 2021-07-22 | 2024-03-26 | Toyota Motor Engineering & Manufacturing North America, Inc. | Deep cooperative feature sharing among connected vehicles |
CN114245460A (zh) * | 2022-02-25 | 2022-03-25 | 深圳市海豚科技创新有限公司 | 定位方法、定位***、电子***和计算机可读存储介质 |
CN114245460B (zh) * | 2022-02-25 | 2022-05-27 | 深圳市海豚科技创新有限公司 | 定位方法、定位***、电子***和计算机可读存储介质 |
CN116242410A (zh) * | 2022-09-05 | 2023-06-09 | 浙江智马达智能科技有限公司 | 一种标定方法、终端及计算机存储介质 |
CN116242410B (zh) * | 2022-09-05 | 2023-12-19 | 浙江智马达智能科技有限公司 | 一种标定方法、终端及计算机存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN106772516B (zh) | 2019-02-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106772516A (zh) | 一种基于模糊理论的复合定位新方法 | |
RU2756439C1 (ru) | Определение локализации для работы транспортного средства | |
Alam et al. | A DSRC Doppler-based cooperative positioning enhancement for vehicular networks with GPS availability | |
Liu et al. | Improving positioning accuracy using GPS pseudorange measurements for cooperative vehicular localization | |
Yang et al. | Multi-sensor multi-vehicle (MSMV) localization and mobility tracking for autonomous driving | |
Ghaleb et al. | Improved vehicle positioning algorithm using enhanced innovation-based adaptive Kalman filter | |
CN107315413B (zh) | 一种车车通信环境下考虑车辆间相对位置的多车协同定位算法 | |
CN106454722A (zh) | 一种移动通信终端基于地图匹配的动态差分定位方法 | |
CN105682222A (zh) | 一种基于车辆自组织网络的车辆位置定位信息融合方法 | |
CN105138779A (zh) | 车载gps时空轨迹大数据优选方法及*** | |
CN104677361B (zh) | 一种综合定位的方法 | |
CN105704652A (zh) | 一种wlan/蓝牙定位中的指纹库采集和优化方法 | |
CN108415057A (zh) | 一种无人车队与路侧单元协同工作的相对定位方法 | |
CN105788263A (zh) | 一种通过手机信息预测道路拥堵的方法 | |
CN106303968A (zh) | 一种基于专用短程通信网络的路网黑客车辆定位方法 | |
CN104507097A (zh) | 一种基于WiFi位置指纹的半监督训练方法 | |
CN110830915B (zh) | 一种确定起点位置的方法及装置 | |
CN106507305A (zh) | 一种车辆gps定位位置的智能上传方法 | |
CN112462401B (zh) | 基于浮动车轨迹数据的城市峡谷快速探测方法及装置 | |
Du et al. | Cooperative vehicle localization base on extended Kalman filter in intelligent transportation system | |
CN105158731B (zh) | 一种基于路测功率值的信源定位方法 | |
Huang et al. | Cv2x-loca: Roadside unit-enabled cooperative localization framework for autonomous vehicles | |
CN102052925A (zh) | 基于空间关系约束的适配区景象匹配方法 | |
CN108398704B (zh) | 一种贝叶斯滤波的多车辆协作定位方法 | |
Chen et al. | Hybrid ToA/AoA schemes for mobile location in cellular communication systems |
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 |