CN110044357B - 一种室内高精度三维无线定位方法 - Google Patents

一种室内高精度三维无线定位方法 Download PDF

Info

Publication number
CN110044357B
CN110044357B CN201910321592.XA CN201910321592A CN110044357B CN 110044357 B CN110044357 B CN 110044357B CN 201910321592 A CN201910321592 A CN 201910321592A CN 110044357 B CN110044357 B CN 110044357B
Authority
CN
China
Prior art keywords
positioning
base stations
label
base station
server
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
CN201910321592.XA
Other languages
English (en)
Other versions
CN110044357A (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.)
Jilin Puluofeite Technology Co ltd
Changchun Institute of Applied Chemistry of CAS
Original Assignee
Jilin Puluofeite Technology Co ltd
Changchun Institute of Applied Chemistry of CAS
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 Jilin Puluofeite Technology Co ltd, Changchun Institute of Applied Chemistry of CAS filed Critical Jilin Puluofeite Technology Co ltd
Priority to CN201910321592.XA priority Critical patent/CN110044357B/zh
Publication of CN110044357A publication Critical patent/CN110044357A/zh
Application granted granted Critical
Publication of CN110044357B publication Critical patent/CN110044357B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation
    • 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
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-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/14Determining absolute distances from a plurality of spaced points of known location
    • 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

Abstract

一种室内高精度三维无线定位方法,包括下列步骤:首先运用往返到达时间RTTOA进行两两基站间的通信来测定飞行时间来确定基站间的距离;再运用往返到达时间RTTOA进行双向飞行时间的测量,计算出标签到基站的平均飞行时间;计算出信号从标签到各基站的传输时长,则标签到基站的距离为信号的传输时长和信号的传播速度的乘积;利用十轴运动姿态传感器算出三轴运动加速度、三轴角度、三轴磁场角度这三个参数,进行参数的解算;判断并剔除非临近基站的定位信息,获取标签的定位数据;将构建标的坐标系结合3D模拟环境,来完成定位以及定位在3D模拟环境中精准显示定位数据。本发明的定位方法可以有效的克服多径效应,在非视距环境中定位精度稳定在10cm左右。

Description

