CN113795769B - 车辆定位方法、装置和车辆 - Google Patents

车辆定位方法、装置和车辆 Download PDF

Info

Publication number
CN113795769B
CN113795769B CN202080005449.0A CN202080005449A CN113795769B CN 113795769 B CN113795769 B CN 113795769B CN 202080005449 A CN202080005449 A CN 202080005449A CN 113795769 B CN113795769 B CN 113795769B
Authority
CN
China
Prior art keywords
road communication
coordinates
vehicle
circle
communication device
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
CN202080005449.0A
Other languages
English (en)
Other versions
CN113795769A (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.)
Suteng Innovation Technology Co Ltd
Original Assignee
Suteng Innovation 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 Suteng Innovation Technology Co Ltd filed Critical Suteng Innovation Technology Co Ltd
Publication of CN113795769A publication Critical patent/CN113795769A/zh
Application granted granted Critical
Publication of CN113795769B publication Critical patent/CN113795769B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S11/00Systems for determining distance or velocity not using reflection or reradiation
    • G01S11/02Systems for determining distance or velocity not using reflection or reradiation using radio waves
    • G01S11/06Systems for determining distance or velocity not using reflection or reradiation using radio waves using intensity measurements
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02Services making use of location information
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02DCLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
    • Y02D30/00Reducing energy consumption in communication networks
    • Y02D30/70Reducing energy consumption in communication networks in wireless communication networks

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Traffic Control Systems (AREA)

Abstract

一种车辆定位装置(104)、方法、计算机程序产品和车辆。通过检测车辆行驶的路边固定设置的道路通信装置(101,102,103)发射的信号的接收信号强度,基于接收信号强度确定车辆到至少三个道路通信装置(101,102,103)的距离,根据各道路通信装置(101,102,103)的坐标和计算的距离确定车辆的坐标,由于车辆和道路通信装置(101,102,103)之间没有障碍物遮挡,接收信号强度较大,解决相关技术中使用卫星定位带来的定位发生偏移的问题,因此可以提高车辆定位的精度。

Description

