CN115150748A - 室内定位的方法、***、电子设备和存储介质 - Google Patents

室内定位的方法、***、电子设备和存储介质 Download PDF

Info

Publication number
CN115150748A
CN115150748A CN202210797947.4A CN202210797947A CN115150748A CN 115150748 A CN115150748 A CN 115150748A CN 202210797947 A CN202210797947 A CN 202210797947A CN 115150748 A CN115150748 A CN 115150748A
Authority
CN
China
Prior art keywords
real
aoa
position information
time
equipment
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
Application number
CN202210797947.4A
Other languages
English (en)
Other versions
CN115150748B (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.)
Huazhong University of Science and Technology
Original Assignee
Huazhong University of Science and Technology
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 Huazhong University of Science and Technology filed Critical Huazhong University of Science and Technology
Priority to CN202210797947.4A priority Critical patent/CN115150748B/zh
Publication of CN115150748A publication Critical patent/CN115150748A/zh
Application granted granted Critical
Publication of CN115150748B publication Critical patent/CN115150748B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/021—Services related to particular areas, e.g. point of interest [POI] services, venue services or geofences
    • 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/0257—Hybrid positioning
    • G01S5/0258—Hybrid positioning by combining or switching between measurements derived from different systems
    • G01S5/02585—Hybrid positioning by combining or switching between measurements derived from different systems at least one of the measurements being a non-radio measurement
    • 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
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02—Services making use of location information
    • H04W4/025—Services making use of location information using location based information parameters
    • H04W4/027—Services making use of location information using location based information parameters using movement velocity, acceleration information
    • 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
    • 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

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)

Abstract

本申请提供了室内定位的方法、***、电子设备和存储介质，包括：通过待定位设备获取室内的信号状态信息CSI和传感信息；根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。利用多径AOA可以克服传统WiFi定位算法中需要获得AP位置先验信息的问题，而且通过多径AOA也解决了在NLoS或多径干扰严重场景下无法进行定位的问题。

Description