一种室内高精度三维无线定位方法
技术领域
本发明属于定位技术领域,尤其是涉及一种室内高精度三维无线定位方法。
背景技术
近年来,随着俄罗斯格洛纳斯定位系统、美国GPS定位系统、欧洲伽利略卫星定位系统,以及中国北斗定位系统的不断完善,定位精度越来越高,已经可以满足有室外定位要求的用户,但是室内环境中有很多区域,卫星信号无法到达,无法穿透厚重的墙壁,因此需要一种室内三维无线定位方法,但目前缺少成熟、精度高的室内三维无线定位方法。
现有的室内定位方法中,RFID定位的定位精度由基站的位置和布置密度决定,由欧几里得公式得到标签和基站的距离,因此计算量比较大;WLAN、Bluetooth定位和超声波定位容易受到外部噪声信号的干扰;红外线定位和视觉信息定位均为视距测距,易受室内环境影响比较大;还有以往的定位坐标系的建立均由人工对定位环境进行测算,然后将带有人为误差的基站定位数据输入计算机来构建定位坐标系,进而带来定位精度误差较大。
本发明是以机器学习为基础,并结合UWB定位和惯性测量技术定位的优良特点的一种室内高精度三维无线定位方法。
发明内容
本发明的目的:就是为了解决现有的定位方法在信号传输距离、非视距、易受环境干扰、功耗、人为误差以及标签和基站的算法运算量大而导致定位精度不高等方面存在的问题,采用往返到达时间RTTOA的测距算法,以机器学习为基础,再结合UWB定位和惯性测量技术定位的优良特性进行联合定位,依托于3D模拟环境来精准显示定位数据。
为实现上述发明目的,本发明提供一种室内高精度三维无线定位方法,其特征在于包括下列步骤:
1、首先运用往返到达时间RTTOA进行两两基站间的通信来测定基站间信号的飞行时间并传输至服务器,来确定基站间的距离,以便于确定N个基站的精准坐标,以其中一个基站为坐标原点,在服务器的定位服务系统上构建标签定位所需的坐标系;
2、再运用往返到达时间RTTOA进行双向飞行时间的测量,将标签和基站的时间信号传输至服务器,并计算出标签到基站的平均飞行时间;
3、在服务器上计算出信号从标签到各基站的传输时长为tn=(Tn-TN)/2,则标签到基站的距离为信号的传输时长tn和信号的传播速度VC的乘积;即D=tn*VC,其中,TN是基站处理信号的时长,Tn为第N个基站广播信号到达标签的时长;
4、利用十轴运动姿态传感器解算出标签的三轴运动加速度、三轴角度、三轴磁场角度这三个参数,并传输至服务器,再在服务器上进行标签的运动方向、速度、加速度参数的解算;
5、在服务器上判断并剔除非临近基站的定位信息,将临近基站的定位信息与十轴运动姿态传感器测算的定位信息进行基于机器学习定位的信息融合,获取标签的定位数据;
6、将步骤1中构建标的坐标系结合3D模拟环境,再将标签的定位数据、速度、运动方向在模拟环境中予以显示,以此来完成定位以及定位在3D模拟环境中精准显示定位数据。
进一步,所述步骤1中构建标签定位所需的坐标系的具体步骤如下:
a、首先运用往返到达时间RTTOA进行两两基站间的通信,双向测量基站间信号的飞行时间,上传至服务器;
b、在服务器上以其中一个基站为坐标原点,根据双向测量基站间信号的飞行时间,解算出基站间的距离,再根据三轴直角坐标系的特点,确定基站的精准坐标,然后以各基站的精准坐标为基础,建立三维直角坐标系。
进一步,所述步骤2中双向飞行时间测量的具体步骤如下:
a、由标签向周围的N个基站同时广播信号,当标签开始进行广播信号时则开始计时操作;
b、N个基站接收到标签的广播信号,此时N个基站分别进行计时操作,经过基站的处理后,改为由基站进行广播信号,在基站开始进行广播信号时结束计时,分别记录N个基站计时时长TN,并将TN上传至服务器;即基站从接收到标签的广播信号到基站开始进行广播信号时的处理时间;
c、标签接收到N个基站的广播信号,此时标签进行计次计时,即分别记录
第N个基站广播的信号到达标签时,标签计时的时长Tn,并将Tn上传至服务器。
进一步,所述步骤4中标签的运动方向、速度、加速度参数的解算具体步骤如下:
a、十轴运动姿态传感器测得三轴运动加速度、三轴角度、三轴磁场角度参数;
b、用三轴运动加速度解算出标签的运动速度、步长、加速度参数;
c、用三轴角度和三轴磁场两个参数解算出标签的运动方向。
所述的,获取标签的定位数据是为在服务器上基于机器学习定位的定位数据和十轴运动姿态传感器的测算数据进行信息融合处理,以便于进一步缩小单个方法解算造成的定位误差,优化后的定位数据。
本发明方法首先运用往返到达时间RTTOA进行两两基站间的通信来测定基站间的距离,避免了由人工进行测量所带来的误差;运用往返到达时间RTTOA进行双向测量飞行时间,避免了标签和基站之间时钟不同步带来的定位误差,而且服务器承担了大部分算法的计算工作,降低了标签和基站的计算复杂度,因此大大降低了定位错误发生的概率,提高了定位效率,同时也降低了下位机因计算量大而产生的功耗问题;而基于机器学习的定位算法也大大降低了编程人员的编程难度;并运用十轴运动姿态传感器测算的数据进行基于机器学习定位的信息融合,并将定位数据在3D模拟环境中精准显示,使得人机交互界面更加友好化,有效地提升了三维定位精度。通过应用试验比较,现有的室内定位方法在非视距环境中定位精度受多径效应的影响,定位精度严重下降,只能达到25-30cm左右的定位精度,乃至定位系统失效;而本发明的定位方法可以有效的克服多径效应,在非视距环境中定位精度稳定在10cm左右。
附图说明
图1是根据本发明具体实施方式的流程图。
具体实施方式
参见图1:一种室内高精度三维无线定位方法包括:
步骤101:测定基站间的信号平均飞行时间。
具体的,首先利用DWM1000模块运用往返到达时间RTTOA进行两两基站间的通信,用以测定基站间信号的飞行时间,并传输至服务器,来确定基站间的距离;所述的服务器包括计算机和无线路由器。
步骤102:利用服务器建立定位坐标系;
具体的,由测得的基站间的距离来确定八个基站的精准坐标,在服务器的定位服务系统上构建标签定位所需的坐标系;
步骤103:测定标签到基站间的信号平均飞行时间;
具体的,由标签向周围的正整数N个基站同时广播信号,当标签开始进行广播信号时则开始计时操作;N个基站接收到标签的广播信号,此时N个基站分别进行计时操作,经过基站的处理后,改为由基站进行广播信号,在基站开始进行广播信号时结束计时,分别记录N个基站计时时长TN,并将TN上传至服务器;标签接收到N个基站的广播信号,此时标签进行计次计时;标签计时的时长Tn,并将Tn上传至服务器。在服务器上计算出信号从标签到各基站的传输时长为tn=(Tn-TN)/2,则标签到基站的距离为信号的传输时长tn和信号的传播速度VC的乘积。即D=tn*VC,其中,TN是基站处理信号的时长,Tn为第N个基站广播信号到达标签的时长;再利用平均飞行时间选择临近基站,以便于定位系统确认标签的大体位置。
步骤104:十轴运动姿态传感器模块测算相关数据;
具体的,利用十轴运动姿态传感器模块通过动力学解算和卡尔曼滤波实时解算出标签的三轴运动加速度、三轴角度、三轴磁场角度,并传输至服务器,再在服务器上进行标签的运动方向、速度、加速度参数的解算;
具体的,用三轴运动加速度解算出标签的运动速度、步长、加速度参数;用三轴角度和三轴磁场两个参数解算出标签的运动方向;
步骤105:利用服务器解算出标签的定位坐标;
具体的,在服务器上计算出标签与N个临近基站固定距离差,并根据固定距离差利用机器学习进行位置坐标的解算;
步骤106:进行基于机器学习定位的信息融合;
具体的,将基于步骤105得到的机器学习定位的定位数据和步骤104得到的十轴运动姿态传感器模块测算标签的运动方向、速度、加速度参数基于改进的Kalman松组合方式实现两个系统的信息融合,由十轴运动姿态传感器测算的数据对机器学习定位的定位数据通过Kalman松组合方式进行误差修正,从而实现基于机器学习定位的信息融合。
步骤107:构造模拟环境,并将相关的定位数据在模拟环境中予以显示。
具体的,利用虚拟现实技术构建出室内现实环境的三维室内模拟环境,首先利用AutoCAD建立精度较高的室内环境模型以及实验设备和物品的三维模型,再输入到3DS MAX中逐步调整各模型的属性,使之更加真实的显示。最后将模型数据转化成定位系统使用的模拟环境格式,并在定位系统内将模拟环境与步骤102建立的定位坐标系进行融合处理,并将定位数据在模拟环境中予以显示运动方向、速度、及速度、坐标、高度参数在模拟环境中予以显示。
步骤108:输出定位模型。