车辆定位方法、装置和车辆
技术领域
本申请涉及自动驾驶领域,尤其涉及一种车辆定位方法、装置和车辆。
背景技术
在自动驾驶领域,通常使用卫星定位系统对车辆进行定位,例如:GPS(GlobalPositioning System,全球卫星定位系统)、北斗卫星定位系统等对车辆进行定位,车辆通过接收卫星的定位测量信号对车辆进行定位,然后车辆被建筑物遮挡时(例如车辆进入涵洞或室内),车辆接收到的卫星信号会非常微弱,从而导致定位发生偏移,无法准确的对车辆进行定位。
发明内容
本申请实施例所要解决的技术问题在于,提供一种车辆定位方法、装置和车辆,解决卫星对车辆定位不准确的问题。
第一方面,本申请提供了一种车辆定位方法,包括:
获取n个道路通信装置各自发送的定位测量信号的接收信号强度;其中,n为大于或等于3的整数;
获取所述n个道路通信装置各自的坐标;
根据所述接收信号强度确定车辆到所述道路通信装置的距离;
根据所述车辆到所述n个道路通信装置各自的距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标。
在一种可能的设计中,所述获取n个道路通信装置各自发送的定位测量信号的接收信号强度,包括:
接收m个道路通信装置各自发送的定位测量信号;其中,m为大于n的整数;
测量m个定位测量信号各自的接收信号强度;
从m个道路通信装置中筛选出接收信号强度大于信号强度阈值的n个道路通信装置;
确定所述n个道路通信装置的接收信号强度。
在一种可能的设计中,所述接收m个道路通信装置各自发送的定位测量信号之前,还包括:
广播定位请求信号;其中,所述定位请求信号用于指示所述道路通信装置发送定位测量信号。
在一种可能的设计中,所述定位测量信号携带所述道路通信装置的坐标;
其中,所述获取所述n个道路通信装置各自的坐标,包括:
解析所述定位测量信号得到所述道路通信装置的坐标。
在一种可能的设计中,所述定位测量信号还携带所述道路通信装置的垂直高度;
其中,所述根据所述车辆到所述n个道路通信装置各自的距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标,包括:
根据所述垂直高度和所述距离计算所述车辆到所述道路通信装置的水平距离;
根据所述车辆到所述n个道路通信装置的水平距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标。
在一种可能的设计中,所述定位测量信号携带所述道路通信装置的设备标识;
其中,所述获取所述n个道路通信装置各自的坐标,包括:
解析所述定位测量信号得到所述道路通信装置的设备标识;
根据所述设备标识在服务器中查询对应的所述道路通信装置的坐标。
在一种可能的设计中,所述根据所述车辆到所述n个道路通信装置各自的距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标,包括:
根据所述设备标识在服务器中查询对应的所述道路通信装置的垂直高度;
根据所述垂直高度和所述距离计算所述车辆到所述道路通信装置的水平距离;
根据所述车辆到所述n个道路通信装置的水平距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标。
在一种可能的设计中,所述根据所述车辆到所述n个道路通信装置的水平距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标,包括:
确定至少三个候选点的坐标;其中,所述候选点是根据所述第一圆形和第二圆形得到,所述第一圆形的圆心坐标为第一道路通信装置的坐标,半径为所述车辆到所述第一道路通信装置的水平距离;所述第二圆形的圆心坐标为第二道路通信装置的坐标,半径为所述车辆到所述第二道路通信装置的水平距离;所述第一道路通信装置和所述第二道路通信装置属于所述n个道路通信装置;
根据所述至少三个候选点的坐标计算所述车辆的坐标。
在一种可能的设计中,根据所述至少三个候选点的坐标计算所述车辆的坐标包括:
根据至少三个候选点围成的多边形的质心坐标作为所述车辆的坐标;或
将所述至少三个候选点的坐标进行加权平均得到所述车辆的坐标。
第二方面,本申请提供了一种车辆定位装置,包括:
获取单元,用于获取n个道路通信装置各自发送的定位测量信号的接收信号强度;其中,n为大于或等于3的整数;
所述获取单元,还用于获取所述n个道路通信装置各自的坐标;
距离计算单元,用于根据所述接收信号强度确定车辆到所述道路通信装置的距离;
坐标计算单元,用于根据所述车辆到所述n个道路通信装置各自的距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标。
本申请的又一方面公开了一种基于车辆定位装置,距离补偿装置包括:接收器、发射器、存储器和处理器;其中,所述存储器中存储一组程序代码,且所述处理器用于调用所述存储器中存储的程序代码,执行上述各方面所述的车辆定位方法。
基于同一申请构思,由于该装置解决问题的原理以及有益效果可以参见上述各可能的距离补偿装置的方法实施方式以及所带来的有益效果,因此该装置的实施可以参见方法的实施,重复之处不再赘述。
本申请的又一方面提了供一种计算机可读存储介质,所述计算机可读存储介质中存储有指令,当其在计算机上运行时,使得计算机执行上述各方面所述的方法。
本申请的又一方面提供了一种包含指令的计算机程序产品,当其在计算机上运行时,使得计算机执行上述各方面所述的方法。
在本申请实施例中,检测车辆到至少三个车辆通信装置发射的定位测量信号的接收信号强度,根据接收信号强度确定车辆到各个车辆通信装置之间的距离,各个车辆通信装置固定设置于路边,因此各个道路通信装置的坐标是固定不变的,根据车辆到各个道路通信装置之间的距离和各个道路通信装置的坐标计算车辆的坐标,由此实现对车辆的实时定位,由于车辆和道路通信装置之间没有障碍物遮挡,接收信号强度较大,解决相关技术中使用卫星定位带来的定位发生偏移的问题,因此可以提高车辆定位的精度。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本申请实施例提供的车辆定位系统的架构示意图;
图2是本申请实施例提供的一种车辆定位方法的流程示意图;
图3-图8是本实施例提供的车辆定位的原理示意图;
图9是本申请实施例提供的一种基于车辆定位装置的结构示意图;
图10是本申请实施例提供的一种基于车辆定位装置的另一结构示意图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
在本申请的描述中,需要理解的是,术语“第一”、“第二”等仅用于描述目的,而不能理解为指示或暗示相对重要性。在本申请的描述中,需要说明的是,除非另有明确的规定和限定,“包括”和“具有”以及它们任何变形,意图在于覆盖不排他的包含。例如包含了一系列步骤或单元的过程、方法、系统、产品或设备没有限定于已列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可选地还包括对于这些过程、方法、产品或设备固有的其他步骤或单元。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本申请中的具体含义。此外,在本申请的描述中,除非另有说明,“多个”是指两个或两个以上。“和/或”,描述关联对象的关联关系,表示可以存在三种关系,例如,A和/或B,可以表示:单独存在A,同时存在A和B,单独存在B这三种情况。字符“/”一般表示前后关联对象是一种“或”的关系。
本申请实施例提供的车辆定位方法可依赖于计算机程序实现,可运行于基于冯诺依曼体系的车辆定位装置上。该计算机程序可集成在应用中,也可作为独立的工具类应用运行。
参见图1,为本申请实施例提供的车辆定位系统的结构示意图,车辆定位系统包括至少三个路边定位装置和车辆定位装置。如图1所示的车辆定位系统包括道路通信装置101、道路通信装置102、道路通信装置103和车辆定位装置104。道路通信装置可以设置在道路两侧也可以设置在道路的一侧,同时道路通信装置也可以距离地面一定高度,例如:道路通信装置设置于路边的路灯、测速仪或其他道路交通设备上。车辆定位装置设置于车辆上,随着车辆的移动而移动。道路通信装置和车辆定位装置之间采用无线方式进行通信,例如:使用蓝牙、WiFi、超宽频、zigbee等方式进行通信。
请参见图2,图2是本申请实施例提供的一种车辆定位方法,该方法包括但不限于如下步骤:
S201、获取n个道路通信装置各自发送的定位测量信号的接收信号强度。
其中,n为大于或等于3的整数,本申请实施例必须根据至少三个道路通信装置发送的定位测量信号来对车辆进行定位。各个道路通信装置可以周期性的以广播的方式发送定位测量信号,各个道路通信装置发送定位测量信号可以是同步的,即各个道路通信装置发送定位测量信号的起始时间和周期都是相同的。设置于车辆上的车辆定位装置接收到各个道路通信装置发送的定位测量信号。车辆定位装置测量来自n个道路通信装置的定位测量信号的接收信号强度(Received Signal Strength Indication,RSSI)。车辆定位装置与道路通信装置之间的距离和接收信号强度呈正相关性,距离越大则测量到的接收信号强度越小,距离越小则测量到的接收信号强度越大。定位测量信号为已知信号,车辆定位装置可以根据信号幅度、相位或周期等信号特征来识别接收到的信号是否为定位测量信号。
例如:参见图1所示,在需要对车辆进行定位时,此时车辆的周围分布有3个道路通信装置:道路通信装置101、道路通信装置102和道路通信装置103,3个道路通信装置周期性的向车辆定位装置104发送定位测量信号。在定位时刻t,车辆定位装置104测量来自道路通信装置101的定位测量信号的接收信号强度为-20分贝(DB),车辆定位装置测量来自道路通信装置102的定位测量信号的接收信号强度为-50分贝,车辆定位装置测量来自道路通信装置103的定位测量信号的接收信号强度为-35分贝。
在一种可能的实施方式中,所述获取n个道路通信装置各自发送的定位测量信号的接收信号强度,包括:
接收m个道路通信装置各自发送的定位测量信号;m为大于n的整数;
测量m个定位测量信号各自的接收信号强度;
从m个道路通信装置中筛选出接收信号强度大于信号强度阈值的n个道路通信装置;
确定所述n个道路通信装置的接收信号强度。
其中,在车辆定位装置存在m个道路通信装置时,车辆定位装置接收m个道路通信装置各自发送的定位测量信号,车辆定位装置测量m个定位测量信号的接收信号强度;车辆定位装置预存储或预配置有信号强度阈值,车辆定位装置在m个定位测量信号中筛选出n个接收信号强度大于信号强度阈值的n个道路通信装置,确定筛选出的n个道路通信装置的接收信号强度。通过信号强度阈值筛选出n个定位测量信号的接收信号强度,使用距离近的道路通信装置进行定位,可以提高定位的精度。
例如:车辆定位装置在定位时刻t接收到5个道路通信装置的定位测量信号,检测到5个道路通信装置的定位测量信号的接收信号强度分布如下:道路通信装置1的接收信号强度为-35dB,道路通信装置2的接收信号强度为-40dB,道路通信装置3的接收信号强度为-45dB,道路通信装置4的接收信号强度为-70dB,道路通信装置5的接收信号强度为-60dB。假设信号强度阈值为-50dB,那么车辆定位装置从上述5个道路通信装置中筛选出的大于信号强度阈值的道路通信装置为:道路通信装置1、道路通信装置2和道路通信装置3。
S202、获取所述n个道路通信装置各自的坐标。
其中,道路通信装置的坐标表示道路通信装置的位置,坐标可以是经纬度坐标或平面直角坐标系中的坐标。由于各个道路通信装置固定设置于路边,各个道路通信装置的位置是已知的,坐标可以是道路通信装置根据内置的定位模块获取的或者由测试人员预先配置的给道路通信装置,本申请实施例不作限制。各个道路通信装置在路边的分布位置本申请实施例不作限制,例如:可以等间隔的分布在道路两侧,也可以只设置于道路的一侧。
例如:根据图1所示,车辆定位装置获取到道路通信装置101的坐标为(x1,y1),道路通信装置102的坐标为(x2,y2),道路通信装置103的坐标为(x3,y3)。
在一种可能的实施中,获取n个道路通信装置的坐标的方法包括:
定位测量信号中携带道路通信装置的坐标,车辆定位装置解析道路通信装置发送的定位测量信号,解析成功后得到道路通信装置的坐标。
例如:道路通信装置101发送的定位测量信号中携带道路通信装置101的坐标(x1,y1),道路通信装置102发送的定位测量信号携带道路通信装置102的坐标(x2,y2),道路通信装置103发送的定位测量信号携带道路通信装置103的坐标。
在另一种可能的实施方式中,获取n个道路通信装置的坐标的方法包括:
定位测量信号中携带道路通信装置的设备标识,设备标识用于唯一表示道路通信装置的身份,设备标识可以是MAC(Media Access Control,媒体访问控制)地址,车辆定位装置根据设备标识在本地或服务器上查询道路通信装置的坐标,服务器或本地存储有设备标识和道路通信装置之间的映射关系。
例如:道路通信装置101发送的定位测量信号中携带道路通信装置101的设备标识:MAC1,车辆定位装置解析定位测量信号得到MAC1,然后在部署在互联网的服务器中查询MAC1对应的道路通信装置101坐标为(x1,y1);道路通信装置102发送的定位测量信号中携带的道路通信装置102的设备标识:MAC2,车辆定位装置解析该定位测量信号得到MAC2,然后在部署在互联网的服务器中查询MAC2对应的道路通信装置2的坐标为(x2,y2);道路通信装置103发送的定位测量信号中携带道路通信装置103的设备标识:MAC3,车辆定位装置解析该定位测量信号得到MAC3,然后在部署在互联网中的服务器中查询MAC3对应的道路通信装置103的坐标(x3,y3)。
S203、根据所述接收信号强度确定车辆到道路通信装置的距离;
其中,接收信号强度和距离呈反相关性,接收信号强度越大则车辆到道路通信装置之间的距离越近,接收信号强度越小则车辆到道路通信装置之间的距离越远。车辆定位装置可以根据预配置的拟合函数确定接收信号强度对应的距离,拟合函数是预先根据已知的多组样本数据(距离和接收信号强度)进行拟合得到的,拟合方法可以是最小二乘法。
例如:根据图1所示,车辆定位装置根据来自道路通信装置101的定位测量信号的接收信号强度,确定到道路通信装置101之间的距离为r1;车辆定位装置根据来自道路通信装置102的定位测量信号的接收信号强度,确定到道路通信装置102之间的距离为r2;车辆定位装置根据来自道路通信装置103的定位测量信号的接收信号强度,确定到道路通信装置103之间的距离为r3。
S204、根据车辆到所述n个道路通信装置各自的距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标。
其中,在各个道路通信装置距离地面的垂直高度小于或等于高度阈值时(例如:5cm),将S203计算得到的距离近似等于车辆到道路通信装置的水平距离。在道路通信装置距离地面的垂直高度大于高度阈值时,例如:道路通信装置设置在路灯的顶端,那么S203计算到的距离实际为车辆到道路通信装置的斜边距离,由于道路通信装置的垂直高度是已知量且固定不变,根据勾股定理可以计算出车辆到道路通信装置的水平距离。
其中,车辆定位装置获取道路通信装置的垂直高度的方法可以是:定位测量信号中携带道路通信装置的垂直高度,车辆定位装置解析接收到的定位测量信号后得到道路通信装置的垂直高度;或定位测量信号中携带道路通信装置的设备标识,车辆定位装置根据设备标识在本地或服务器查询对应的垂直高度,本地或服务器中预存储有设备标识和垂直高度之间的映射关系。
在本实施例中,对于n个道路通信装置来说,以道路通信装置的坐标为圆心坐标,车辆到道路通信装置的水平距离为半径进行画圆,会得到n个圆形,在理想状态下,上述得到的n个圆形会存在一个共同的交点,即多个圆形相交于一点,那么该交点的坐标即为车辆的坐标。
举例来说,道路通信装置101的坐标A1(x1,y1),车辆到道路通信装置101的水平距离为R1;道路通信装置102的坐标为A2(x2,y2),车辆到道路通信装置102的水平距离为R2;道路通信装置103的坐标为A3(x3,y3),车辆到道路通信装置103的水平距离为R3。以A1为圆心,R1为半径画圆形成圆形1;以A2为圆心,R2为半径画圆形成圆形2;以A3为圆心,R3为半径画圆形成圆形3。圆形1、圆形2和圆形3存在一个共同的交点B点,很容易根据三个圆形的半径和圆心的坐标计算得到B点的坐标,B点的坐标即为车辆的坐标。
在实际应用场景中,车辆定位测量装置测量到的水平距离可能存在误差,那么n个圆形可能不存在一个共同的交点,n个圆形中的任意两个圆形来说,两个圆形存在相交和不相交两种情况。例如:参见图4所示,n=3,3个圆形两两相交,但是不存在共同的交点,圆形1和圆形2之间存在两个交点(C点和D点),圆形1和圆形3之间存在两个交点(A点和E点),圆形2和圆形3之间存在两个交点(B点和F点),圆形1、圆形2和圆形3之间无法只交于一点。参见图5所示,n=3,3个圆形中任意两个圆形均不相交,圆形1、圆形2和圆形3之间均不存在交点。
在本申请实施例中,以道路通信装置的坐标为圆心,车辆到道路通信装置的水平距离为半径画圆,那么会得到n个圆形,对于n个圆形中的任意两个圆形来说,计算两个圆形对应的候选点的坐标,最终选取的候选点的数量大于或等于3个。
其中,计算候选点的坐标包括:参见图6,在两个圆形相交时,圆形1的圆心为A1,圆形2的圆心为A2,圆形1和圆形2的交点为A点和B点,线段A1A2和线段AB的交点C即为候选点,根据圆形的对称性质,可以得知线段A1A2垂直于线段AB,且线段AC的长度和线段CB的长度相等,假设圆心A1的坐标为(x1,y1),圆心A2的坐标为(x2,y2),圆形1的半径为R1,圆形2的半径为R2,那么线段A1A的长度为R1,线段A2A的长度为R2,可以计算得到A点坐标为(x3,y3),B点坐标为(x4,y4),并进一步得到候选点C的x轴坐标(经度坐标)为:(x3+x4)/2,候选点C的y轴坐标(纬度坐标)为:(y3+y4)/2,其中,A1C表示线段A1C的长度,A1A2表示线段A1A2的长度。根据图6的计算至少三个候选点的坐标。
参见图7所示,在两个圆形不相交时,计算两个圆形对应的候选点包括:圆形1的圆心为A1,圆形2的圆心为A2点,圆形1的半径为R1,圆形2的半径为R2,两个圆形不相交,假设圆心A1的坐标为(x1,y1),圆心A2的坐标为(x2,y2)。圆心A1与A2的距离为D。圆形1和圆形2对应的候选点为O点,那么候选点O的x轴坐标(经度坐标)为:候选点O的y轴坐标(纬度坐标)为:
其中,根据图6和图7的方法获得至少三个获选点的坐标之后,根据三个候选点的坐标确定车辆的坐标,确定至少三个候选点围成的多边形的质心的坐标,将该质心的坐标作为车辆的坐标或将至少三个候选点的坐标进行加权平均得到车辆的坐标。
举例来说,参见图8所示,A1点为圆形1的圆心,A1点为圆形2的圆心,A3点为圆形3的圆心,A4点为圆形4的坐标,B1点为圆形1和圆形2对应的候选点,B2点为圆形2和圆形4对应的候选点,B3点为圆形3和圆形4对应的候选点,候选点B1、候选点B2和候选点B3围成一个三角形B1B2B3,加上候选点B1的坐标为(a1,b1),候选点B2的坐标为(a2,b2),候选点B3的坐标为(a3,b3),那么确定三角形B1B2B3的质心的坐标为或者将候选点B1、候选点B2和候选点B3的坐标进行加权平均后也可以得到车辆的坐标为
根据图2的描述,检测车辆到至少三个车辆通信装置发射的定位测量信号的接收信号强度,根据接收信号强度确定车辆到各个车辆通信装置之间的距离,各个车辆通信装置固定设置于路边,因此各个道路通信装置的坐标是固定不变的,根据车辆到各个道路通信装置之间的距离和各个道路通信装置的坐标计算车辆的坐标,由此实现对车辆的实时定位,由于车辆和道路通信装置之间没有障碍物遮挡,接收信号强度较大,解决相关技术中使用卫星定位带来的定位发生偏移的问题,因此可以提高车辆定位的精度。
上述详细阐述了本申请实施例的一种车辆定位方法,下面提供了本申请实施例的一种车辆定位装置(以下简称装置3)。
图9所示的装置3可以实现图2所示实施例的车辆定位方法,装置3包括获取单元301、距离计算单元302和坐标计算单元303。
获取单元301,用于获取n个道路通信装置各自发送的定位测量信号的接收信号强度;其中,n为大于或等于3的整数;
所述获取单元301,还用于获取所述n个道路通信装置各自的坐标;
距离计算单元302,用于根据所述接收信号强度确定车辆到所述道路通信装置的距离;
坐标计算单元303,用于根据所述车辆到所述n个道路通信装置各自的距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标。
可选的,所述获取n个道路通信装置各自发送的定位测量信号的接收信号强度,包括:
接收m个道路通信装置各自发送的定位测量信号;其中,m为大于n的整数;
测量m个定位测量信号各自的接收信号强度;
从m个道路通信装置中筛选出接收信号强度大于信号强度阈值的n个道路通信装置;
确定所述n个道路通信装置的接收信号强度。
可选的,装置3还包括:
广播单元,用于广播定位请求信号;其中,所述定位请求信号用于指示所述道路通信装置发送定位测量信号。
可选的,所述定位测量信号携带所述道路通信装置的坐标;
其中,所述获取所述n个道路通信装置各自的坐标,包括:
解析所述定位测量信号得到所述道路通信装置的坐标。
可选的,所述定位测量信号还携带所述道路通信装置的垂直高度;
其中,所述根据所述车辆到所述n个道路通信装置各自的距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标,包括:
根据所述垂直高度和所述距离计算所述车辆到所述道路通信装置的水平距离;
根据所述车辆到所述n个道路通信装置的水平距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标。
可选的,所述定位测量信号携带所述道路通信装置的设备标识;
其中,所述获取所述n个道路通信装置各自的坐标,包括:
解析所述定位测量信号得到所述道路通信装置的设备标识;
根据所述设备标识在服务器中查询对应的所述道路通信装置的坐标。
可选的,所述根据所述车辆到所述n个道路通信装置各自的距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标,包括:
根据所述设备标识在服务器中查询对应的所述道路通信装置的垂直高度;
根据所述垂直高度和所述距离计算所述车辆到所述道路通信装置的水平距离;
根据所述车辆到所述n个道路通信装置的水平距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标。
可选的,所述根据所述车辆到所述n个道路通信装置的水平距离和所述n个道路通信装置各自的坐标计算所述车辆的坐标,包括:
确定至少三个候选点的坐标;其中,所述候选点是根据所述第一圆形和第二圆形得到,所述第一圆形的圆心坐标为第一道路通信装置的坐标,半径为所述车辆到所述第一道路通信装置的水平距离;所述第二圆形的圆心坐标为第二道路通信装置的坐标,半径为所述车辆到所述第二道路通信装置的水平距离;所述第一道路通信装置和所述第二道路通信装置属于所述n个道路通信装置;
根据所述至少三个候选点的坐标计算所述车辆的坐标。
可选的,根据所述至少三个候选点的坐标计算所述车辆的坐标包括:
根据至少三个候选点围成的多边形的质心坐标作为所述车辆的坐标;或
将所述至少三个候选点的坐标进行加权平均得到所述车辆的坐标。
本申请实施例和图1~图8的方法实施例基于同一构思,其带来的技术效果也相同,具体过程可参照图1~图8的方法实施例的描述,此处不再赘述。
所述装置3可以为实现相关功能的现场可编程门阵列(field-programmablegate array,FPGA),专用集成芯片,系统芯片(system on chip,SoC),中央处理器(centralprocessor unit,CPU),网络处理器(network processor,NP),数字信号处理电路,微控制器(micro controller unit,MCU),还可以采用可编程控制器(programmable logicdevice,PLD)或其他集成芯片。
上述详细阐述了本申请实施例的一种车辆定位方法,下面提供了本申请实施例的一种基于车辆定位装置(以下简称装置4)。
图10为本申请实施例提供的一种装置结构示意图,以下简称装置4,装置4可以集成于车辆等交通工具中,如图4所示,该装置包括:存储器402、处理器401、发射器404以及接收器403。
存储器402可以是独立的物理单元,与处理器401、发射器404以及接收器403可以通过总线连接。存储器402、处理器401、发射器404以及接收器401也可以集成在一起,通过硬件实现等。
发射器404用于发射信号,例如:以广播的方式发射定位请求信号。接收器403可以为CMOS接收器,用于接收信号,例如:接收定位测量信号。
存储器402用于存储实现以上方法实施例,或者装置实施例各个模块的程序,处理器401调用该程序,执行以上方法实施例的操作。
可选地,当上述实施例的车辆定位方法中的部分或全部通过软件实现时,装置也可以只包括处理器。用于存储程序的存储器位于装置之外,处理器通过电路/电线与存储器连接,用于读取并执行存储器中存储的程序。
处理器可以是中央处理器(central processing unit,CPU),网络处理器(network processor,NP)或者CPU和NP的组合。
处理器还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(application-specific integrated circuit,ASIC),可编程逻辑器件(programmablelogic device,PLD)或其组合。上述PLD可以是复杂可编程逻辑器件(complexprogrammable logic device,CPLD),现场可编程逻辑门阵列(field-programmable gatearray,FPGA),通用阵列逻辑(generic array logic,GAL)或其任意组合。
存储器可以包括易失性存储器(volatile memory),例如随机存取存储器(random-access memory,RAM);存储器也可以包括非易失性存储器(non-volatilememory),例如快闪存储器(flash memory),硬盘(hard disk drive,HDD)或固态硬盘(solid-state drive,SSD);存储器还可以包括上述种类的存储器的组合。
上述实施例中,发送单元或发射器执行上述各个方法实施例发送的步骤,接收单元或接收器执行上述各个方法实施例接收的步骤,其它步骤由其他单元或处理器执行。发送单元和接收单元可以组成收发单元,接收器和发射器可以组成收发器。
本申请实施例还提供了一种计算机存储介质,存储有计算机程序,该计算机程序用于执行上述实施例提供的车辆定位方法。
本申请实施例还提供了一种包含指令的计算机程序产品,当其在计算机上运行时,使得计算机执行上述实施例提供的车辆定位方法。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。