室内定位的方法、***、电子设备和存储介质
技术领域
本申请属于室内定位领域，尤其涉及室内定位的方法、***、电子设备和存储介质。
背景技术
当前，基于视觉和激光雷达传感器的高精度跟踪是室内定位研究的主流方向。研究者们通过利用摄像头、激光雷达等传感器融合IMU实现了高精度、高保真度的定位以及室内环境重建。然而视觉传感器受光照、环境纹理等因素影响严重，激光雷达价格昂贵并且受天气、空气湿度等影响严重，导致现有的同步定位与地图构建(Simultaneouslocalization and mapping，SLAM)算法无法广泛应用于复杂室内环境中。
针对激光雷达和视觉传感器的局限性，研究人员在当前同步定位与地图构建SLAM框架中加入一些低成本且不受上述环境条件约束的传感器。射频(Radio-frequency，RF)传感器对动态照明条件和结构化的室内环境的鲁棒性，即使在黑暗，弱纹理和烟雾环境下也能正常工作。其中WiFi信号相比于其他无线信号在部署区域和覆盖范围上有巨大优势。目前的一些工作提出了WiFi-SLAM***。使用WiFi信号的信号强度信息(Received SignalStrength，RSSI)进行SLAM。但RSSI测量在大多数室内场景中并不可靠的，因为室内环境的多径衰落会严重干扰无线信号强度。随着无线技术的发展，使得商用网卡能够获取WiFi正交频分复用信号的信道状态信息(Channel Sate Information，CSI)。与信号强度不同，CSI提供了信号的相位信息和多个子载波的信道响应，从而大大降低了定位模糊度并提高了室内的多径分辨率。一些工作利用CSI估计移动端的位置、速度以及AP(Access Point，AP)位置的***。研究了通过WiFi信号赋能自主导航的可行性。但这些***只能工作在无多径衰落的场景，如空旷的室外环境。对于室内等遭受严重多径衰落的环境下并不适用。
综上所述，现有基于视觉和激光雷达的SLAM***受到光照、环境纹理，算力、载重以及成本等方面的限制，无法广泛应用。无线信号具有丰富的环境感知能力，有着巨大的潜力为手持移动端提供更鲁棒的状态估计和环境感知。然而，目前基于RSSI进行的SLAM算法由于RSSI在室内场景下的随机性，导致效果并不理想。而利用CSI的SLAM***中，缺乏有效特征参数的提取，在室内环境下鲁棒性较差。
发明内容
本发明实施例的主要目的在于提供室内定位的方法、***、电子设备和存储介质，使得多径AOA可以克服传统WiFi定位算法中需要获得AP位置先验信息的问题，而且通过多径AOA也解决了在NLoS或多径干扰严重场景下无法进行定位的问题。
第一方面，提供了室内定位的方法，所述方法包括：
通过待定位设备获取室内的信号状态信息CSI和传感信息；
根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；
通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
在一个可能的实现方式中，所述根据所述CSI获取多径信道到达角AOA，包括：
将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA。
在另一个可能的实现方式中，所述将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA，包括：
根据预设的信号接收公式
Figure BDA0003732833550000021
获取所述待定位设备接收到的信号，记录预设时间段内<hij(t),pi(t)>的数据对，将所述数据对设置为多天线阵列，其中，hij(t)为t时刻待接收设备接收的信号，pi(t)为t时刻待接收设备的位置，dij(t)为t时刻待接收设备与信号发射端的距离；
根据预设的运动轨迹公式pij(t)＝pi(t)-pj(t)获取所述待定位设备的相对运动轨迹；
根据预设的转向向量公式和所述相对运动轨迹获取转向向量
Figure BDA0003732833550000031
其中，(ρk,ξk,ψk),(ρl,ξl,ψl)为k、l时刻待定位设备在世界坐标系下的坐标；
根据预设的能量谱公式
Figure BDA0003732833550000032
获取能量谱，进而获取所述Fij(θ,φ)的峰值对应的(θ,φ)，并将所述峰值对应的(θ,φ)设置为多径AOA。
在另一个可能的实现方式中，所述通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化，包括：
根据预设的融合优化算法
Figure BDA0003732833550000033
将所述实时粗略位置信息、历史位置信息、真实AP和虚拟AP的估计位置信息融合优化，其中，ρ(·,c)为Huber代价函数，c为经验阈值。
第二方面，提供了一种室内定位的***，所述***包括：
信息获取模块，用于通过待定位设备获取室内的信号状态信息CSI和传感信息；
初略位置信息获取模块，用于根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；
估计及优化模块，用于通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
在一个可能的实现方式中，所述根据所述CSI获取多径信道到达角AOA，包括：
将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA。
在另一个可能的实现方式中，所述初略位置信息获取模块，包括：
多天线阵列设置单元，用于根据预设的信号接收公式
Figure BDA0003732833550000041
获取所述待定位设备接收到的信号，记录预设时间段内<hij(t),pi(t)>的数据对，将所述数据对设置为多天线阵列，其中，hij(t)为t时刻待接收设备接收的信号，pi(t)t时刻待接收设备的位置，dij(t)为t时刻待接收设备与信号发射端的距离；
相对运动轨迹获取单元，用于根据预设的运动轨迹公式
Figure BDA0003732833550000042
获取所述待定位设备的相对运动轨迹；
转向向量获取单元，用于根据预设的转向向量公式和所述相对运动轨迹获取转向向量
Figure BDA0003732833550000043
其中，(ρk,ξk,ψk),(ρl,ξl,ψl)为k、l时刻待定位设备在世界坐标系下的坐标；
多径AOA设置单元，用于根据预设的能量谱公式
Figure BDA0003732833550000044
获取能量谱，进而获取所述Fij(θ,φ)的峰值对应的(θ,φ)，并将所述峰值对应的(θ,φ)设置为多径AOA。
在另一个可能的实现方式中，通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化，包括：
根据预设的融合优化算法
Figure BDA0003732833550000051
将所述实时粗略位置信息、历史位置信息、真实AP和虚拟AP的估计位置信息融合优化，其中，ρ(·,c)为Huber代价函数，c为经验阈值。
第三方面，提供了一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，处理器执行程序时实现如第一方面提供的室内定位的方法。
第四方面，提供了一种非暂态计算机可读存储介质，其上存储有计算机程序，计算机程序被处理器执行时实现如第一方面提供的室内定位的方法。
附图说明
为了更清楚地说明本申请实施例中的技术方案，下面将对本申请实施例描述中所需要使用的附图作简单地介绍。
图1为本发明一个实施例提供的室内定位的方法的流程图；
图2为本发明再一个实施例提供的室内定位的方法的流程图；
图3为本发明一个实施例提供的室内定位的***的结构图；
图4为本发明再一个实施例提供的室内定位的***的结构图；
图5为本发明一种电子设备的实体结构示意图。
具体实现方式
下面详细描述本申请的实施例，所述实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的模块或具有相同或类似功能的模块。下面通过参考附图描述的实施例是示例性的，仅用于解释本申请，而不能解释为对本发明的限制。
本技术领域技术人员可以理解，除非特意声明，这里使用的单数形式“一”、“一个”、“所述”和“该”也可包括复数形式。应该进一步理解的是，本申请的说明书中使用的措辞“包括”是指存在所述特征、整数、步骤、操作、模块和/或组件，但是并不排除存在或添加一个或多个其他特征、整数、步骤、操作、模块、组件和/或它们的组。应该理解，当我们称模块被“连接”或“耦接”到另一模块时，它可以直接连接或耦接到其他模块，或者也可以存在中间模块。此外，这里使用的“连接”或“耦接”可以包括无线连接或无线耦接。这里使用的措辞“和/或”包括一个或更多个相关联的列出项的全部或任一模块和全部组合。
为使本申请的目的、技术方案和优点更加清楚，下面将结合附图对本申请实现方式作进一步地详细描述。
下面以具体地实施例对本申请的技术方案以及本申请的技术方案如和解决上述技术问题进行详细说明。下面这几个具体的实施例可以相互结合，对于相同或相似的概念或过程可能在某些实施例中不再赘述。下面将结合附图，对本申请的实施例进行描述。
如图1所示为本发明一个实施例提供的室内定位的方法的流程图，所述方法包括：
步骤101，通过待定位设备获取室内的信号状态信息CSI和传感信息；
步骤102，根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；
步骤103，通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
在本发明实施例中，待定位设备为具有WiFi信号接收模块以及惯性测量单元的设备，通常为手机、平板电脑等移动终端。待定位设备通过WiFi信号接收模块获取室内信道的CSI(Channel Sate Information，信道状态信息)，通过惯性测量单元获取包含待定位设备的加速度、待定位设备的陀螺仪信息等传感信息。获取的CSI通过计算可以获取多径AOA(Angle of Arrival，信道到达角)，而传感信息可以用于获取待定位设备在室内的实时大致位置信息，即实时粗略位置信息，对于实时粗略位置信息由于其只是通过惯性测量单元获取的大致信息，准确度不够，而且随着时间的增加，惯性信息获取的位置信息会越来越不准确，因此，在实时粗略位置信息的基础上，引入多径AOA和融合优化算法，通过融合优化算法对多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息待定位设备的当前位置信息进行估计，并对待优化参数进行实时优化，获取位置更为准确的优化后的位置信息。
其中，所述根据所述CSI获取多径信道到达角AOA，包括：
将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA。
在本发明实施例中，由于待定位设备通常只拥有1-2根天线，该天线数量并不足以通过多天线阵列的方式估计出多径AOA，因此，需要获取待定位设备的行动轨迹，将行动轨迹虚拟为大孔径天线，根据SAR的原理通过该大孔径雷达获取多径AOA信息。
惯性导航***具有抗干扰性强，不需要借助外部设备等优点，目前大多智能手机都配备着惯性测量单元，IMU由三个正交陀螺仪和三个正交加速度计组成，分别用于测量***的加速度和比力。通过积分可以从加速度和角速度中得到位置、速度和姿态(也称为旋转)三个量，分别用p、v、q表示。因此INS是获取载体状态信息的有效方案。此外，IMU测量信息频率相对于大多数传感器更高。
在惯性导航中，对于姿态表述常用到的方法有四元数法、欧拉角法等。欧拉角使用俯仰角、横滚角、航向角来描述姿态发生的变化，其优点在于更符合人们的思维习惯，更加直观的描述了角度的变化。然而其有一个重大缺陷，在俯仰角绝对值为90°时，翻滚角与俯仰角无法进行区分，出现“锁死”现象。四元数可用于描述载体的旋转，它将三维空间中的旋转用一个单位长度的四维向量来表示，一个四维向量包含一个实部和三个虚部，其优势在于能够无歧义的描述姿态。本发明采用四元素法来对姿态进行描述：
q＝q0+q1i+q2j+q3k
其中i,j,k为三个虚部。i2＝-1,j2＝-1,k2＝-1，且满足
Figure BDA0003732833550000071
此外，需要对载体坐标系和世界坐标系进行区分，用b表示***自身坐标系，w表示世界坐标系。
Figure BDA0003732833550000072
是用四元数表示的从b系相对于w系的旋转。此外可以通过四元数
Figure BDA0003732833550000073
转化得到旋转矩阵
Figure BDA0003732833550000074
通过对IMU的测量数据进行积分，可以推导出从第m时刻到n时刻的位置
Figure BDA0003732833550000081
速度
Figure BDA0003732833550000082
旋转
Figure BDA0003732833550000083
Figure BDA0003732833550000084
Figure BDA0003732833550000085
Figure BDA0003732833550000086
其中，bg为陀螺仪的偏置，ba为加速度计的偏置，gw为重力加速度，ng陀螺仪的噪声，na为加速度计的噪声，Ω(·)为四元数的右乘矩阵。
其中，所述通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化，包括：
根据预设的融合优化算法
Figure BDA0003732833550000087
将所述实时粗略位置信息、历史位置信息、真实AP和虚拟AP的估计位置信息融合优化，其中，ρ(·,c)为Huber代价函数，c为经验阈值。
在本发明实施例中，AP并不总是与用户放置在相同的高度，而是被放置在天花板附近，AP的高度也是未知的，这增加了优化的复杂性。然而，AP高度的变化对AP到用户的AoA影响很小，使得最终对定位性能的影响可以忽略，因此为简化***复杂性本发明对室内场所用户的二维位置和方向进行优化，这也包含了目前室内场景大多数的应用需求。
用户手机中的加速度计和陀螺仪传感器提供跨时间的相对位姿测量，这里将手机与用户近似为同一参考系。令状态空间S为用户在P个时间步长的一组姿态，则状态空间可表示为：
Figure BDA0003732833550000088
其中每个pi属于特殊欧几里得群。令pi与pi+1时刻的相对位姿测量为zi，同时其对角协方差矩阵为∑i。该协方差矩阵可以在IMU预积分阶段通过对误差项求积分得到。用来表示残差的置信程度，协方差矩阵越大，表明当前的测量数据的可信度越低，其在优化过程中对结果的影响程度越小。
考虑两个连续的位姿pi与pi+1。则相对位姿的测量模型
Figure BDA0003732833550000089
可定义为：
Figure BDA0003732833550000091
其中R(·)∈SO(3)是旋转矩阵。通过该预测模型，可以将两个连续的用户位姿测量和预测之间的误差函数定义为：
Figure BDA0003732833550000092
在考虑IMU的误差模型后，需要继续对AP与VAP的测量模型与误差模型进行定义。首先，由于本设计考虑无法获得AP与VAP位置及方向先验信息的情况，因此需要在状态空间S中附加AP与VAP的位置。为方便讨论，下面以仅使用单AP的情况进行分析，但该方法易扩展为多AP场景。因此，将状态空间S改写为：
Figure BDA0003732833550000093
其中a＝(ax,ay)∈SE(2)表示AP的位置。
Figure BDA0003732833550000094
表示第j个VAP的位置。通过这种重新定义，本发明将AP的位姿纳入了优化的范围。
下面对真实AP到用户间AoA测量进行建模：
Figure BDA0003732833550000095
其中旋转
Figure BDA0003732833550000096
使AP到用户的AoA转化到用户坐标系下。由于用户手机天线数量限制无法进行AoA参数估计，通过上述SAR方法可对AP与用户间AoA进行估计，选择每接收到M次CSI数据进行一次SAR参数估计，并取水平角作为每一次观测量。则AP与用户直射路径的AoA测量和预测之间的误差函数定义为：
Figure BDA0003732833550000097
其中
Figure BDA0003732833550000098
是AP到用户在第i个位置上的直射路径AoA测量值。需要说明的是，由于采用SAR技术，因此获得AoA参数估计的速率相比于有M根天线的接收机下降了M倍数。
同理对VAP到用户间AoA测量进行建模：
Figure BDA0003732833550000099
VAP与用户间AoA测量和预测之间的误差函数定义为：
Figure BDA00037328335500000910
需要说明的是，由于VAP的信号本质上为真实AP的反射信号，因此用户无法区分解算的多径AoA分别来自哪个VAP或真实AP。然而由于用户行走速度的限制，相邻两个位置间距离较小，因此对于同一个VAP或真实AP在下一个时刻的AoA会受到当前的AoA数值以及两个时刻间的相对运动约束。由于两个时刻的间隔时间较短，可以通过IMU在短时间内的积分获得。
令k到k+1时刻手机的相对旋转表示为
Figure BDA0003732833550000101
两个时刻的相对位移表示为
Figure BDA0003732833550000102
以给定直射路径θk为例，通过第k个位置与第k+1个位置间的IMU测量对θk+1进行预测。
由于AP相对于手机的AoA主要由AP与手机的相对位置和手机的姿态决定。因此该预测过程主要包含两部分的预测：一部分是由于手机位移导致角度变化α，另一部分是由于姿态变化导致的角度变化β。因此对于k+1时刻的预测值
Figure BDA0003732833550000103
可以表示为
Figure BDA0003732833550000104
β可以由旋转矩阵
Figure BDA0003732833550000105
获得。但α在求解过程中存在需要取近似的地方，这是由于AP与手机距离l未知，但对于k到k+1时刻弧长求解过程中需要利用该参数。弧长的计算公式为：
Figure BDA0003732833550000106
因此，假设k和k+1时刻相对位移较小，弧长可以用位移近似代替。因此近似的弧长计算为：
Figure BDA0003732833550000107
Figure BDA0003732833550000108
其中at表示IMU的线加速度，
Figure BDA0003732833550000109
表示k时刻相对初始时刻的旋转。Δt表示k到k+1之间的时间差。初始距离l可以选取经验值。则，
Figure BDA00037328335500001010
初始距离对最终优化效果影响不大，因为本***的WIFI-IMU融合优化模块可以不断的优化用户的位置和方向以及AP，VAP的位置，从而更新了l。因此通过上述方法可以通过θk预测
Figure BDA00037328335500001011
同理，该方法可以对其他VAP下一时刻的AoA进行预测。因此，对于k+1时刻利用SAR方法获得的N+1个多径AoA可以分别与预测的AoA进行对照，将
Figure BDA00037328335500001012
与θk+1最接近的匹配为同一VAP或AP。
最后，为了将用户转化在一个固定的全局参考系上，需要提供了一个初始先验位置
Figure BDA0003732833550000111
综上所述，完整的优化函数可以定义为：
Figure BDA0003732833550000112
其中ρ(·,c)采用Huber代价函数，c为经验阈值，能够进一步加强对异常值的优化。
Figure BDA0003732833550000113
此外，σAP和σVAP分别表示AP与VAP到用户的AoA方差，其数值可以通过记录一段时间数据，结合统计学公式获得。值得说明的一点是，本发明创新性地提出将VAP误差加入总体的因子图中进行优化。之前大多融合算法使用的扩展卡尔曼滤波算法(Extend KalmanFilter，EKF)且仅仅利用当前WiFi的直射AoA进行融合，而将VAP的AoA加入总体的因子图中，可以有效克服NLoS情况，且能够利用当前与历史定位结果之间的联系，进一步降低定位误差。
构建完上述的目标函数后，采用Levenberg-Marquadt方法求解该优化问题。通过以上方式，在无先验AP位置信息和NLoS环境下，可以实现高精度和高鲁棒性的室内定位。
本发明实施例，通过待定位设备获取室内的信号状态信息CSI和传感信息；根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。使得多径AOA可以克服传统WiFi定位算法中需要获得AP位置先验信息的问题，而且通过多径AOA也解决了在NLoS或多径干扰严重场景下无法进行定位的问题。
如图2所示为本发明再一个实施例提供的室内定位的方法的流程图，所述将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA，包括：
步骤201，根据预设的信号接收公式
Figure BDA0003732833550000121
获取所述待定位设备接收到的信号，记录预设时间段内<hij(t),pi(t)>的数据对，将所述数据对设置为多天线阵列，其中，hij(t)为t时刻待接收设备接收的信号，pi(t)t时刻待接收设备的位置，dij(t)为t时刻待接收设备与信号发射端的距离；
步骤202，根据预设的运动轨迹公式pij(t)＝pi(t)-pj(t)获取所述待定位设备的相对运动轨迹；
步骤203，根据预设的转向向量公式和所述相对运动轨迹获取转向向量
Figure BDA0003732833550000122
其中，(ρk,ξk,ψk),(ρl,ξl,ψl)为k、l时刻待定位设备在世界坐标系下的坐标；
步骤204，根据预设的能量谱公式
Figure BDA0003732833550000123
获取能量谱，进而获取所述Fij(θ,φ)的峰值对应的(θ,φ)，并将所述峰值对应的(θ,φ)设置为多径AOA。
在本发明实施例中，在的三维极坐标系下，为方便讨论令AP为发射端j且在坐标原点，令手机为接收端i。考虑到该过程在较短时间内完成，因此接收端pi(k)到pi(l)相对运动轨迹可由IMU进行估计。接收端运动轨迹为一条由M组坐标构成的三维轨迹[pi(k)，...，pi(l)]，l＝k+M。接收信号可表示为：
Figure BDA0003732833550000124
这里dij(t)代表发送端与接收端之间的距离。用pi(t)，pj(t)代表t时刻接收端与发送端的位置，那么，可以在接收端记录一段时间里的<hij(t)，pi(t)>数据对，并将每个这样的数据对看作三维空间中的一根虚拟天线。这样，通过采集一段时间窗口内的<hij(t)，pi(t)>数据对，便可以得到一个虚拟的三维空间上的多天线阵列。
值得注意的是，信道状态信息采集hij(t)所需的带宽开销是很小的。以WiFi信号为例，只需要5kb/s的通信速率就能完成hij(t)的采集，不会影响收发端之间的正常通信。
有了虚拟多天线阵列，就可以仿照之前一维线性天线阵列，进行到达角估计。首先可以得到SAR的信号接收模型：
Yij(t)＝[Y(tk),...,Y(tl)]T＝a(θ,φ)(t)hij(t)+n(t)
这里Yij(t)代表t时刻时间窗口[tk，...，tl]上产生的接收信号。由于天线阵列拓展到了三维极坐标系下，转向向量是θ，φ的函数。
这样，同样可以利用Bartlett波束赋形法来估计到达角，信号能量谱可以写作如下形式：
Figure BDA0003732833550000131
Fij(θ，φ)是一个二维矩阵，它的每一个元素可以看作其代表的信号方向是真实的信号到达角的可能性。得到能量谱Fij(θ，φ)后，只需要知道其峰值对应的(θ，φ)便可以得到信号到达角。
在分析一维线性天线阵列的信号接收模型时，引入了转向向量来帮助分析各天线上的相位关系。在给定接收端移动轨迹条件下，只需导出其对应的转向向量便可以计算到达角了。
由于需要的只是手机与AP的相对方位，与手机和AP收发***所处的绝对位置无关。因此对于发送端位置并无要求，接收端相对运动轨迹可以表示为：
pij(t)＝pi(t)-pj(t)
利用相对轨迹，导出极坐标系下的三维天线阵列的转向向量：
Figure BDA0003732833550000132
这里(ρk，ξk，ψk)，(ρl，ξl，ψl)代表k，l时刻接收端在世界坐标系下的坐标。
得到了转向向量以及接收端在每个虚拟天线位置上收集到的信号hij(t)，便可以通过Bartlett波束赋形到达角解算法得到能量谱Fij(θ，φ)：
Figure BDA0003732833550000133
Fij(θ，φ)的各个峰值对应的(θ，φ)即为三维空间中的信号多径到达角，在LoS情况下最高峰为直射路径到达角，其余峰值为各主反射面反射信号到达角度，即各VAP到达角度，峰值大小可用于表征其置信度。
然而要实现到达角估计，最重要的一步就是获取信道信息hij(t)，即CSI。对于一对收发端来说，它们使用的射频电路的晶振并不相同，这会导致收发设备之间存在载波频率的差异，这种差异称为载波频偏(Carrier Frequency Offset，CFO)。CFO会导致接收机采集到的CSI包含噪声，从而影响到达角预测精度。
一种消除CFO的常用手段是信道互惠。信道互惠利用了前向信道和反向信道之间的关系，来消除CFO。因为不仅可以在接收端获得CSI，在发射端也能接收到来自接收端信号的CSI(反向信道)。接收端每收到一个来自发射端的数据包，便立即发回一个ACK信号，这样发射端也能采集到一帧CSI。
收发端采集的CSI可分别表达如下：
Figure BDA0003732833550000141
Figure BDA0003732833550000142
Figure BDA0003732833550000143
和
Figure BDA0003732833550000144
分别为前向信道和反向信道的CSI，Δf为CFO，τ为信号传播时间。这里假设在接收端接收到前向信道CSI到发射机接收到反向信道CSI的过程中接收端位移忽略不计，故上两式中信号传播时间τ相同。
得到了双向信道信息后，可以由下式计算出不含CFO的原始信道：
Figure BDA0003732833550000145
因此可以通过
Figure BDA0003732833550000146
和
Figure BDA0003732833550000147
得到不包含CFO的原始信道hij(t)。这里的κh是一个不随时间变化的常数。能量谱函数：
Figure BDA0003732833550000148
通过上式计算能量谱并取各个峰值对应的(θ，φ)，便可得到不受CFO影响的多径到达角估计值。
如图3所示为本发明一个实施例提供的室内定位的***的结构图，所述***包括：
信息获取模块301，用于通过待定位设备获取室内的信号状态信息CSI和传感信息；
实时粗略位置信息获取模块302，用于根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；
估计及优化模块303，用于通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
在本发明实施例中，待定位设备为具有WiFi信号接收模块以及惯性测量单元的设备，通常为手机、平板电脑等移动终端。待定位设备通过WiFi信号接收模块获取室内信道的CSI(Channel Sate Information，信道状态信息)，通过惯性测量单元获取包含待定位设备的加速度、待定位设备的陀螺仪信息等传感信息。获取的CSI通过计算可以获取多径AOA(Angle of Arrival，信道到达角)，而传感信息可以用于获取待定位设备在室内的实时大致位置信息，即实时粗略位置信息，对于实时粗略位置信息由于其只是通过惯性测量单元获取的大致信息，准确度不够，而且随着时间的增加，惯性信息获取的位置信息会越来越不准确，因此，在实时粗略位置信息的基础上，引入多径AOA和融合优化算法，通过融合优化算法对多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息待定位设备的当前位置信息进行估计，并对待优化参数进行实时优化，获取位置更为准确的优化后的位置信息。
其中，所述根据所述CSI获取多径信道到达角AOA，包括：
将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA。
在本发明实施例中，由于待定位设备通常只拥有1-2根天线，该天线数量并不足以通过多天线阵列的方式估计出多径AOA，因此，需要获取待定位设备的行动轨迹，将行动轨迹虚拟为大孔径天线，根据SAR的原理通过该大孔径雷达获取多径AOA信息。
惯性导航***具有抗干扰性强，不需要借助外部设备等优点，目前大多智能手机都配备着惯性测量单元，IMU由三个正交陀螺仪和三个正交加速度计组成，分别用于测量***的加速度和比力。通过积分可以从加速度和角速度中得到位置、速度和姿态(也称为旋转)三个量，分别用p、v、q表示。因此INS是获取载体状态信息的有效方案。此外，IMU测量信息频率相对于大多数传感器更高。
在惯性导航中，对于姿态表述常用到的方法有四元数法、欧拉角法等。欧拉角使用俯仰角、横滚角、航向角来描述姿态发生的变化，其优点在于更符合人们的思维习惯，更加直观的描述了角度的变化。然而其有一个重大缺陷，在俯仰角绝对值为90°时，翻滚角与俯仰角无法进行区分，出现“锁死”现象。四元数可用于描述载体的旋转，它将三维空间中的旋转用一个单位长度的四维向量来表示，一个四维向量包含一个实部和三个虚部，其优势在于能够无歧义的描述姿态。本发明采用四元素法来对姿态进行描述：
q＝q0+q1i+q2j+q3k
其中i,j,k为三个虚部。i2＝-1,j2＝-1,k2＝-1，且满足
Figure BDA0003732833550000161
此外，需要对载体坐标系和世界坐标系进行区分，用b表示***自身坐标系，w表示世界坐标系。
Figure BDA0003732833550000162
是用四元数表示的从b系相对于w系的旋转。此外可以通过四元数
Figure BDA0003732833550000163
转化得到旋转矩阵
Figure BDA0003732833550000164
通过对IMU的测量数据进行积分，可以推导出从第m时刻到n时刻的位置
Figure BDA0003732833550000165
速度
Figure BDA0003732833550000166
旋转
Figure BDA0003732833550000167
Figure BDA0003732833550000168
Figure BDA0003732833550000169
Figure BDA00037328335500001610
其中，bg为陀螺仪的偏置，ba为加速度计的偏置，gw为重力加速度，ng陀螺仪的噪声，na为加速度计的噪声，Ω(·)为四元数的右乘矩阵。
其中，所述通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化，包括：
根据预设的融合优化算法
Figure BDA0003732833550000171
将所述实时粗略位置信息、历史位置信息、真实AP和虚拟AP的估计位置信息融合优化，其中，ρ(·,c)为Huber代价函数，c为经验阈值。
在本发明实施例中，AP并不总是与用户放置在相同的高度，而是被放置在天花板附近，AP的高度也是未知的，这增加了优化的复杂性。然而，AP高度的变化对AP到用户的AoA影响很小，使得最终对定位性能的影响可以忽略，因此为简化***复杂性本发明对室内场所用户的二维位置和方向进行优化，这也包含了目前室内场景大多数的应用需求。
用户手机中的加速度计和陀螺仪传感器提供跨时间的相对位姿测量，这里将手机与用户近似为同一参考系。令状态空间S为用户在P个时间步长的一组姿态，则状态空间可表示为：
Figure BDA0003732833550000172
其中每个pi属于特殊欧几里得群。令pi与pi+1时刻的相对位姿测量为zi，同时其对角协方差矩阵为∑i。该协方差矩阵可以在IMU预积分阶段通过对误差项求积分得到。用来表示残差的置信程度，协方差矩阵越大，表明当前的测量数据的可信度越低，其在优化过程中对结果的影响程度越小。
考虑两个连续的位姿pi与pi+1。则相对位姿的测量模型
Figure BDA0003732833550000173
可定义为：
Figure BDA0003732833550000174
其中R(·)∈SO(3)是旋转矩阵。通过该预测模型，可以将两个连续的用户位姿测量和预测之间的误差函数定义为：
Figure BDA0003732833550000175
在考虑IMU的误差模型后，需要继续对AP与VAP的测量模型与误差模型进行定义。首先，由于本设计考虑无法获得AP与VAP位置及方向先验信息的情况，因此需要在状态空间S中附加AP与VAP的位置。为方便讨论，下面以仅使用单AP的情况进行分析，但该方法易扩展为多AP场景。因此，将状态空间S改写为：
Figure BDA0003732833550000176
其中a＝(ax,ay)∈SE(2)表示AP的位置。
Figure BDA0003732833550000181
表示第j个VAP的位置。通过这种重新定义，本发明将AP的位姿纳入了优化的范围。
下面对真实AP到用户间AoA测量进行建模：
Figure BDA0003732833550000182
其中旋转
Figure BDA0003732833550000183
使AP到用户的AoA转化到用户坐标系下。由于用户手机天线数量限制无法进行AoA参数估计，通过上述SAR方法可对AP与用户间AoA进行估计，选择每接收到M次CSI数据进行一次SAR参数估计，并取水平角作为每一次观测量。则AP与用户直射路径的AoA测量和预测之间的误差函数定义为：
Figure BDA0003732833550000184
其中
Figure BDA0003732833550000185
是AP到用户在第i个位置上的直射路径AoA测量值。需要说明的是，由于采用SAR技术，因此获得AoA参数估计的速率相比于有M根天线的接收机下降了M倍数。
同理对VAP到用户间AoA测量进行建模：
Figure BDA0003732833550000186
VAP与用户间AoA测量和预测之间的误差函数定义为：
Figure BDA0003732833550000187
需要说明的是，由于VAP的信号本质上为真实AP的反射信号，因此用户无法区分解算的多径AoA分别来自哪个VAP或真实AP。然而由于用户行走速度的限制，相邻两个位置间距离较小，因此对于同一个VAP或真实AP在下一个时刻的AoA会受到当前的AoA数值以及两个时刻间的相对运动约束。由于两个时刻的间隔时间较短，可以通过IMU在短时间内的积分获得。
令k到k+1时刻手机的相对旋转表示为
Figure BDA0003732833550000188
两个时刻的相对位移表示为
Figure BDA0003732833550000189
以给定直射路径θk为例，通过第k个位置与第k+1个位置间的IMU测量对θk+1进行预测。
由于AP相对于手机的AoA主要由AP与手机的相对位置和手机的姿态决定。因此该预测过程主要包含两部分的预测：一部分是由于手机位移导致角度变化α，另一部分是由于姿态变化导致的角度变化β。因此对于k+1时刻的预测值
Figure BDA0003732833550000191
可以表示为
Figure BDA0003732833550000192
β可以由旋转矩阵
Figure BDA0003732833550000193
获得。但α在求解过程中存在需要取近似的地方，这是由于AP与手机距离l未知，但对于k到k+1时刻弧长求解过程中需要利用该参数。弧长的计算公式为：
Figure BDA0003732833550000194
因此，假设k和k+1时刻相对位移较小，弧长可以用位移近似代替。因此近似的弧长计算为：
Figure BDA0003732833550000195
Figure BDA0003732833550000196
其中at表示IMU的线加速度，
Figure BDA0003732833550000197
表示k时刻相对初始时刻的旋转。Δt表示k到k+1之间的时间差。初始距离l可以选取经验值。则，
Figure BDA0003732833550000198
初始距离对最终优化效果影响不大，因为本***的WIFI-IMU融合优化模块可以不断的优化用户的位置和方向以及AP，VAP的位置，从而更新了l。因此通过上述方法可以通过θk预测
Figure BDA0003732833550000199
同理，该方法可以对其他VAP下一时刻的AoA进行预测。因此，对于k+1时刻利用SAR方法获得的N+1个多径AoA可以分别与预测的AoA进行对照，将
Figure BDA00037328335500001910
与θk+1最接近的匹配为同一VAP或AP。
最后，为了将用户转化在一个固定的全局参考系上，需要提供了一个初始先验位置
Figure BDA00037328335500001911
如默认进入大门时刻的位置为初始位置。综上所述，完整的优化函数可以定义为：
Figure BDA00037328335500001912
其中ρ(·,c)采用Huber代价函数，c为经验阈值，能够进一步加强对异常值的优化。
Figure BDA00037328335500001913
此外，σAP和σVAP分别表示AP与VAP到用户的AoA方差，其数值可以通过记录一段时间数据，结合统计学公式获得。值得说明的一点是，本发明创新性地提出将VAP误差加入总体的因子图中进行优化。之前大多融合算法使用的扩展卡尔曼滤波算法(Extend KalmanFilter，EKF)且仅仅利用当前WiFi的直射AoA进行融合，而将VAP的AoA加入总体的因子图中，可以有效克服NLoS情况，且能够利用当前与历史定位结果之间的联系，进一步降低定位误差。
构建完上述的目标函数后，采用Levenberg-Marquadt方法求解该优化问题。通过以上方式，在无先验AP位置信息和NLoS环境下，可以实现高精度和高鲁棒性的室内定位。
本发明实施例，通过待定位设备获取室内的信号状态信息CSI和传感信息；根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。使得多径AOA可以克服传统WiFi定位算法中需要获得AP位置先验信息的问题，而且通过多径AOA也解决了在NLoS或多径干扰严重场景下无法进行定位的问题。
如图4所示为本发明再一个实施例提供的室内定位的***的结构图，所述实时粗略位置信息获取模块302，包括：
多天线阵列设置单元401，用于根据预设的信号接收公式
Figure BDA0003732833550000201
获取所述待定位设备接收到的信号，记录预设时间段内<hij(t),pi(t)>的数据对，将所述数据对设置为多天线阵列，其中，hij(t)为t时刻待接收设备接收的信号，pi(t)t时刻待接收设备的位置，dij(t)为t时刻待接收设备与信号发射端的距离；
相对运动轨迹获取单元402，用于根据预设的运动轨迹公式pij(t)＝pi(t)-pj(t)获取所述待定位设备的相对运动轨迹；
转向向量获取单元403，用于根据预设的转向向量公式和所述相对运动轨迹获取转向向量
Figure BDA0003732833550000211
其中，(ρk,ξk,ψk),(ρl,ξl,ψl)为k、l时刻待定位设备在世界坐标系下的坐标；
多径AOA设置单元404，用于根据预设的能量谱公式
Figure BDA0003732833550000212
获取能量谱，进而获取所述Fij(θ,φ)的峰值对应的(θ,φ)，并将所述峰值对应的(θ,φ)设置为多径AOA。
在本发明实施例中，在的三维极坐标系下，为方便讨论令AP为发射端j且在坐标原点，令手机为接收端i。考虑到该过程在较短时间内完成，因此接收端pi(k)到pi(l)相对运动轨迹可由IMU进行估计。接收端运动轨迹为一条由M组坐标构成的三维轨迹[pi(k)，...，pi(l)]，l＝k+M。接收信号可表示为：
Figure BDA0003732833550000213
这里dij(t)代表发送端与接收端之间的距离。用pi(t)，pj(t)代表t时刻接收端与发送端的位置，那么，可以在接收端记录一段时间里的<hij(t)，pi(t)>数据对，并将每个这样的数据对看作三维空间中的一根虚拟天线。这样，通过采集一段时间窗口内的<hij(t)，pi(t)>数据对，便可以得到一个虚拟的三维空间上的多天线阵列。
值得注意的是，信道状态信息采集hij(t)所需的带宽开销是很小的。以WiFi信号为例，只需要5kb/s的通信速率就能完成hij(t)的采集，不会影响收发端之间的正常通信。
有了虚拟多天线阵列，就可以仿照之前一维线性天线阵列，进行到达角估计。首先可以得到SAR的信号接收模型：
Yij(t)＝[Y(tk),...,Y(tl)]T＝a(θ,φ)(t)hij(t)+n(t)
这里Yij(t)代表t时刻时间窗口[tk，...，tl]上产生的接收信号。由于天线阵列拓展到了三维极坐标系下，转向向量是θ，φ的函数。
这样，同样可以利用Bartlett波束赋形法来估计到达角，信号能量谱可以写作如下形式：
Figure BDA0003732833550000221
Fij(θ，φ)是一个二维矩阵，它的每一个元素可以看作其代表的信号方向是真实的信号到达角的可能性。得到能量谱Fij(θ，φ)后，只需要知道其峰值对应的(θ，φ)便可以得到信号到达角。
在分析一维线性天线阵列的信号接收模型时，引入了转向向量来帮助分析各天线上的相位关系。在给定接收端移动轨迹条件下，只需导出其对应的转向向量便可以计算到达角了。
由于需要的只是手机与AP的相对方位，与手机和AP收发***所处的绝对位置无关。因此对于发送端位置并无要求，接收端相对运动轨迹可以表示为：
pij(t)＝pi(t)-pj(t)
利用相对轨迹，导出极坐标系下的三维天线阵列的转向向量：
Figure BDA0003732833550000222
这里(ρk，ξk，ψk)，(ρl，ξl，ψl)代表k，l时刻接收端在世界坐标系下的坐标。
得到了转向向量以及接收端在每个虚拟天线位置上收集到的信号hij(t)，便可以通过Bartlett波束赋形到达角解算法得到能量谱Fij(θ，φ)：
Figure BDA0003732833550000223
Fij(θ，φ)的各个峰值对应的(θ，φ)即为三维空间中的信号多径到达角，在LoS情况下最高峰为直射路径到达角，其余峰值为各主反射面反射信号到达角度，即各VAP到达角度，峰值大小可用于表征其置信度。
然而要实现到达角估计，最重要的一步就是获取信道信息hij(t)，即CSI。对于一对收发端来说，它们使用的射频电路的晶振并不相同，这会导致收发设备之间存在载波频率的差异，这种差异称为载波频偏(Carrier Frequency Offset，CFO)。CFO会导致接收机采集到的CSI包含噪声，从而影响到达角预测精度。
一种消除CFO的常用手段是信道互惠。信道互惠利用了前向信道和反向信道之间的关系，来消除CFO。因为不仅可以在接收端获得CSI，在发射端也能接收到来自接收端信号的CSI(反向信道)。接收端每收到一个来自发射端的数据包，便立即发回一个ACK信号，这样发射端也能采集到一帧CSI。
收发端采集的CSI可分别表达如下：
Figure BDA0003732833550000231
Figure BDA0003732833550000232
Figure BDA0003732833550000233
和
Figure BDA0003732833550000234
分别为前向信道和反向信道的CSI，Δf为CFO，τ为信号传播时间。这里假设在接收端接收到前向信道CSI到发射机接收到反向信道CSI的过程中接收端位移忽略不计，故上两式中信号传播时间τ相同。
得到了双向信道信息后，可以由下式计算出不含CFO的原始信道：
Figure BDA0003732833550000235
因此可以通过
Figure BDA0003732833550000236
和
Figure BDA0003732833550000237
得到不包含CFO的原始信道hij(t)。这里的κh是一个不随时间变化的常数。能量谱函数：
Figure BDA0003732833550000238
通过上式计算能量谱并取各个峰值对应的(θ，φ)，便可得到不受CFO影响的多径到达角估计值。
图5示例了一种电子设备的实体结构示意图，如图5所示，该电子设备可以包括：处理器(processor)501、通信接口(Communications Interface)502、存储器(memory)503和通信总线504，其中，处理器，通信接口，存储器通过通信总线完成相互间的通信。处理器可以调用存储器中的逻辑指令，以执行室内定位的方法，该方法包括：通过待定位设备获取室内的信号状态信息CSI和传感信息；根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
此外，上述的存储器中的逻辑指令可以通过软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可读取存储介质中。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器(ROM，Read-Only Memory)、随机存取存储器(RAM，Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
另一方面，本发明实施例还提供一种计算机程序产品，所述计算机程序产品包括存储在非暂态计算机可读存储介质上的计算机程序，所述计算机程序包括程序指令，当所述程序指令被计算机执行时，计算机能够执行上述各方法实施例所提供的室内定位的方法，该方法包括：通过待定位设备获取室内的信号状态信息CSI和传感信息；根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
又一方面，本发明实施例还提供一种非暂态计算机可读存储介质，其上存储有计算机程序，该计算机程序被处理器执行时实现以执行上述各实施例提供的室内定位的方法，该方法包括：通过待定位设备获取室内的信号状态信息CSI和传感信息；根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
应该理解的是，虽然附图的流程图中的各个步骤按照箭头的指示依次显示，但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明，这些步骤的执行并没有严格的顺序限制，其可以以其他的顺序执行。而且，附图的流程图中的至少一部分步骤可以包括多个子步骤或者多个阶段，这些子步骤或者阶段并不必然是在同一时刻执行完成，而是可以在不同的时刻执行，其执行顺序也不必然是依次进行，而是可以与其他步骤或者其他步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
以上所述仅是本发明的部分实现方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。

Claims (10)

1.一种室内定位的方法，其特征在于，所述方法包括：
通过待定位设备获取室内的信号状态信息CSI和传感信息；
根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；
通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
2.如权利要求1所述的方法，其特征在于，所述根据所述CSI获取多径信道到达角AOA，包括：
将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA。
3.如权利要求2所述的方法，其特征在于，所述将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA，包括：
根据预设的信号接收公式
Figure FDA0003732833540000011
获取所述待定位设备接收到的信号，记录预设时间段内<hij(t),pi(t)>的数据对，将所述数据对设置为多天线阵列，其中，hij(t)为t时刻待接收设备接收的信号，pi(t)为t时刻待接收设备的位置，dij(t)为t时刻待接收设备与信号发射端的距离；
根据预设的运动轨迹公式pij(t)＝pi(t)-pj(t)获取所述待定位设备的相对运动轨迹；
根据预设的转向向量公式和所述相对运动轨迹获取转向向量
Figure FDA0003732833540000012
其中，(ρk,ξk,ψk),(ρl,ξl,ψl)为k、l时刻待定位设备在世界坐标系下的坐标；
根据预设的能量谱公式
Figure FDA0003732833540000013
获取能量谱，进而获取所述Fij(θ,φ)的峰值对应的(θ,φ)，并将所述峰值对应的(θ,φ)设置为多径AOA。
4.如权利要求1所述的方法，其特征在于，所述通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化，包括：
根据预设的融合优化算法
Figure FDA0003732833540000021
将所述实时粗略位置信息、历史位置信息、真实AP和虚拟AP的估计位置信息融合优化，其中，ρ(·,c)为Huber代价函数，c为经验阈值。
5.一种室内定位的***，其特征在于，所述***包括：
信息获取模块，用于通过待定位设备获取室内的信号状态信息CSI和传感信息；
实时粗略位置信息获取模块，用于根据所述CSI获取多径信道到达角AOA，并根据所述传感信息获取所述待定位设备在所述室内的实时粗略位置信息；
估计及优化模块，用于通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化。
6.如权利要求5所述的***，其特征在于，所述根据所述CSI获取多径信道到达角AOA，包括：
将所述待定位设备的行动轨迹虚拟为大孔径天线，根据合成孔径雷达SAR的原理通过所述大孔径天线获取所述多径AOA。
7.如权利要求6所述的***，其特征在于，所述实时粗略位置信息获取模块，包括：
多天线阵列设置单元，用于根据预设的信号接收公式
Figure FDA0003732833540000022
获取所述待定位设备接收到的信号，记录预设时间段内<hij(t),pi(t)>的数据对，将所述数据对设置为多天线阵列，其中，hij(t)为t时刻待接收设备接收的信号，pi(t)t时刻待接收设备的位置，dij(t)为t时刻待接收设备与信号发射端的距离；
相对运动轨迹获取单元，用于根据预设的运动轨迹公式
Figure FDA0003732833540000031
获取所述待定位设备的相对运动轨迹；
转向向量获取单元，用于根据预设的转向向量公式和所述相对运动轨迹获取转向向量
Figure FDA0003732833540000032
其中，(ρk,ξk,ψk),(ρl,ξl,ψl)为k、l时刻待定位设备在世界坐标系下的坐标；
多径AOA设置单元，用于根据预设的能量谱公式
Figure FDA0003732833540000033
获取能量谱，进而获取所述Fij(θ,φ)的峰值对应的(θ,φ)，并将所述峰值对应的(θ,φ)设置为多径AOA。
8.如权利要求5所述的***，其特征在于，通过预设的融合优化算法根据所述实时粗略位置信息、多径AOA、历史位置信息、真实AP和虚拟AP的估计位置信息对所述待定位设备的当前位置进行估计，并对待优化参数进行实时优化，包括：
根据预设的融合优化算法
Figure FDA0003732833540000034
将所述实时粗略位置信息、历史位置信息、真实AP和虚拟AP的估计位置信息融合优化，其中，ρ(·,c)为Huber代价函数，c为经验阈值。
9.一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述程序时实现如权利要求1-4任一项所述的室内定位的方法。
10.一种非暂态计算机可读存储介质，其上存储有计算机程序，其特征在于，所述计算机程序被处理器执行时实现如权利要求1-4任一项所述的室内定位的方法。
CN202210797947.4A 2022-07-06 2022-07-06 室内定位的方法、***、电子设备和存储介质 Active CN115150748B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210797947.4A CN115150748B (zh) 2022-07-06 2022-07-06 室内定位的方法、***、电子设备和存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210797947.4A CN115150748B (zh) 2022-07-06 2022-07-06 室内定位的方法、***、电子设备和存储介质

Publications (2)

Publication Number Publication Date
CN115150748A true CN115150748A (zh) 2022-10-04
CN115150748B CN115150748B (zh) 2024-07-05

Family

ID=83411247

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210797947.4A Active CN115150748B (zh) 2022-07-06 2022-07-06 室内定位的方法、***、电子设备和存储介质

Country Status (1)

Country Link
CN (1) CN115150748B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118158609A (zh) * 2024-05-08 2024-06-07 厦门大学 一种多径信号多历元联合跟踪***和方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016112758A1 (zh) * 2015-01-15 2016-07-21 中兴通讯股份有限公司 终端的定位方法及装置
WO2017198037A1 (zh) * 2016-05-17 2017-11-23 安徽酷哇机器人有限公司 基于AoA的UWB定位***
CN110749859A (zh) * 2019-10-22 2020-02-04 清华大学 基于多载频的单基站阵列定位方法和装置
CN111182459A (zh) * 2019-12-31 2020-05-19 西安电子科技大学 一种基于信道状态信息室内无线定位方法、无线通信***
CN113376572A (zh) * 2021-05-31 2021-09-10 清华大学 网络定位方法、装置、电子设备和存储介质

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016112758A1 (zh) * 2015-01-15 2016-07-21 中兴通讯股份有限公司 终端的定位方法及装置
WO2017198037A1 (zh) * 2016-05-17 2017-11-23 安徽酷哇机器人有限公司 基于AoA的UWB定位***
CN110749859A (zh) * 2019-10-22 2020-02-04 清华大学 基于多载频的单基站阵列定位方法和装置
CN111182459A (zh) * 2019-12-31 2020-05-19 西安电子科技大学 一种基于信道状态信息室内无线定位方法、无线通信***
CN113376572A (zh) * 2021-05-31 2021-09-10 清华大学 网络定位方法、装置、电子设备和存储介质

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
李宝林;马东群;李都;江艳;: "一种基于行为和航迹特征的室内定位方法研究", 计算机应用与软件, no. 08, 15 August 2017 (2017-08-15) *
田增山;张千坤;周牧;王斌;: "基于CFR虚拟阵列天线的AOA室内定位", 电子学报, no. 06, 15 June 2018 (2018-06-15) *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118158609A (zh) * 2024-05-08 2024-06-07 厦门大学 一种多径信号多历元联合跟踪***和方法

Also Published As

Publication number Publication date
CN115150748B (zh) 2024-07-05

Similar Documents

Publication Publication Date Title
CN110118549B (zh) 一种多源信息融合定位方法和装置
AU2017233539B2 (en) Estimating locations of mobile devices in a wireless tracking system
CN107003378B (zh) 便携式电子装置和确定便携式电子装置的地理位置的方法
US9121711B2 (en) Environmental awareness for improved power consumption and responsiveness in positioning devices
Liu et al. Accelerometer assisted robust wireless signal positioning based on a hidden Markov model
CN109341679A (zh) 一种智能设备导航方法及导航***
Schatzberg et al. Enhanced WiFi ToF indoor positioning system with MEMS-based INS and pedometric information
US20220196787A1 (en) Wireless device localization
US9223006B2 (en) Method and device for localizing objects
Tian et al. HiQuadLoc: A RSS fingerprinting based indoor localization system for quadrotors
CN112529962A (zh) 一种基于视觉算法的室内空间关键定位技术方法
Bisio et al. WiFi meets barometer: Smartphone-based 3D indoor positioning method
CN115150748B (zh) 室内定位的方法、***、电子设备和存储介质
CN113534047A (zh) 设备定位方法和装置
CN110865333B (zh) 洋流影响下水下滑翔机单信标无源声学定位方法
CN113347709B (zh) 一种基于uwb的室内定位方法及***
CN110658515A (zh) 一种基于uwb单基站的多用户imu定位对齐方法
US11368809B2 (en) Single antenna direction finding and localization
CN110940334B (zh) 一种人体行走测速徽章及测速方法
US20230353980A1 (en) Determination and tracking of trajectories of moving objects in wireless applications
CN116027266A (zh) Uwb与视觉紧耦合slam算法的定位方法及***
Cui et al. Integrated WiFi/MEMS indoor navigation based on searching space limiting and self-calibration
CN112714396A (zh) 一种基于极坐标的定位方法及***
Zhang et al. Overview of Application Research on Inertial Navigation Unit
CN114928881B (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