Claims (3)

1.一种室内高精度三维无线定位方法,其特征在于:所述方法包括以下步骤:
(1)首先运用往返到达时间RTTOA进行两两基站间的通信来测定基站间信号的飞行时间并传输至服务器,来确定基站间的距离,以便于确定N个基站的精准坐标,以其中一个基站为坐标原点,在服务器的定位服务系统上构建标签定位所需的坐标系;
(2)再运用往返到达时间RTTOA进行双向飞行时间的测量,将标签和基站的时间信号传输至服务器,并计算出标签到基站的平均飞行时间;
(3)在服务器上计算出信号从标签到各基站的传输时长为tn=(Tn-TN)/2,则标签到基站的距离为信号的传输时长tn和信号的传播速度VC的乘积;即D=tn*VC,其中,TN是基站处理信号的时长,Tn为第N个基站广播信号到达标签的时长;
(4)利用十轴运动姿态传感器解算出标签的三轴运动加速度、三轴角度、三轴磁场角度这三个参数,并传输至服务器,再在服务器上进行标签的运动方向、速度、加速度参数的解算;
(5)在服务器上判断并剔除非临近基站的定位信息,将临近基站的定位信息与十轴运动姿态传感器测算的定位信息进行基于机器学习定位的信息融合,获取标签的定位数据;
(6)将步骤1中构建标的坐标系结合3D模拟环境,再将标签的定位数据、速度、运动方向在模拟环境中予以显示,以此来完成定位以及定位在3D模拟环境中精准显示定位数据;
其中,所述步骤2中双向飞行时间测量的具体步骤如下:
a、由标签向周围的N个基站同时广播信号,当标签开始进行广播信号时则开始计时操作;
b、N个基站接收到标签的广播信号,此时N个基站分别进行计时操作,经过基站的处理后,改为由基站进行广播信号,在基站开始进行广播信号时结束计时,分别记录N个基站计时时长TN,并将TN上传至服务器;即基站从接收到标签的广播信号到基站开始进行广播信号时的处理时间;
c、标签接收到N个基站的广播信号,此时标签进行计次计时,即分别记录
第N个基站广播的信号到达标签时,标签计时的时长Tn,并将Tn上传至服务器。
2.根据权利要求1所述的一种室内高精度三维无线定位方法,其特征在于:所述步骤1中构建标签定位所需的坐标系的具体步骤如下:
a、首先运用往返到达时间RTTOA进行两两基站间的通信,双向测量基站间信号的飞行时间,上传至服务器;
b、在服务器上以其中一个基站为坐标原点,根据双向测量基站间信号的飞行时间,解算出基站间的距离,再根据三轴直角坐标系的特点,确定基站的精准坐标,然后以各基站的精准坐标为基础,建立三维直角坐标系。
3.根据权利要求1所述的一种室内高精度三维无线定位方法,其特征在于:
所述步骤4中标签的运动方向、速度、加速度参数的解算具体步骤如下:
a、十轴运动姿态传感器测得三轴运动加速度、三轴角度、三轴磁场角度参数;
b、用三轴运动加速度解算出标签的运动速度、步长、加速度参数;
c、用三轴角度和三轴磁场两个参数解算出标签的运动方向。
CN201910321592.XA 2019-04-22 2019-04-22 一种室内高精度三维无线定位方法 Active CN110044357B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910321592.XA CN110044357B (zh) 2019-04-22 2019-04-22 一种室内高精度三维无线定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910321592.XA CN110044357B (zh) 2019-04-22 2019-04-22 一种室内高精度三维无线定位方法