Claims (12)

1.一种车辆定位方法,其特征在于,包括:
获取n个道路通信装置各自发送的定位测量信号的接收信号强度;其中,n为大于或等于3的整数;
获取所述n个道路通信装置各自的坐标;
根据所述接收信号强度确定车辆到所述道路通信装置的距离;
获取所述道路通信装置的垂直高度;
在所述垂直高度小于或等于高度阈值时,将所述车辆到所述道路通信装置的距离作为所述车辆到所述道路通信装置的水平距离,或者,在所述垂直高度大于所述高度阈值时,
根据所述道路通信装置的垂直高度、所述距离和勾股定理计算所述车辆到所述道路通信装置的水平距离;
确定至少三个候选点的坐标;所述候选点是根据第一圆形和第二圆形得到,所述第一圆形的圆心坐标为第一道路通信装置的坐标,半径为所述车辆到所述第一道路通信装置的水平距离;所述第二圆形的圆心坐标为第二道路通信装置的坐标,半径为所述车辆到所述第二道路通信装置的水平距离;所述第一道路通信装置和所述第二道路通信装置属于所述n个道路通信装置;
其中,当所述第一圆形和第二圆形相交时,所述候选点为第一连线和第二连线之间的交点,所述第一连线为所述第一圆形和第二圆形相交的交点之间的连线,所述第二连线为所述第一圆形的圆心坐标与所述第二圆形的圆心坐标之间的连线;当所述第一圆形和第二圆形不相交时,所述候选点的x轴坐标和y轴坐标分别如下:
所述第一圆形的圆心坐标为(x1,y1),所述第二圆形的圆心坐标为(x2,y2),所述第一圆形的圆心与所述第二圆形的圆心之间的距离为D,所述第一圆形的半径为R1,所述第二圆形的半径为R2;
根据所述至少三个候选点的坐标计算所述车辆的坐标。
2.根据权利要求1所述的方法,其特征在于,所述获取n个道路通信装置各自发送的定位测量信号的接收信号强度,包括:
接收m个道路通信装置各自发送的定位测量信号;其中,m为大于n的整数;
测量m个定位测量信号各自的接收信号强度;
从m个道路通信装置中筛选出接收信号强度大于信号强度阈值的n个道路通信装置;
确定所述n个道路通信装置的接收信号强度。
3.根据权利要求1所述的方法,其特征在于,所述接收m个道路通信装置各自发送的定位测量信号之前,还包括:
广播定位请求信号;其中,所述定位请求信号用于指示所述道路通信装置发送定位测量信号。
4.根据权利要求1所述的方法,其特征在于,所述定位测量信号携带所述道路通信装置的坐标;
其中,所述获取所述n个道路通信装置各自的坐标,包括:
解析所述定位测量信号得到所述道路通信装置的坐标。
5.根据权利要求4所述的方法,其特征在于,所述定位测量信号还携带所述道路通信装置的垂直高度。
6.根据权利要求1所述的方法,其特征在于,所述定位测量信号携带所述道路通信装置的设备标识;
其中,所述获取所述n个道路通信装置各自的坐标,包括:
解析所述定位测量信号得到所述道路通信装置的设备标识;
根据所述设备标识在服务器中查询对应的所述道路通信装置的坐标。
7.根据权利要求6所述的方法,其特征在于,所述获取所述道路通信装置的垂直高度,包括:
根据所述设备标识在服务器中查询对应的所述道路通信装置的垂直高度。
8.根据权利要求1所述的方法,其特征在于,根据所述至少三个候选点的坐标计算所述车辆的坐标包括:
根据至少三个候选点围成的多边形的质心坐标作为所述车辆的坐标;或
将所述至少三个候选点的坐标进行加权平均得到所述车辆的坐标。
9.一种车辆定位装置,其特征在于,包括:
获取单元,用于获取n个道路通信装置各自发送的定位测量信号的接收信号强度;其中,n为大于或等于3的整数;
所述获取单元,还用于获取所述n个道路通信装置各自的坐标;
距离计算单元,用于根据所述接收信号强度确定车辆到所述道路通信装置的距离;
坐标计算单元,用于获取所述道路通信装置的垂直高度;在所述垂直高度小于或等于高度阈值时,将所述车辆到所述道路通信装置的距离作为所述车辆到所述道路通信装置的水平距离,或者,在所述垂直高度大于所述高度阈值时,根据所述道路通信装置的垂直高度、所述距离和勾股定理计算所述车辆到所述道路通信装置的水平距离;确定至少三个候选点的坐标;所述候选点是根据第一圆形和第二圆形得到,所述第一圆形的圆心坐标为第一道路通信装置的坐标,半径为所述车辆到所述第一道路通信装置的水平距离;所述第二圆形的圆心坐标为第二道路通信装置的坐标,半径为所述车辆到所述第二道路通信装置的水平距离;所述第一道路通信装置和所述第二道路通信装置属于所述n个道路通信装置;其中,当所述第一圆形和第二圆形相交时,所述候选点为第一连线和第二连线之间的交点,所述第一连线为所述第一圆形和第二圆形相交的交点之间的连线,所述第二连线为所述第一圆形的圆心坐标与所述第二圆形的圆心坐标之间的连线;当所述第一圆形和第二圆形不相交时,所述候选点的x轴坐标和y轴坐标分别如下:
所述第一圆形的圆心坐标为(x1,y1),所述第二圆形的圆心坐标为(x2,y2),所述第一圆形的圆心与所述第二圆形的圆心之间的距离为D,所述第一圆形的半径为R1,所述第二圆形的半径为R2;
根据所述至少三个候选点的坐标计算所述车辆的坐标。
10.一种计算机程序产品,其特征在于,所述计算机程序产品包括指令,当所述计算机程序产品在计算机上运行时,使得计算机执行如权利要求1至8任意一项所述的方法。
11.一种车辆定位装置,其特征在于,包括处理器、存储器、发射器和接收器,所述处理器与所述发射器和接收器耦合,存储器用于存储计算机程序或指令,所述处理器用于执行所述存储器中的计算机程序或指令,以控制所述接收器和所述发射器收发信号;当所述处理器执行所述计算机程序或指令时,所述处理器还用于实现如权利要求1至8任意一项所述的方法。
12.一种车辆,其特征在于,包括如权利要求9或11所述的车辆定位装置。
CN202080005449.0A 2020-03-27 2020-03-27 车辆定位方法、装置和车辆 Active CN113795769B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/081819 WO2021189464A1 (zh) 2020-03-27 2020-03-27 车辆定位方法、装置和车辆

