CN114928881B - 基于超宽带和视觉智能装置的协同定位系统及定位方法 - Google Patents
基于超宽带和视觉智能装置的协同定位系统及定位方法 Download PDFInfo
- Publication number
- CN114928881B CN114928881B CN202210405191.4A CN202210405191A CN114928881B CN 114928881 B CN114928881 B CN 114928881B CN 202210405191 A CN202210405191 A CN 202210405191A CN 114928881 B CN114928881 B CN 114928881B
- Authority
- CN
- China
- Prior art keywords
- vector
- global navigation
- navigation satellite
- location
- intelligent
- 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
Links
- 230000000007 visual effect Effects 0.000 title claims abstract description 46
- 238000000034 method Methods 0.000 title claims abstract description 25
- 230000003068 static effect Effects 0.000 claims abstract description 12
- 239000013598 vector Substances 0.000 claims description 68
- 238000005259 measurement Methods 0.000 claims description 39
- 238000004422 calculation algorithm Methods 0.000 claims description 34
- 239000011159 matrix material Substances 0.000 claims description 25
- 238000001914 filtration Methods 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000007547 defect Effects 0.000 abstract description 2
- 238000000691 measurement method Methods 0.000 abstract description 2
- 238000012360 testing method Methods 0.000 abstract description 2
- 102100021198 Chemerin-like receptor 2 Human genes 0.000 description 3
- 101000750094 Homo sapiens Chemerin-like receptor 2 Proteins 0.000 description 3
- 238000013459 approach Methods 0.000 description 3
- 239000013256 coordination polymer Substances 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 239000000969 carrier Substances 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012634 optical imaging Methods 0.000 description 1
- 238000013215 result calculation Methods 0.000 description 1
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
- H04W64/003—Locating users or terminals or network equipment for network management purposes, e.g. mobility management locating network equipment
-
- 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)
- Signal Processing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种基于超宽带装置和视觉智能装置的协同定位系统及定位方法，基于全球导航卫星系统、超宽带和计算机视觉的智能装置协同定位，并考虑M2I方法只在超宽带静态锚的密集网络覆盖的区域有效，在大面积安装这种基础设施非常昂贵。为了研究减少这种密集的M2I超宽带基础设施需求的可能性，采用了M2M测量方法。测试结果表明，基于超宽带的M2M测距方法能够在亚米级的精度水平上可靠地评估可移动锚点的相对距离，特别是在锚点距离非常近的情况下。该协同定位系统能够在单一平台上集成传感器来弥补全球导航定位系统在可用性、可靠性以及受威胁性等方面的不足，同时，协同定位在多平台之间进行数据共享，为定位提供了进一步的性能改进。
Description
技术领域
本发明涉及一种定位技术，特别涉及一种基于超宽带和视觉智能装置的协同定位系统及定位方法。
背景技术
全球导航卫星系统(Global Navigation Satellite Systems，GNSS)在部分遮蔽的环境和室内中进行定位是一项挑战，因为在这些环境中，仅靠GNSS的接收器无法提供精确度与鲁棒性水平都高的定位解决方案。因此，GNSS需要与基于新方法的传感器集成与融合以提升定位系统的性能。
协同导航(Cooperative Positioning，CP)代表了传感器集成概念的下一个推广层次，传统上是指将在一个平台上获得的所有传感器数据流集成在一起。协同导航提供了一个框架来集成由多个平台获取的传感器数据，这些平台通常相互靠近，有效CP的两个要求是节点间通信和测距的可用性。CP技术对于在群体或网络中导航的平台的定位非常有用，在定位精确度和可靠性方面取得了显著的性能改进。
如果无法得到协同平台的精确导航信息，或者获取的相对导航精度下降，则会导致控制精度变差，任务执行效果也会下降甚至出现错误，因此，单一传感器导航已经难以满足现代化作战环境下的任务需求。最近的技术发展已经为实验性协同导航实现提供了必要的传感器和通信能力，本发明使用基于超宽带的测距技术，并探索将其与光学成像相结合的潜力，实现基于超宽带和智能装置的协同定位算法。这些传感器很容易获取并通过其他应用进行测试，使系统设计能够将关注重点放在协同导航计算和性能方面。
发明内容
针对精确定位和移动定位问题，提出了一种基于超宽带和视觉智能装置的协同定位系统及定位方法，提供一个合作性的、鲁棒的、无处不在的移动平台定位解决方案，可部署在智能装置上实现可移动目标的主动侦测。
本发明的技术方案为：一种基于超宽带和视觉智能装置的协同定位系统及定位方法，在定位区域根据条件设置实时测图系统GPSVan，在每个GPSVan上部署2个TD UWB装置、2个Pozyx装置、全球导航卫星系统接收器GNSS以及录像设备，所述2个TD UWB装置为TD M2I和TD M2M，2个Pozyx装置为Pozyx-L和Pozyx-R，全球导航卫星系统接收器GNSS以及录像设备，在定位区域内的智能装置中配置一个全球导航卫星系统接收器GNSS、一个TD M2M和两个Pozyx装置；
所述TD M2I用于测量其所在GPSVan与定位区域内其他GPSVan的静态目标I的距离；
所述TD M2M用于测量该GPSVan与其他部署了协同定位算法的智能装置之间的距离；
作为TD M2M冗余的所述Pozyx-L和Pozyx-R同时测量其所在GPSVan和其他部署了协同定位算法的智能装置之间的距离；
所述每个GPSVan上录像设备，获取静态图像和动态视频数据，与TD UWB装置配合追踪其他部署了协同定位算法的智能装置相对于自身的位置和角度数据，产生移动数据。
一种基于超宽带和视觉智能装置的协同定位系统的定位方法，利用扩展的卡尔曼滤波算法，计算联合全球导航卫星系统、TD M2I、TD M2M和Pozyx向量表示以及视觉向量表示作为状态矩阵，利用状态矩阵获得每个时刻的观测矩阵，进行定位区域内智能设备目标协同定位，估计目标所处的位置。
进一步，所述全球导航卫星系统向量表示：利全球导航卫星系统用全球导航卫星系统/GPS进行位置测度，第i个部署协同定位算法的智能装置的平台的位置定义为安装在该平台上的全球导航卫星系统接收器的位置，然后使用扩展的费尔曼滤波器计算全球导航卫星系统的状态向量，每个全球导航卫星系统状态向量由所有安装全球导航卫星系统接收器的位置状态向量组成。
进一步，所述TD M2I向量表示：利用TD M2I无线电装置进行范围测度，假设所有静态目标均可进行M2I测量，并假设以某一时间为中心的短时间间隔内速度恒定，使用扩展的费尔曼滤波器得到M2I向量表示，每个M2I距离向量为所有可用TD M2I超宽带无线电装置的距离向量组成。
进一步，所述TD M2M向量表示：假设所有部署了协同定位算法的智能装置均可进行M2M测量，进行范围测度，并假设以某一时间为中心的短时间间隔内速度恒定，使用扩展的费尔曼滤波器得到M2M向量表示，每个M2M距离向量为所有可用TD M2M超宽带无线电装置的距离向量组成。
进一步，所述根据权利要求2所述基于超宽带和视觉智能装置的协同定位系统的定位方法，其特征在于，所述视觉向量表示：设在某一时刻提供的视觉测量值为自身与其他部署了协同定位算法的智能装置的平台在该时刻的相对位置，将录像设备中的视觉信息提取出来，视觉向量表示为所有可用的视觉信息的组合。
进一步，所述观测矩阵计算方法：装载定位装置的可移动GPSVan和智能设备内导入协同定位算法，均构成自身定位平台，GPSVan和智能设备使用EKF获得可靠的状态估计，然后，第i个部署协同定位算法的智能装置的位置定义为安装在该平台上的全球导航卫星系统接收器的位置，对于GPSVan其位置定义为全球导航卫星系统天线的位置；
令和/>分别表示第i个部署平台在t时刻的位置和速度，令xk表示tk时刻的联合状态向量，/>为对应第i个部署平台的状态部分，xk定义为：
动态模型用于表示xk和xk+1之间的关系：
xk+1＝Fkxk+ωk
其中：
其中：F′k为单个部署平台的转移矩阵，定义为：
I为单位矩阵，
观测向量zk由全球导航卫星系统测距向量M2I向量/>M2M向量和视觉信息向量/>组成：
其中zk为第k次测量时锚点所采集的范围值，由于锚点是按顺序检查的，所以范围值在不同的时间被采集到，设与xk相关的时间tk等于/>和Δtk＝tk-tk-1的平均值，令/>
测量模型可以表示为：
zk＝hk(xk)+δk
其中观测矩阵为：
利用计算出的和/>得到hk(xk)，假设所有可用的测量值，/>计算线性化对应的项/>通过一个单独的程序来完成的，用/>近似代替/>
其中，是/>给定时刻tk-1时的状态值时的预测值，/>时GPSVan和第j个M2I定位点之间的预测距离；
令为/>给定时刻tk-1时的状态值，/>是时刻/>在平台i和i'之间距离测量的时间瞬间得到的预测距离，/>计算线性化对应的项
最后，在平台方向可得的假设下，和/>简单地记为其中/>是第i个部署平台在时刻的预测值。
本发明的有益效果在于：本发明基于超宽带装置和视觉智能装置的协同定位系统及定位方法，在定位区域内，有任意一载具接收到全球导航卫星定位情况下，实现所有载具绝对定位，在没有全球导航卫星定位的情况下，实现载具个体相对定位。对于协同定位M2I超宽带结构可以有效地实现亚米级的二维定位精度。然而，由于M2I方法只在超宽带静态锚的密集网络覆盖的区域有效，在大面积安装这种基础设施可能非常昂贵。为了研究减少这种密集的M2I超宽带基础设施需求的可能性，采用了M2M测量方法。测试结果表明，基于超宽带的M2M测距方法能够在亚米级的精度水平上可靠地评估可移动锚点的相对距离，特别是在锚点距离非常近的情况下。该协同定位系统能够在单一平台上集成传感器来弥补全球导航定位系统在可用性、可靠性以及受威胁性等方面的不足，同时，协同定位在多平台之间进行数据共享，为定位提供了进一步的性能改进。
附图说明
图1为本发明基于超宽带装置和视觉智能装置进行协同定位示意图；
图2为本发明传感器设置示意图。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。本实施例以本发明技术方案为前提进行实施，给出了详细的实施方式和具体的操作过程，但本发明的保护范围不限于下述的实施例。
超宽带和计算机视觉将协同辅助给基于全球导航卫星系统的导航模块来处理问题。具体来说，超宽带可以作为小区域的独立定位解决方案，提供亚米级精度的定位数据，但它在大范围内的独立可用性需要使用大型基础设施，因为超宽带测量的成功率会随着设备之间的距离迅速降低。此时，视觉数据可以提供角度等不同类型的信息，可以辅助全球导航卫星系统在相当远的距离中进行定位，因此，它与超宽带的结合将减少所需的超宽带基础设施的规模并提高整体定位结果。
如图1与图2所示协同定位示意图和传感器设置示意图，TD1和TD2表示两个TD UWB(超宽带)装置，Pozyx1和Pozyx2表示两个Pozyx UWB装置，GNSS表示全球导航卫星系统接收器，GPR1表示录像设备。在定位区域内每个装载定位装置的定位点作为一个锚点，在每个GPSVan上部署2个TD UWB装置、2个Pozyx装置、前后各安装一个全球导航卫星系统接收器GNSS以及录像设备GPR1。在智能装置中配置一个全球导航卫星系统接收器GNSS、一个TDM2M和两个Pozyx装置。
所述定位装置为超宽带装置、视觉智能装置、全球导航卫星系统接收器的统称，装载定位装置的可移动设备内导入协同定位算法，均构成自身定位平台。
基于超宽带装置和视觉智能装置的协同定位方法，具体实现步骤如下：
1、准备超宽带无线电装置：TimeDomain(TD)和Pozyx。
在每个GPSVan(实时测图系统)上部署2个TD UWB装置和2个Pozyx装置，其中，2个TD UWB装置为TD M2I(移动多媒体互连器件TD1)和TD M2M(Machine-To-Machine机器对机器TD2)，2个Pozyx装置(超宽带技术和传感器融合的精确室内定位装置)为Pozyx-L和Pozyx-R。
TD M2I用于测量其所在GPSVan与其他GPSVan的静态目标I的距离，TD M2M用于测量其所在GPSVan与其他部署了协同定位算法的智能装置之间的距离。Pozyx-L和Pozyx-R也用于测量其所在GPSVan和其他部署了协同定位算法的智能装置之间的距离。TD M2M、Pozyx-L、Pozyx-R三组装置均起到M2M测量(相对测距)的作用，作为结构冗余设计，在算法中用作平均结果计算，降低误差。
2、安装录像设备：
在每个GPSVan利用录像设备GPR1，获取静态图像和动态视频数据，用于追踪其他部署了协同定位算法的智能装置相对于自身的位置和角度数据，以辅助GNSS在相当远的距离中进行定位。本文公式中上标vis为视觉定位。
3、安装GNSS接收器：
在每个GPSVan与部署了协同定位算法的智能装置的平台上安装全球导航卫星系统接收器GNSS作为主要的定位装置。
4、GNSS测距：
利用全球导航卫星系统/GPS进行位置测度，第i个部署了协同定位算法的智能装置的平台的位置定义为安装在该平台上的全球导航卫星系统接收器的位置，然后使用扩展的费尔曼滤波器计算全球导航卫星系统的状态向量，每个全球导航卫星系统状态向量由所有安装全球导航卫星系统接收器的位置状态向量组成。本文公式中上标GNSS为全球导航卫星系统位置测度。
具体来说,当GPS/全球导航卫星系统可用时，与GPS/全球导航卫星系统位置测度相关联，假设全球导航卫星系统在所有部署平台上可用，则：
其中，I为单位矩阵，0为零向量。为了简化描述，公式中假设带定位装置共4个个体，从c1到c4。上标c指带定位装置的移动设备，为c1在时刻k的状态向量。
当全球导航卫星系统测度在tk时刻在平台i上不可用，则去掉上述矩阵的第i行。
5、M2I测距：
利用TD M2I无线电装置进行范围测度，假设所有静态目标均可进行M2I测量，并假设以某一时间为中心的短时间间隔内速度恒定，使用扩展的费尔曼滤波器可以得到M2I向量表示，每个M2I距离向量为所有可用TD M2I超宽带无线电装置的距离向量组成。
具体来说，假设M2I测度在所有锚点上可用，且在以tk为中心的很短的时间间隔里速度恒定，为：
其中是带有第j个锚点的部署平台在测度时间范围内的位置：
其中，p代表位置，△p代表相对位置，v代表速度，h代表状态矩阵，tk和δk均代表时刻，并且同一组测量中的时刻，u下标T表示对应移动设备的头部朝向方向，u下标H上标表示对应移动设备的的切向方向。
6、M2M测距：
根据每个部署了协同定位算法的智能装置的平台上的M2M UWB设备：TD M2M和2个Pozyx装置，进行范围测度，假设所有部署了协同定位算法的智能装置均可进行M2M测量，并假设以某一时间为中心的短时间间隔内速度恒定，使用扩展的费尔曼滤波器可以得到M2M向量表示，每个M2M距离向量为所有可用TDM2M超宽带无线电装置的距离向量组成。得到M2M向量表示。
指的是M2M的范围测度，为了符号简洁，假设只有一个M2M UWB设备绑定在每个智能装置上，设/>为其相对于该移动设备上全球导航卫星系统接收机的位移，令/>为平台i和i'之间距离测量的时间瞬间，则：
其中，假设M2M测度在所有锚点之间可用，且在以tk为中心的很短的时间间隔里速度恒定，表示M2M UWB设备在第i个平台上在时刻/>关于全球导航卫星系统接收器的位置：
当范围测度在平台i和i'之间不可用，则去掉上述矩阵的第i行。
7、视觉信息获取：
设在某一时刻提供的视觉测量值为自身与其他部署了协同定位算法的智能装置的平台在该时刻的相对位置，将录像设备中的视觉信息提取出来，视觉向量表示为所有可用的视觉信息的组合。
当视觉信息可用时，假设其与UWB集成在一起。令视觉信息在时刻被提供，令/>为该时刻部署平台相对于GPSVan的相对位置，然后，当在一帧中检测到所有的部署平台时:
当视觉信息在tk时刻在平台i上不可用，则去掉上述矩阵的第i行。
8、计算观测矩阵：
利用扩展的卡尔曼滤波算法，计算联合了全球导航卫星系统、TD M2I\TD M2M和Pozyx向量表示以及视觉数据的状态矩阵，每种状态向量由所有可用的状态向量组成。
假设tk与一个可能的全球导航卫星系统测量时间瞬间相一致，Δtk＝0.2s。在协同定位方法中，状态向量是通过将所有被考虑的智能装置的状态向量(假设有4个)连接起来形成的。为了不失去一般性，下面将假设仅使用四个智能装置来表示方程。
使用EKF来获得可靠的状态估计，然后，第i个部署了协同定位算法的智能装置的位置定义为安装在该平台上的全球导航卫星系统接收器的位置。对于GPSVan，其位置定义为全球导航卫星系统天线的位置。
令和/>分别表示第i个部署平台在t时刻的位置和速度，令xk表示tk时刻的联合状态向量，/>为对应第i个部署平台的状态部分，xk定义为：
下述动态模型用于表示xk和xk+1之间的关系：
xk+1＝Fkxk+ωk
其中：
其中：F′k为单个部署平台的转移矩阵，定义为：
观测向量zk由全球导航卫星系统测距向量、M2I向量、M2M向量和视觉信息向量组成：
其中zk为第k次测量时锚点所采集的范围值。由于锚点是按顺序检查的，所以范围值在不同的时间被采集到。设与xk相关的时间tk等于/>和Δtk＝tk-tk-1的平均值，令/>
测量模型可以表示为：
zk＝hk(xk)+δk
其中观测矩阵为：
利用计算出的和/>得到hk(xk)，为简便起见，假设所有可用的测量值，线性化后的观测矩阵Hk可表示为：
其中，和/>的计算线性化对应的项/>和/>他们的估计被假定是通过一个单独的程序来完成的，独立于这里提出的定位方法。因此，可以用/>近似代替/>
其中，是/>给定时刻tk-1时的状态值时的预测值，/>时GPSVan和第j个M2I锚点之间的预测距离。
然后，令为/>给定时刻tk-1时的状态值，/>是时刻/>在平台i和i'之间距离测量的时间瞬间得到的预测距离。
最后，在平台方向可得的假设下，和/>可以简单地记为其中/>是第i个部署平台在时刻的预测值。
9、实现协同定位：
根据每个时刻的观测矩阵对其他部署了协同定位算法的智能装置进行协同定位，估计目标所处的位置。
以上所述实施例仅表达了本发明的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。因此，本发明专利的保护范围应以所附权利要求为准。
Claims (5)
1.一种基于超宽带和视觉智能装置的协同定位系统，其特征在于，在定位区域根据条件设置实时测图系统GPSVan，在每个GPSVan上部署2个TD UWB装置、2个Pozyx装置、全球导航卫星系统接收器GNSS以及录像设备，所述2个TD UWB装置为TD M2I和TD M2M，2个Pozyx装置为Pozyx-L和Pozyx-R，全球导航卫星系统接收器GNSS以及录像设备，在定位区域内的智能装置中配置一个全球导航卫星系统接收器GNSS、一个TD M2M和两个Pozyx装置；
所述TD M2I用于测量其所在GPSVan与定位区域内其他GPSVan的静态目标I的距离；
所述TD M2M用于测量该GPSVan与其他部署了协同定位算法的智能装置之间的距离；
作为TD M2M冗余的所述Pozyx-L和Pozyx-R同时测量其所在GPSVan和其他部署了协同定位算法的智能装置之间的距离；
所述每个GPSVan上录像设备，获取静态图像和动态视频数据，与TD UWB装置配合追踪其他部署了协同定位算法的智能装置相对于自身的位置和角度数据，产生移动数据；
利用扩展的卡尔曼滤波算法，计算联合全球导航卫星系统、TD M2I、TD M2M和Pozyx向量表示以及视觉向量表示作为状态矩阵，利用状态矩阵获得每个时刻的观测矩阵，进行定位区域内智能设备目标协同定位，估计目标所处的位置；
所述观测矩阵计算方法：装载定位装置的可移动GPSVan和智能设备内导入协同定位算法，均构成自身定位平台，GPSVan和智能设备使用EKF获得可靠的状态估计，然后，第i个部署协同定位算法的智能装置的位置定义为安装在该平台上的全球导航卫星系统接收器的位置，对于GPSVan其位置定义为全球导航卫星系统天线的位置；
令和/>分别表示第i个部署平台在t时刻的位置和速度，令xk表示tk时刻的联合状态向量，/>为对应第i个部署平台的状态部分，xk定义为：
动态模型用于表示xk和xk+1之间的关系：
xk+1＝Fkxk+ωk
其中：
其中：F′k为单个部署平台的转移矩阵，定义为：
I为单位矩阵，
观测向量zk由全球导航卫星系统测距向量M2I向量/>M2M向量/>和视觉信息向量/>组成：
其中zk为第k次测量时锚点所采集的范围值，由于锚点是按顺序检查的，所以范围值在不同的时间被采集到，设与xk相关的时间tk等于/>和Vtk＝tk-tk-1的平均值，令/>测量模型可以表示为：
zk＝hk(xk)+δk
其中观测矩阵为：
利用计算出的和/>得到hk(xk)，假设所有可用的测量值，/>计算线性化对应的项/>通过一个单独的程序来完成的，用近似代替/>
其中，是/>给定时刻tk-1时的状态值时的预测值，/>时GPSVan和第j个M2I定位点之间的预测距离；
令为/>给定时刻tk-1时的状态值，/>是时刻/>在平台i和i'之间距离测量的时间瞬间得到的预测距离，/>计算线性化对应的项/>
最后，在平台方向可得的假设下，和/>简单地记为其中/>是第i个部署平台在时刻的预测值。
2.根据权利要求1所述基于超宽带和视觉智能装置的协同定位系统的定位方法，其特征在于，所述全球导航卫星系统向量表示：利全球导航卫星系统用全球导航卫星系统/GPS进行位置测度，第i个部署协同定位算法的智能装置的平台的位置定义为安装在该平台上的全球导航卫星系统接收器的位置，然后使用扩展的费尔曼滤波器计算全球导航卫星系统的状态向量，每个全球导航卫星系统状态向量由所有安装全球导航卫星系统接收器的位置状态向量组成。
3.根据权利要求1所述基于超宽带和视觉智能装置的协同定位系统的定位方法，其特征在于，所述TD M2I向量表示：利用TD M2I无线电装置进行范围测度，假设所有静态目标均可进行M2I测量，并假设以某一时间为中心的短时间间隔内速度恒定，使用扩展的费尔曼滤波器得到M2I向量表示，每个M2I距离向量为所有可用TD M2I超宽带无线电装置的距离向量组成。
4.根据权利要求1所述基于超宽带和视觉智能装置的协同定位系统的定位方法，其特征在于，所述TD M2M向量表示：假设所有部署了协同定位算法的智能装置均可进行M2M测量，进行范围测度，并假设以某一时间为中心的短时间间隔内速度恒定，使用扩展的费尔曼滤波器得到M2M向量表示，每个M2M距离向量为所有可用TD M2M超宽带无线电装置的距离向量组成。
5.根据权利要求1所述基于超宽带和视觉智能装置的协同定位系统的定位方法，其特征在于，所述视觉向量表示：设在某一时刻提供的视觉测量值为自身与其他部署了协同定位算法的智能装置的平台在该时刻的相对位置，将录像设备中的视觉信息提取出来，视觉向量表示为所有可用的视觉信息的组合。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210405191.4A CN114928881B (zh) | 2022-04-18 | 2022-04-18 | 基于超宽带和视觉智能装置的协同定位系统及定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210405191.4A CN114928881B (zh) | 2022-04-18 | 2022-04-18 | 基于超宽带和视觉智能装置的协同定位系统及定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114928881A CN114928881A (zh) | 2022-08-19 |
| CN114928881B true CN114928881B (zh) | 2024-05-14 |
Family
ID=82807398
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202210405191.4A Active CN114928881B (zh) | 2022-04-18 | 2022-04-18 | 基于超宽带和视觉智能装置的协同定位系统及定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114928881B (zh) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100819392B1 (ko) * | 2006-12-29 | 2008-04-04 | (재)대구경북과학기술연구원 | Ｇｐｓ 및 ｕｗｂ 연동 측위 시스템 및 방법 |
| CN107300385A (zh) * | 2017-08-25 | 2017-10-27 | 上海瀚界科技发展有限公司 | 基于uwb测距的惯导定位系统 |
| CN109946730A (zh) * | 2019-03-06 | 2019-06-28 | 东南大学 | 一种车路协同下基于超宽带的车辆高可靠融合定位方法 |
| CN110793519A (zh) * | 2019-11-26 | 2020-02-14 | 河南工业大学 | 一种不完全测量的协同导航定位方法 |
| CN112068173A (zh) * | 2020-08-09 | 2020-12-11 | 河南工业大学 | 一种基于环路和积数据关联算法的协同导航方法 |
| CN113433576A (zh) * | 2021-06-28 | 2021-09-24 | 中国科学院国家授时中心 | 一种gnss与v-slam融合定位方法及系统 |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9235212B2 (en) * | 2012-05-01 | 2016-01-12 | 5D Robotics, Inc. | Conflict resolution based on object behavioral determination and collaborative relative positioning |
| EP4127773A1 (en) * | 2020-03-30 | 2023-02-08 | Wiser Systems, Inc. | Integrated camera and ultra- wideband location devices and related systems |
-
2022
- 2022-04-18 CN CN202210405191.4A patent/CN114928881B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100819392B1 (ko) * | 2006-12-29 | 2008-04-04 | (재)대구경북과학기술연구원 | Ｇｐｓ 및 ｕｗｂ 연동 측위 시스템 및 방법 |
| CN107300385A (zh) * | 2017-08-25 | 2017-10-27 | 上海瀚界科技发展有限公司 | 基于uwb测距的惯导定位系统 |
| CN109946730A (zh) * | 2019-03-06 | 2019-06-28 | 东南大学 | 一种车路协同下基于超宽带的车辆高可靠融合定位方法 |
| CN110793519A (zh) * | 2019-11-26 | 2020-02-14 | 河南工业大学 | 一种不完全测量的协同导航定位方法 |
| CN112068173A (zh) * | 2020-08-09 | 2020-12-11 | 河南工业大学 | 一种基于环路和积数据关联算法的协同导航方法 |
| CN113433576A (zh) * | 2021-06-28 | 2021-09-24 | 中国科学院国家授时中心 | 一种gnss与v-slam融合定位方法及系统 |
Non-Patent Citations (4)
| Title |
|---|
| Collaborative Multiple UAVs Navigation With GPS/INS/UWB Jammers Using Sigma Point Belief Propagation;Hongmei Chen;《IEEE Access》;20201021;全文 * |
| Impact of channel access on localization in cooperative UWB sensor network: A case study;Alberto Savioli;《2012 9th Workshop on Positioning, Navigation and Communication》;20120316;全文 * |
| 基于BDS/UWB的协同车辆定位方法;徐爱功;曹楠;隋心;王长强;高嵩;;测绘科学;20200615(06);全文 * |
| 基于UWB的室内协同定位方法;郭少彬;沈锋;杨莹;;电子信息对抗技术;20180715(04);全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114928881A (zh) | 2022-08-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US20150241560A1 (en) | Apparatus and method for providing traffic control service | |
| WO2015048397A1 (en) | Off-target tracking using feature aiding in the context of inertial navigation | |
| US10928834B2 (en) | Autonomous vehicle localization using 5G infrastructure | |
| CN105973268B (zh) | 一种基于共基座安装的传递对准精度定量评估方法 | |
| CN110081881A (zh) | 一种基于无人机多传感器信息融合技术的着舰引导方法 | |
| EP3403116B1 (en) | Method for calibrating a local positioning system based on time-difference-of-arrival measurements | |
| CN110361692A (zh) | 一种融合定位方法及装置 | |
| Mostafa et al. | A novel GPS/RAVO/MEMS-INS smartphone-sensor-integrated method to enhance USV navigation systems during GPS outages | |
| Helgesen et al. | Real-time georeferencing of thermal images using small fixed-wing UAVs in maritime environments | |
| WO2018066754A1 (ko) | 라이다 센서를 이용한 차량의 자세 추정 방법 | |
| CN110441769A (zh) | 基于sar序贯图像的目标定位方法、装置及存储介质 | |
| CN110657808A (zh) | 一种机载光电吊舱有源目标定位方法及系统 | |
| US9817099B2 (en) | System and method for precision collaborative targeting | |
| CN112540345B (zh) | 一种基于高斯分布检测uwb质量的双模型定位方法及系统 | |
| CN102128618B (zh) | 主动式动态定位方法 | |
| CN114928881B (zh) | 基于超宽带和视觉智能装置的协同定位系统及定位方法 | |
| JP2021143861A (ja) | 情報処理装置、情報処理方法及び情報処理システム | |
| CN114705223A (zh) | 多移动智能体在目标跟踪中的惯导误差补偿方法及系统 | |
| US10830906B2 (en) | Method of adaptive weighting adjustment positioning | |
| Zhu et al. | CamDist: Camera based distance estimation with a smartphone | |
| Hrabar et al. | PTZ camera pose estimation by tracking a 3D target | |
| Kealy et al. | Collaborative navigation field trials with different sensor platforms | |
| CN115294204B (zh) | 一种户外目标定位方法及系统 | |
| EP4166989A1 (en) | Methods and systems for determining a position and an acceleration of a vehicle | |
| CN116358600A (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 |