Publications (2)

Publication Number Publication Date
CN110044357A CN110044357A (zh) 2019-07-23
CN110044357B true CN110044357B (zh) 2023-02-24

Family

ID=67278130

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910321592.XA Active CN110044357B (zh) 2019-04-22 2019-04-22 一种室内高精度三维无线定位方法

Country Status (1)

Country Link
CN (1) CN110044357B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110426725B (zh) * 2019-07-29 2021-05-04 阎祯祺 一种精确定位室内用户移动终端的方法
CN112180321B (zh) * 2020-08-21 2022-12-27 天津市山石机器人有限责任公司 应用于3d定位系统操控坐标系相对位置的调整方法
CN113800395B (zh) * 2021-08-25 2023-10-31 南京沃旭通讯科技有限公司 一种基于六轴传感器的多元运动绑定方法
CN114449441B (zh) * 2022-01-18 2024-03-19 广东电网有限责任公司 一种电能表库房定位方法、装置、电子设备及存储介质
CN114578286B (zh) * 2022-05-09 2022-09-20 江苏多飞网络科技有限公司 一种商品入库的监督方法与系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20020092718A (ko) * 2001-06-05 2002-12-12 주식회사 네비콤 지피에스 단말기 및 무선통신 단말기에 대한 측위 방법
CN105657668A (zh) * 2016-03-16 2016-06-08 南通大学 一种基于uwb的室内移动机器人定位与导航控制方法
WO2017092180A1 (zh) * 2015-12-01 2017-06-08 中国矿业大学 一种惯性导航与激光扫描融合的采煤机定位装置及方法
CN107817469A (zh) * 2017-10-18 2018-03-20 上海理工大学 基于非视距环境下超宽频测距实现室内定位方法
CN109341683A (zh) * 2018-06-29 2019-02-15 中国人民解放军海军工程大学 基于uwb双标签的航向计算及其性能分析方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI626857B (zh) * 2017-06-06 2018-06-11 立創智能股份有限公司 無線定位系統

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20020092718A (ko) * 2001-06-05 2002-12-12 주식회사 네비콤 지피에스 단말기 및 무선통신 단말기에 대한 측위 방법
WO2017092180A1 (zh) * 2015-12-01 2017-06-08 中国矿业大学 一种惯性导航与激光扫描融合的采煤机定位装置及方法
CN105657668A (zh) * 2016-03-16 2016-06-08 南通大学 一种基于uwb的室内移动机器人定位与导航控制方法
CN107817469A (zh) * 2017-10-18 2018-03-20 上海理工大学 基于非视距环境下超宽频测距实现室内定位方法
CN109341683A (zh) * 2018-06-29 2019-02-15 中国人民解放军海军工程大学 基于uwb双标签的航向计算及其性能分析方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于RFID技术的位置感知中定位方法概述;付志学等;《山东工业技术》;20141115(第21期);全文 *
基于区域判定的超宽带井下高精度定位;方文浩等;《计算机应用》;20180316(第07期);全文 *