Publications (2)

Publication Number Publication Date
CN113795769A CN113795769A (zh) 2021-12-14
CN113795769B true CN113795769B (zh) 2023-08-04

Family

ID=77891492

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202080005449.0A Active CN113795769B (zh) 2020-03-27 2020-03-27 车辆定位方法、装置和车辆

Country Status (2)

Country Link
CN (1) CN113795769B (zh)
WO (1) WO2021189464A1 (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113815649B (zh) * 2021-10-29 2023-05-23 上海洛轲智能科技有限公司 避障系统、避障方法、电子设备及介质
CN114697895A (zh) * 2022-03-28 2022-07-01 中国工商银行股份有限公司 车辆室内定位方法、系统、装置和计算机设备
CN116761255B (zh) * 2023-08-17 2023-12-15 湖北香溢数字科技有限公司 一种车辆定位方法及装置

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015016406A1 (ko) * 2013-08-01 2015-02-05 자동차부품연구원 차량용 절대측위 보정 시스템 및 방법
CN105472563A (zh) * 2014-09-29 2016-04-06 黄大卫 一种精确导航定位方法、装置
CN106646573A (zh) * 2016-12-23 2017-05-10 烟台中飞海装科技有限公司 用于市区内人员定位的定位方法及定位发送设备
CN106781605A (zh) * 2016-12-20 2017-05-31 国网山东省电力公司东明县供电公司 机械车辆gps卫星预定位装置与方法
CN108061876A (zh) * 2017-11-15 2018-05-22 阿里巴巴集团控股有限公司 一种车辆定位方法和装置
WO2019014824A1 (zh) * 2017-07-18 2019-01-24 深圳市大疆创新科技有限公司 定位方法、无人机和机器可读存储介质
CN109509342A (zh) * 2018-12-13 2019-03-22 成都三柚科技有限公司 一种车辆停车方法、装置、电子设备及存储介质
CN111417068A (zh) * 2020-03-26 2020-07-14 深圳市微测检测有限公司 车辆辅助导航定位方法、装置、设备及可读存储介质

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101634700A (zh) * 2009-08-25 2010-01-27 杭州华三通信技术有限公司 无线网络中终端的定位方法和装置
US20160260328A1 (en) * 2015-03-06 2016-09-08 Qualcomm Incorporated Real-time Occupancy Mapping System for Autonomous Vehicles
CN105554878B (zh) * 2015-12-11 2020-09-22 深圳市金溢科技股份有限公司 停车管理方法、车载蓝牙标签、基站及系统
WO2018209586A1 (zh) * 2017-05-17 2018-11-22 深圳市炜光科技有限公司 蓝牙的定位方法及系统
CN109348409B (zh) * 2018-11-07 2021-08-17 京东数字科技控股有限公司 定位处理方法、装置、智能硬件设备以及存储介质

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015016406A1 (ko) * 2013-08-01 2015-02-05 자동차부품연구원 차량용 절대측위 보정 시스템 및 방법
CN105472563A (zh) * 2014-09-29 2016-04-06 黄大卫 一种精确导航定位方法、装置
CN106781605A (zh) * 2016-12-20 2017-05-31 国网山东省电力公司东明县供电公司 机械车辆gps卫星预定位装置与方法
CN106646573A (zh) * 2016-12-23 2017-05-10 烟台中飞海装科技有限公司 用于市区内人员定位的定位方法及定位发送设备
WO2019014824A1 (zh) * 2017-07-18 2019-01-24 深圳市大疆创新科技有限公司 定位方法、无人机和机器可读存储介质
CN108061876A (zh) * 2017-11-15 2018-05-22 阿里巴巴集团控股有限公司 一种车辆定位方法和装置
CN109509342A (zh) * 2018-12-13 2019-03-22 成都三柚科技有限公司 一种车辆停车方法、装置、电子设备及存储介质
CN111417068A (zh) * 2020-03-26 2020-07-14 深圳市微测检测有限公司 车辆辅助导航定位方法、装置、设备及可读存储介质

Also Published As

Publication number Publication date
CN113795769A (zh) 2021-12-14
WO2021189464A1 (zh) 2021-09-30

Similar Documents

Publication Publication Date Title
CN113795769B (zh) 车辆定位方法、装置和车辆
US8369872B2 (en) Method and device for determination of the position of a terminal in a mobile communication network
US10094671B2 (en) Position measurement method, own position measurement device, and on-board unit
US8378891B2 (en) Method and system for optimizing quality and integrity of location database elements
EP4336864A1 (en) Vehicle-road cooperative positioning method and apparatus, vehicle-mounted positioning system, and roadside unit
WO2012158463A1 (en) Wi-fi access point characteristics database
EP3672310A1 (en) Identifying potentially manipulated radio signals and/or radio signal parameters based on radio map information
US8634846B2 (en) Method and system for determining a location of a mobile device based on a plurality of location samples
CN110839208B (zh) 用于校正多路径偏移和确定无线站点位置的方法及装置
CN106028280A (zh) 一种定位方法、装置和儿童手表
JP2015219089A (ja) 無線測位装置、無線測位用地図データベース
CN113126044A (zh) 雷达标定方法、装置及设备
CN113411743B (zh) 一种终端定位方法、装置及终端
CN105635958B (zh) 一种定位数据采集方法和装置
CN110411499B (zh) 传感器检测识别能力的评估方法及评估系统
CN115866751B (zh) 基于固定信标和室内地图的定位方法及装置
EP3650881A1 (en) Reconfiguration of a radio positioning support system
EP3961263A1 (en) Proximity-based navigation method
CN113993069B (zh) 一种室内定位方法及装置、电子设备
KR101058098B1 (ko) 다른 단말기의 위치정보 및 그 위치정보의 신뢰도에 따라 자신의 위치를 측정하는 단말기 및 시스템 그리고 그 위치 측정 방법
CN103983947A (zh) 一种基于超声波的无线定位系统及方法
WO2017220643A1 (en) Indoor radio map verification
CN114660633A (zh) 智能网联汽车定向性能测试方法、装置及系统
TWI642962B (zh) 整合無線接收訊號強度和磁場特徵之室內定位系統
CN112684409A (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