CN115494450A - 一种高精度的超宽带室内定位跟踪与控制方法及装置 - Google Patents
一种高精度的超宽带室内定位跟踪与控制方法及装置 Download PDFInfo
- Publication number
- CN115494450A CN115494450A CN202211437273.3A CN202211437273A CN115494450A CN 115494450 A CN115494450 A CN 115494450A CN 202211437273 A CN202211437273 A CN 202211437273A CN 115494450 A CN115494450 A CN 115494450A
- Authority
- CN
- China
- Prior art keywords
- target
- current
- estimation
- precision
- population
- 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 38
- 238000013507 mapping Methods 0.000 claims abstract description 22
- 230000003044 adaptive effect Effects 0.000 claims abstract description 12
- 238000004422 calculation algorithm Methods 0.000 claims description 27
- 239000011159 matrix material Substances 0.000 claims description 24
- 238000005457 optimization Methods 0.000 claims description 17
- 241000287127 Passeridae Species 0.000 claims description 14
- 239000013598 vector Substances 0.000 claims description 13
- 238000011161 development Methods 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 10
- 238000010845 search algorithm Methods 0.000 claims description 7
- 238000011156 evaluation Methods 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 4
- 230000006978 adaptation Effects 0.000 claims description 2
- 230000008569 process Effects 0.000 description 8
- 230000006870 function Effects 0.000 description 5
- 238000005259 measurement Methods 0.000 description 5
- 238000004458 analytical method Methods 0.000 description 4
- 230000000750 progressive effect Effects 0.000 description 3
- 230000007704 transition Effects 0.000 description 3
- 230000000739 chaotic effect Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 241000287196 Asthenes Species 0.000 description 1
- 241000282461 Canis lupus Species 0.000 description 1
- 241000283153 Cetacea Species 0.000 description 1
- 101150096839 Fcmr gene Proteins 0.000 description 1
- 238000007476 Maximum Likelihood Methods 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000005295 random walk Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000012163 sequencing technique Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/04—Position of source determined by a plurality of spaced direction-finders
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0205—Details
- G01S5/021—Calibration, monitoring or correction
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0205—Details
- G01S5/0221—Receivers
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0294—Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03H—IMPEDANCE NETWORKS, e.g. RESONANT CIRCUITS; RESONATORS
- H03H17/00—Networks using digital techniques
- H03H17/02—Frequency selective networks
- H03H17/0248—Filters characterised by a particular frequency response or filtering method
- H03H17/0255—Filters based on statistics
- H03H17/0257—KALMAN filters
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/33—Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
-
- 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/006—Locating users or terminals or network equipment for network management purposes, e.g. mobility management with additional information processing, e.g. for direction or speed determination
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE 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/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Remote Sensing (AREA)
- Pure & Applied Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Computational Mathematics (AREA)
- Theoretical Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Databases & Information Systems (AREA)
- Algebra (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Operations Research (AREA)
- Probability & Statistics with Applications (AREA)
- Computer Hardware Design (AREA)
- Computing Systems (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供一种高精度的超宽带室内定位跟踪与控制方法及装置,包括:获取目标当前粗估计位置;根据目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度;若目标当前估计精度满足系统要求,则完成估计上报,若目标当前估计精度不满足系统要求,根据目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群;计算目标适应值确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求。本发明提供的高精度的超宽带室内定位跟踪与控制方法及装置,通过对目标当前粗估计位置进行优化,提升了定位跟踪结果的有效性与可靠性。
Description
技术领域
本发明涉及超宽带技术领域,特别是涉及一种高精度的超宽带室内定位跟踪与控制方法及装置。
背景技术
超宽带(UltraWideband,UWB)技术因其功耗低、安全性高、系统复杂度低和定位精度高的特点,目前已经成为一种室内定位领域的热门研究方案。类似全球定位系统(GlobalPositioning System,GPS)定位之于室外定位,UWB定位系统的真实精度也与信号质量及信道条件息息相关。特别的,UWB信号对视线传输(Line of Sight,LOS)与非视线传输(NotLine of Sight,NLOS)传播十分敏感,NLOS误差对定位精度产生的负面影响往往是系统与用户无法容忍的。
普遍地,在UWB定位系统中无论具体采取到达时间(Time of Arrival,TOA)、到达时间差(Time Difference of Arrival,TDOA)、到达角(Angle of Arrival,AOA)中何种解决方案,均可在通过解析类算法计算出目标位置的初始估计后,而后利用迭代类算法进一步提升初始估计精度。上述方案的前提是UWB定位系统能够获取相对稳定而持续有效的观测值,一旦某基站持续上报NLOS观测值或频繁进出LOS与NLOS观测状态,则解析与迭代类算法性能将受到极大影响或者得到无效解。然而在真实室内环境中,无法避免的存在大量遮挡与复杂的多径状况,并且此类物理遮挡与多径效应还具有时变性,这也意味着UWB基站难以始终保持理想LOS测量状态,先验信道环境估计结果也无法长期作为参考。如何在非理想条件下维持或者提升对目标位置、运动状态的有效估计同样值得关注。
因此,有必要提供一种高精度的超宽带室内定位跟踪与控制方法及装置,以有效解决上述问题。
发明内容
本发明提供一种高精度的超宽带室内定位跟踪与控制方法及装置,通过对目标当前粗估计位置进行优化,提升了定位跟踪结果的有效性与可靠性。
本发明实施例提供一种高精度的超宽带室内定位跟踪与控制方法,包括:
获取目标当前粗估计位置;
根据所述目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度;
评价目标当前估计精度,若所述目标当前估计精度满足系统要求,则完成估计上报,若所述目标当前估计精度不满足系统要求,则对所述目标当前粗估计位置进行优化;
根据所述目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群;
计算目标适应值以确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求。
优选地,所述评价目标当前估计精度包括当接收信号能量与测距信息置信度低于第一阈值时,则所述目标当前估计精度不满足系统要求。
优选地,所述评价目标当前估计精度包括当所述目标当前粗估计位置和目标前时刻粗估计位置的欧氏距离大于第二阈值时或当所述目标当前粗估计位置和目标前时段所在轨迹的马氏距离大于第三阈值时,则所述目标当前估计精度不满足系统要求。
优选地,所述欧氏距离经旋转缩放后得到所述马氏距离,所述马氏距离具体通过以下公式进行计算:
因变换后各维度间线性无关,各维度方差即为自身特征值,从而有:
优选地,当所述目标当前估计瞬时速度大于第四阈值时,则所述目标当前估计精度不满足系统要求。
优选地,所述根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群包括使用麻雀搜索算法,具体通过以下公式进行计算:
优选地,所述计算目标适应值确定最优位置和最差位置具体通过以下公式进行计算:
优选地,所述根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群包括使用哈里斯鹰优化算法,所述哈里斯鹰优化算法包括探索阶段和开发阶段,所述探索阶段具体通过以下公式进行计算:
优选地,所述开发阶段具体通过以下公式进行计算:
本发明实施例还提供一种高精度的超宽带室内定位跟踪与控制装置,包括:
当前粗估计位置获取模块,其用于获取目标当前粗估计位置;
当前估计瞬时速度计算模块,其用于根据所述目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度;
当前估计精度评价模块,其用于评价目标当前估计精度,若所述目标当前估计精度满足系统要求,则完成估计上报,若所述目标当前估计精度不满足系统要求,则对所述目标当前粗估计位置进行优化;
当前粗估计位置优化模块,其用于根据所述目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群;
最优位置和最差位置计算模块,其用于计算目标适应值确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求。
与现有技术相比,本发明实施例的技术方案具有以下有益效果:
本发明实施例提供的一种高精度的超宽带室内定位跟踪与控制方法及装置,获取目标当前粗估计位置;根据所述目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度;评价目标当前估计精度,若所述目标当前估计精度满足系统要求,则完成估计上报,若所述目标当前估计精度不满足系统要求,则对所述目标当前粗估计位置进行优化;根据所述目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群;计算目标适应值以确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求,通过对目标当前粗估计位置进行优化,提升了定位跟踪结果的有效性与可靠性;
进一步地,通过使用麻雀搜索算法或哈里斯鹰优化算法,在应用层面上提升了超宽带定位系统的稳定性与可行性,且设计巧妙,计算简单,市场前景广阔。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图做一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,而不是全部实施例。对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明的一个实施例提供的一种高精度的超宽带室内定位跟踪与控制方法的流程示意图;
图2为本发明的一个实施例提供的一种高精度的超宽带室内定位跟踪与控制装置的模块示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
下面以具体的实施例对本发明的技术方案进行详细说明。下面这几个具体的实施例可以相互结合,对于相同或相似的概念或过程可能在某些实施例不再赘述。
基于现有技术存在的问题,本发明实施例提供一种高精度的超宽带室内定位跟踪与控制方法及装置,通过对目标当前粗估计位置进行优化,提升了定位跟踪结果的有效性与可靠性。
图1为本发明的一个实施例提供的一种高精度的超宽带室内定位跟踪与控制方法的流程示意图,请参看图1,提供一种高精度的超宽带室内定位跟踪与控制方法,包括:
步骤S101:获取目标当前粗估计位置。
在具体实施中,各UWB基站按定位方案需求完成空间分布、上电启动、时钟同步等准备过程。
依据IEEE 802.10.4协议与实际定位方案,各UWB基站开始与标签进行对应测距过程:如TOA定位方案则执行DS-TWR测距过程;TDOA方案则按UpTDOA或者DownloadTDOA需求执行标准测距过程;如基站支持多天线,则在测距同时进行UWB信号相位差测量、转化为信号入射角并完成上报。同时,上报帧中所包含的信号质量、测距(角)信息置信度与系统刷新率等信息将对后续步骤的控制与计算起到一定的辅助和支撑作用。
解析算法器进行目标位置粗估计,通过卡尔曼滤波器消除UWB上报测距(角)信息中的部分高斯噪声,并使用解析类方法求出目标位置粗估计,卡尔曼滤波器系统方程基本一致,观测方程与粗估计解析形式一般受实际定位方案不同而有所不同。
对常见的室内定位系统,考虑如下非线性离散时间系统模型:
该模型下卡尔曼滤波器满足如下更新方程:
时间更新过程:
观测更新过程:
以二维定位场景为例,已知个参考基站坐标为,对于低速弱机动待测目标,可认为目标在采样周期内进行平面匀速直线运动,系统状态向量为关于时间的包含位置、速度信息的矢量,则系统状态转移函数满足,故系统状态转移矩阵:
不同的定位方案分别具有观测方程如下:
对上述观测方程均可利用TS-WLS算法进行解析解的计算。
首先可由LS估计理论,得到关于待测目标位置的最小二乘解作为下一步估计的初始值:
从而可以得到TS-WLS的最终解为:
步骤S102:根据所述目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度。
步骤S103:评价目标当前估计精度,若所述目标当前估计精度满足系统要求,则完成估计上报,若所述目标当前估计精度不满足系统要求,则对所述目标当前粗估计位置进行优化。
在具体实施中,所述评价目标当前估计精度包括当接收信号能量与测距信息置信度低于第一阈值时,则所述目标当前估计精度不满足系统要求。本领域技术人员可以根据系统需要设置第一阈值,在此不再赘述。具体地,考虑UWB基站上报信道环境优劣、接收信号强度(Received Signal Strength,RSS)与品质因数(Figureof Merit,FoM),如果存在某一基站信道环境明显改变或者RSS与FoM显著降低,均可认为此基站与标签测量环境发生变化,当前时刻上报测距值中含有非高斯的噪声分量,即使在解析算法器中使用卡尔曼滤波器与TS-WLS算法降低了部分异常测距引入的额外定位误差,但此时对目标的位置粗估计结果仍不足以直接作为准确结果进行输出。
在具体实施中,所述评价目标当前估计精度包括当所述目标当前粗估计位置和目标前时刻粗估计位置的欧氏距离(Euclidean Distance)大于第二阈值时或当所述目标当前粗估计位置和目标前时段所在轨迹的马氏距离(Mahalanobis Distance)大于第三阈值时,则所述目标当前估计精度不满足系统要求。本领域技术人员可以根据系统需要设置第二阈值和第三阈值,在此不再赘述。具体地,基于对目标运动状态的先验信息,对此估计的质量加以分析并输出评价结果。结合系统刷新率和目标基本运动属性,可通过目标当前时刻粗估计与前时刻所在位置欧氏距离、目标当前时刻粗估计与前时段所在轨迹的马氏距离以及目标当前时刻的瞬时速度三个维度进行分析与评判,若存在位置抖动过大、轨迹偏差较多或者瞬时速度超出理论极限速度均可认为粗估计质量低。
在具体实施中,当所述目标当前估计瞬时速度大于第四阈值时,则所述目标当前估计精度不满足系统要求。本领域技术人员可以根据系统需要设置第四阈值,在此不再赘述。
在具体实施中,所述欧氏距离经旋转缩放后得到所述马氏距离,所述马氏距离具体通过以下公式进行计算:
引入马氏距离的意义是消除不同坐标维度上信息的相关性,以更准确地检测出离群点,从而有效评估粗估计的质量。
步骤S104:根据所述目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群。
步骤S105:计算目标适应值以确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求。
在具体实施中,针对观测信息不稳定或者长期质量较差的情况,可以使用确定所需引入改进群智能算法,包括但不限于粒子群优化算法(Particle Swarm Optimization,PSO)、灰狼优化算法(Grey Wolf Optimizer,GWO)、鲸鱼优化算法(Whale OptimizationAlgorithm,WOA)、哈里斯鹰优化算法(Harris Hawks Optimization,HHO)、麻雀搜索算法(Sparrow Search Algorithm,SSA)及上述优化的改进算法进行实施。
考虑由种群,则种群状态可表示为如下形式:
在具体实施中,所述根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群包括使用麻雀搜索算法,首先初始化麻雀种群,计算个体的适应度值并排序,找到最佳和最差适应度的个体,依次更新发现者、加入者、警戒者位置,不断迭代更新,直至满足算法终止条件算法终止。在SSA中,具有较好适应度值的发现者约占种群数量的10%~20%,在每次迭代过程中,发现者的位置更新描述如下:
在每次迭代过程中,发现者之外均视为加入者,所述计算目标适应值确定最优位置和最差位置具体通过以下公式进行计算:
修改上式如下:
此外,种群中还存在侦察预警的麻雀,一般占到种群数量的10%~20%,侦察者随机产生,其位置更新描述如下:
其改进方法主要有引入Logistic映射、Tent映射、Cubic映射等以增强初始种群随机性从而提升求解精度;引入反向学习策略、高斯变异、柯西变异等加快收敛速度,并提升算法鲁棒性;引入Lévy飞行机制或强化飞行机制以提升求解精度;以及引入自适应因子等等其他方向。
在具体实施中,所述根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群包括使用哈里斯鹰优化算法,所述哈里斯鹰优化算法包括探索阶段和开发阶段,所述探索阶段具体通过以下公式进行计算:
在具体实施中,所述开发阶段具体通过以下公式进行计算:
开发阶段更新公式包括软、硬包围与渐进软、硬包围。
其中,软包围更新公式为:
硬包围更新公式为:
渐进软包围更新公式为:
渐进硬包围更新公式为:
HHO算法的大致流程为:初始化种群,将适应度最优的个体设置为猎物,根据逃逸能量和生成的随机数执行全局搜索或局部开发中对应的包围策略。计算每个个体的适应度并与猎物适应度比较,若位置更新后的个体适应度值优于猎物,则以适应度值更优的个体位置作为新的猎物位置,不断迭代直至满足终止条件或达到最大迭代次数算法终止。
其改进方法主要有引入Tent映射、Cubic映射等以增强初始种群随机性从而提升求解精度;引入精英等级策略、反向学习策略、随机游走策略等以缩小解空间从而加快收敛速度,并提升算法鲁棒性;引入最大似然估计改进算法适应度函数以强化对特定优化问题解的精度;以及引入自适应因子、变异因子、非线性逃逸能量因子等等其他方向。
统一的,对SSA和HHO两个算法改进方法中所述Logistic、Tent、Cubic混沌映射可描述为如下分立方程:
引入目的是通过上述混沌映射替代伪随机数生成器,从而在种群初始化过程中获得更好的效果。
最后,在上述输出迭代解的基础上,计算当前时刻迭代估计与前时刻所在位置欧氏距离、当前时刻迭代估计与前时段所在轨迹的马氏距离以及当前时刻迭代估计的瞬时速度三个维度进行分析与评判,若均为合理则可认为迭代解更准确并完成输出。
图2为本发明的一个实施例提供的一种高精度的超宽带室内定位跟踪与控制装置的模块示意图,请参看图2,提供一种高精度的超宽带室内定位跟踪与控制装置,包括:
当前粗估计位置获取模块21,其用于获取目标当前粗估计位置;
当前估计瞬时速度计算模块22,其用于根据所述目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度;
当前估计精度评价模块23,其用于评价目标当前估计精度,若所述目标当前估计精度满足系统要求,则完成估计上报,若所述目标当前估计精度不满足系统要求,则对所述目标当前粗估计位置进行优化;
当前粗估计位置优化模块24,其用于根据所述目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群;
最优位置和最差位置计算模块25,其用于计算目标适应值确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求。
综上所述,本发明实施例的一种高精度的超宽带室内定位跟踪与控制方法及装置,获取目标当前粗估计位置;根据所述目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度;评价目标当前估计精度,若所述目标当前估计精度满足系统要求,则完成估计上报,若所述目标当前估计精度不满足系统要求,则对所述目标当前粗估计位置进行优化;根据所述目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群;计算目标适应值以确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求,通过对目标当前粗估计位置进行优化,提升了定位跟踪结果的有效性与可靠性;
进一步地,通过使用麻雀搜索算法或哈里斯鹰优化算法,在应用层面上提升了超宽带定位系统的稳定性与可行性,且设计巧妙,计算简单,市场前景广阔。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (10)
1.一种高精度的超宽带室内定位跟踪与控制方法,其特征在于,包括:
获取目标当前粗估计位置;
根据所述目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度;
评价目标当前估计精度,若所述目标当前估计精度满足系统要求,则完成估计上报,若所述目标当前估计精度不满足系统要求,则对所述目标当前粗估计位置进行优化;
根据所述目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群;
计算目标适应值以确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求。
2.根据权利要求1所述的高精度的超宽带室内定位跟踪与控制方法,其特征在于,所述评价目标当前估计精度包括当接收信号能量与测距信息置信度低于第一阈值时,则所述目标当前估计精度不满足系统要求。
3.根据权利要求1所述的高精度的超宽带室内定位跟踪与控制方法,其特征在于,所述评价目标当前估计精度包括当所述目标当前粗估计位置和目标前时刻粗估计位置的欧氏距离大于第二阈值时或当所述目标当前粗估计位置和目标前时段所在轨迹的马氏距离大于第三阈值时,则所述目标当前估计精度不满足系统要求。
5.根据权利要求1所述的高精度的超宽带室内定位跟踪与控制方法,其特征在于,当所述目标当前估计瞬时速度大于第四阈值时,则所述目标当前估计精度不满足系统要求。
10.一种高精度的超宽带室内定位跟踪与控制装置,其特征在于,包括:
当前粗估计位置获取模块,其用于获取目标当前粗估计位置;
当前估计瞬时速度计算模块,其用于根据所述目标当前粗估计位置和目标前时刻粗估计位置计算目标当前估计瞬时速度;
当前估计精度评价模块,其用于评价目标当前估计精度,若所述目标当前估计精度满足系统要求,则完成估计上报,若所述目标当前估计精度不满足系统要求,则对所述目标当前粗估计位置进行优化;
当前粗估计位置优化模块,其用于根据所述目标当前粗估计位置确定种群边界及范围,根据目标当前估计质量配置种群初始化参数,引入映射并生成初始种群;
最优位置和最差位置计算模块,其用于计算目标适应值确定最优位置和最差位置,更新目标位置进行边界判断,直至达到迭代次数,使得目标当前估计精度满足系统要求。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211437273.3A CN115494450B (zh) | 2022-11-17 | 2022-11-17 | 一种高精度的超宽带室内定位跟踪与控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211437273.3A CN115494450B (zh) | 2022-11-17 | 2022-11-17 | 一种高精度的超宽带室内定位跟踪与控制方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115494450A true CN115494450A (zh) | 2022-12-20 |
CN115494450B CN115494450B (zh) | 2023-03-21 |
Family
ID=85115932
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211437273.3A Active CN115494450B (zh) | 2022-11-17 | 2022-11-17 | 一种高精度的超宽带室内定位跟踪与控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115494450B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116182873A (zh) * | 2023-05-04 | 2023-05-30 | 长沙驰芯半导体科技有限公司 | 室内定位方法、系统及计算机可读介质 |
CN117787071A (zh) * | 2023-12-26 | 2024-03-29 | 四川大学 | 基于改进哈里斯鹰算法的非均匀平面天线阵列综合方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018018994A1 (zh) * | 2016-07-27 | 2018-02-01 | 无锡知谷网络科技有限公司 | 室内定位方法及定位系统 |
CN109816071A (zh) * | 2019-02-12 | 2019-05-28 | 河南工程学院 | 一种基于rfid的室内目标追踪方法 |
JP2019086506A (ja) * | 2017-11-02 | 2019-06-06 | 日本電信電話株式会社 | 推定装置、推定方法、及びプログラム |
CN112738709A (zh) * | 2020-12-25 | 2021-04-30 | 杭州品铂科技有限公司 | 一种基于uwb信号的粒子群搜索室内定位方法及系统 |
CN113326912A (zh) * | 2021-05-28 | 2021-08-31 | 南京邮电大学 | 一种基于信息共享哈里斯鹰优化的超宽带定位方法 |
CN113420863A (zh) * | 2021-05-19 | 2021-09-21 | 南昌大学 | 一种基于哈里斯鹰算法的储能双向变流器控制参数整定方法 |
CN113759313A (zh) * | 2021-07-23 | 2021-12-07 | 哈尔滨工程大学 | 一种基于混沌麻雀算法的时差/频差定位方法 |
-
2022
- 2022-11-17 CN CN202211437273.3A patent/CN115494450B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018018994A1 (zh) * | 2016-07-27 | 2018-02-01 | 无锡知谷网络科技有限公司 | 室内定位方法及定位系统 |
JP2019086506A (ja) * | 2017-11-02 | 2019-06-06 | 日本電信電話株式会社 | 推定装置、推定方法、及びプログラム |
CN109816071A (zh) * | 2019-02-12 | 2019-05-28 | 河南工程学院 | 一种基于rfid的室内目标追踪方法 |
CN112738709A (zh) * | 2020-12-25 | 2021-04-30 | 杭州品铂科技有限公司 | 一种基于uwb信号的粒子群搜索室内定位方法及系统 |
CN113420863A (zh) * | 2021-05-19 | 2021-09-21 | 南昌大学 | 一种基于哈里斯鹰算法的储能双向变流器控制参数整定方法 |
CN113326912A (zh) * | 2021-05-28 | 2021-08-31 | 南京邮电大学 | 一种基于信息共享哈里斯鹰优化的超宽带定位方法 |
CN113759313A (zh) * | 2021-07-23 | 2021-12-07 | 哈尔滨工程大学 | 一种基于混沌麻雀算法的时差/频差定位方法 |
Non-Patent Citations (4)
Title |
---|
MARVIN BARAHONA等: ""On the decoding of equiprobable UWB chipless RFID tags using a minimum distance detector"" * |
SOMAYYEH CHAMAANIDENG: "\"Time-Domain Design of UWB Vivaldi Antenna Array Using Multiobjective Particle Swarm Optimization\"" * |
朱国会: ""基于TDOA/FDOA的运动多站无源定位算法研究"", 《中国优秀硕士学位论文全文数据库 信息技术辑》 * |
武志凯: "基于UWB的室内定位技术及系统研究", 《中国优秀硕士学位论文全文数据库 信息技术辑》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116182873A (zh) * | 2023-05-04 | 2023-05-30 | 长沙驰芯半导体科技有限公司 | 室内定位方法、系统及计算机可读介质 |
CN117787071A (zh) * | 2023-12-26 | 2024-03-29 | 四川大学 | 基于改进哈里斯鹰算法的非均匀平面天线阵列综合方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115494450B (zh) | 2023-03-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115494450B (zh) | 一种高精度的超宽带室内定位跟踪与控制方法及装置 | |
CN105549049B (zh) | 一种应用于gps导航的自适应卡尔曼滤波算法 | |
CN110503071B (zh) | 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法 | |
Bae et al. | Large-scale indoor positioning using geomagnetic field with deep neural networks | |
Ho et al. | An accurate algebraic solution for moving source location using TDOA and FDOA measurements | |
Zhang et al. | An efficient machine learning approach for indoor localization | |
CN110933630A (zh) | 基于超宽带通信的室内三维定位方法及装置 | |
CN109379711B (zh) | 一种定位方法 | |
WO2016112758A1 (zh) | 终端的定位方法及装置 | |
CN110996333A (zh) | 一种基于鲸鱼算法的无线传感器网络节点定位方法 | |
CN104504728B (zh) | 多机动目标跟踪方法、系统及其广义联合概率数据关联器 | |
CN109991570A (zh) | 一种基于拟牛顿法的运动目标直接定位方法 | |
CN111722180A (zh) | 一种基于卡尔曼滤波的室内行人定位方法、装置及系统 | |
CN109195110A (zh) | 基于层次聚类技术和在线极限学习机的室内定位方法 | |
Galov et al. | Bayesian filters for ToF and RSS measurements for indoor positioning of a mobile object | |
Wang et al. | A linear combination-based weighted least square approach for target localization with noisy range measurements | |
CN116321410A (zh) | 一种基于toa的迭代加权最小二乘超宽带定位算法 | |
CN115226027A (zh) | 一种WiFi室内指纹定位方法及装置 | |
Tariq et al. | WSN Localization Method Based on Hybrid PSO-GRNN Approach. | |
CN104050686B (zh) | 一种密集空间目标跟踪方法 | |
CN115499916A (zh) | 基于改进鲸鱼优化算法的无线传感器网络节点定位方法 | |
Junoh et al. | Augmentation of Fingerprints for Indoor BLE Localization Using Conditional GANs | |
CN112083410A (zh) | 机动目标跟踪方法 | |
Li et al. | Fingerprint-based BLE indoor position methods to improve localization accuracy by particle filters | |
Wang et al. | An advanced algorithm for Fingerprint Localization based on Kalman Filter |
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 |