Also Published As

Publication number Publication date
CN110044357A (zh) 2019-07-23

Similar Documents

Publication Publication Date Title
CN110044357B (zh) 一种室内高精度三维无线定位方法
CN105526934B (zh) 一种室内外一体化高精度定位导航系统及其定位方法
CN109282811B (zh) Uwb与智能手机互联的室内外定位系统与方法
CN107817469B (zh) 基于非视距环境下超宽频测距实现室内定位方法
Shi et al. Anchor self-localization algorithm based on UWB ranging and inertial measurements
CN110446159A (zh) 一种室内无人机精确定位与自主导航的系统及方法
CN1981206B (zh) 使用超声波的定位系统和用于控制其的方法
CN102997846B (zh) 基于工作空间测量定位系统的飞机全机水平测量方法
CN105578417A (zh) 一种移动中的人员的室内定位方法
CN110026993B (zh) 一种基于uwb及热释电红外传感器的人体跟随机器人
CN103206952A (zh) 定位方法及装置
US10048058B2 (en) Data capture system for texture and geometry acquisition
US10976407B2 (en) Locating radio transmission source by scene reconstruction
CN105182319A (zh) 一种基于射频和双目视觉的目标定位系统及方法
CN108008433A (zh) 基于uwb和gps技术的室外室内无缝对接定位系统
WO2017049940A1 (zh) 室内空间测量定位网络动态坐标测量多站数据同步方法
CN104237846A (zh) 自主式移动对象室内三维定位跟踪系统与方法
Tian et al. Research on indoor positioning system based on UWB technology
Hu et al. Accuracy improvement of indoor real-time location tracking algorithm for smart supermarket based on ultra-wideband
CN110309883A (zh) 一种基于视觉slam的无人机自主定位方法
CN106767830A (zh) 一种转发式室内定位设备及定位方法
CN107356902B (zh) 一种WiFi定位指纹数据自动采集方法
CN105607054A (zh) 收发一体式超宽带飞行雷达定时采样探测方法
CN113190113A (zh) 超宽带定位的虚拟现实系统及实现位置和方向的定位方法
CN206876184U (zh) 一种基于rssi和惯性导航的室内定位装置

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