CN108919322A - 一种采用角度信息转换的定位解算方法 - Google Patents
一种采用角度信息转换的定位解算方法 Download PDFInfo
- Publication number
- CN108919322A CN108919322A CN201810756660.0A CN201810756660A CN108919322A CN 108919322 A CN108919322 A CN 108919322A CN 201810756660 A CN201810756660 A CN 201810756660A CN 108919322 A CN108919322 A CN 108919322A
- Authority
- CN
- China
- Prior art keywords
- value
- angle
- user
- base station
- user location
- 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
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
- 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
-
- 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
Abstract
本发明涉及一种采用角度信息转换的定位解算方法,属于定位导航技术领域。该方法根据用户与基站之间的测距值求解其对应的角度值,通过角度值的更新对用户位置坐标估计进行更新,在用户初始位置误差较大和多组测量权重值不同的情况下收敛速度快,提高了基于测距的定位系统的解算实时性,并且可以进一步改进为采用最陡下降法和Levenberg‑Marquard法实现,适合工程应用。
Description
技术领域
本发明涉及一种采用角度信息转换的定位解算方法,属于定位导航技术领域。
背景技术
在常见的基于测距信息的无线电定位系统中,通常以测距信息为基础,建立测距方程组,采用加权最小二乘等方法计算得到用户位置。然而传统测距方程的表示方法在不同测距信息权值不相同或者初始位置信息偏差较大时,需要迭代计算的时间长,影响了定位解算结果的实时性能。
发明内容
针对传统基于测距信息的无线电导航系统中测距方程组解算效率低的问题,本发明提出了一种采用角度信息转换的定位解算方法,将测距方程组的表示方式转换为角度信息,加快了定位迭代算法的收敛速度,提高了基于测距信息的无线电定位系统的实时性能。
本发明为解决其技术问题采用如下技术方案:
一种采用角度信息转换的定位解算方法,包括以下步骤:
(1)初始化用户位置
需要对被估用户位置进行初始值设定,同时获取用户和基站之间的无线电测距值;
(2)根据用户位置初始值和基站位置计算相应的角度值;
(3)计算角度值对应的加权用户位置坐标;
(4)计算加权用户位置情况下的用户与基站之间的距离与测距值的差值;
根据角度值和测距值进行加权计算后得到的位置即为加权用户位置,将此位置值与基站位置做差求得用户与基站之间的距离估计值,并将距离估计值与测距值进行做差;
(5)计算加权差值;
(6)判定加权差值是否低于阈值,如果是,则输出位置估计结果;
如果否,更新用户位置并回到步骤(2)进行迭代计算。
步骤(2)的具体过程如下:
根据用户位置x=[x y z]T和信号来源位置pi=[ai bi ci]T计算以用户为中心的坐标系的两个角度值,通过该角度值和测距值在三维空间内确定唯一的坐标,其中:x为位置坐标在直角坐标系下x轴的值;y为位置坐标在直角坐标系下y轴的值;z为位置坐标在直角坐标系下z轴的值;ai为信源位置坐标在直角坐标系下x轴的值;bi为信源位置坐标在直角坐标系下y轴的值;ci为信源位置坐标在直角坐标系下z轴的值。
所述角度值的计算式为:
||x-pi||cosθi=x-ai、其中:θi为矢量x-pi与x轴之间的夹角,为矢量x-pi与x轴构成的平面与XOY平面的夹角,|| ||代表L2范数
步骤(3)中所述计算角度值对应的加权用户位置坐标采用如下方法::
其中为测距方差,角度值θi、通过用户坐标值x与无线电测距信号基站位置pi采用角度计算公式求得。
步骤(5)中所述的计算加权差值,计算方式为:其中Δdi=||di-(x*-pi)||,di为第i组无线电测距值。
本发明的有益效果如下:
本发明提出了一种采用角度信息转换的定位解算方法,根据用户与基站之间的测距值求解其对应的角度值,通过角度值的更新对用户位置坐标估计进行更新,在用户初始位置误差较大和多组测量权重值不同的情况下收敛速度快,提高了基于测距的定位系统的解算实时性,并且可以进一步改进为采用最陡下降法和Levenberg-Marquard法实现,适合工程应用。
附图说明
图1是本发明的角度示意图。
图2是本发明的执行步骤流程图。
具体实施方式
下面结合附图对技术具体实施方式进行详细说明,其计算流程如图2所示,角度示意图如图1所示,主要包含以下步骤:
(1)初始化用户位置估计坐标x=[x y z]T,第i个无线电测距信号来源位置pi=[ai bi ci]T,其中:x为位置坐标在直角坐标系下x轴的值;y为位置坐标在直角坐标系下y轴的值;z为位置坐标在直角坐标系下z轴的值;ai为信源位置坐标在直角坐标系下x轴的值;bi为信源位置坐标在直角坐标系下y轴的值;ci为信源位置坐标在直角坐标系下z轴的值;
(2)根据角度换算关系||x-pi||cosθi=x-ai、 其中:θi为矢量x-pi与x轴之间的夹角,为矢量x-pi与x轴构成的平面与XOY平面的夹角,计算坐标值x与无线电测距信号基站位置pi对应的角度值θi、||||代表L2范数;
(3)设定有N组测距信息x,计算N组测距信息对应的加权位置估计值,
其中为第i组无线电测距信号的方差,di为第i组无线电测距值;
(4)根据公式Δdi=||di-(x*-pi)||计算用户位置估值x*与基站位置pi之间的距离与第i个无线电测距值di之间的差值Δdi;
(5)计算加权差值
(6)判定Δd是否低于预设阈值,如果低于阈值则跳出迭代,得到定位解;如果高于阈值,则将本次计算周期得到的x*赋值给用户估计坐标x,回到角度计算步骤(2)重新计算角度值θi、直至Δd低于阈值。
Claims (5)
1.一种采用角度信息转换的定位解算方法,其特征在于,包括以下步骤:
(1)初始化用户位置
需要对被估用户位置进行初始值设定,同时获取用户和基站之间的无线电测距值;
(2)根据用户位置初始值和基站位置计算相应的角度值;
(3)计算角度值对应的加权用户位置坐标;
(4)计算加权用户位置情况下的用户与基站之间的距离与测距值的差值;
根据角度值和测距值进行加权计算后得到的位置即为加权用户位置,将此位置值与基站位置做差求得用户与基站之间的距离估计值,并将距离估计值与测距值进行做差;
(5)计算加权差值;
(6)判定加权差值是否低于阈值,如果是,则输出位置估计结果;如果否,更新用户位置并回到步骤(2)进行迭代计算。
2.根据权利要求1所述的一种采用角度信息转换的定位解算方法,其特征在于,步骤(2)的具体过程如下:
根据用户位置x=[x y z]T和信号来源位置pi=[ai bi ci]T计算以用户为中心的坐标系的两个角度值,通过该角度值和测距值在三维空间内确定唯一的坐标,其中:x为位置坐标在直角坐标系下x轴的值;y为位置坐标在直角坐标系下y轴的值;z为位置坐标在直角坐标系下z轴的值;ai为信源位置坐标在直角坐标系下x轴的值;bi为信源位置坐标在直角坐标系下y轴的值;ci为信源位置坐标在直角坐标系下z轴的值。
3.根据权利要求2所述的一种采用角度信息转换的定位解算方法,其特征在于,所述角度值的计算式为:
||x-pi||cosθi=x-ai、
其中:θi为矢量x-pi与x轴之间的夹角,为矢量x-pi与x轴构成的平面与XOY平面的夹角,|| ||代表L2范数。
4.根据权利要求1所述的一种采用角度信息转换的定位解算方法,其特征在于:
步骤(3)中所述计算角度值对应的加权用户位置坐标采用如下方法::
其中为测距方差,角度值θi、通过用户坐标值x与无线电测距信号基站位置pi采用角度计算公式求得。
5.根据权利要求1所述的一种采用角度信息转换的定位解算方法,其特征在于:
步骤(5)中所述计算加权差值的计算方式为:其中Δdi=||di-(x*-pi)||,di为第i组无线电测距值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810756660.0A CN108919322B (zh) | 2018-07-11 | 2018-07-11 | 一种采用角度信息转换的定位解算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810756660.0A CN108919322B (zh) | 2018-07-11 | 2018-07-11 | 一种采用角度信息转换的定位解算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108919322A true CN108919322A (zh) | 2018-11-30 |
CN108919322B CN108919322B (zh) | 2022-07-08 |
Family
ID=64411711
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810756660.0A Active CN108919322B (zh) | 2018-07-11 | 2018-07-11 | 一种采用角度信息转换的定位解算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108919322B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111123323A (zh) * | 2019-12-31 | 2020-05-08 | 杭州电子科技大学 | 一种提高便携设备定位精度的方法 |
JPWO2022054257A1 (zh) * | 2020-09-11 | 2022-03-17 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101394672A (zh) * | 2008-10-30 | 2009-03-25 | 上海大学 | 基于多径散射信息的高精度无线定位方法及系统 |
CN102149192A (zh) * | 2011-01-25 | 2011-08-10 | 南京信息工程大学 | 一种基于移动台合作的蜂窝网络无线定位方法 |
CN103152695A (zh) * | 2013-02-04 | 2013-06-12 | 太原理工大学 | 基于td-scdma系统的井下人员精确定位方法 |
CN103558602A (zh) * | 2013-08-14 | 2014-02-05 | 西北工业大学 | 一种用于多基地声纳配置方式的模拟退火定位方法 |
CN107064878A (zh) * | 2017-06-28 | 2017-08-18 | 山东大学 | 一种基于高精度gps的声源定位方法及其实现系统 |
CN107479078A (zh) * | 2017-07-21 | 2017-12-15 | 武汉大学 | 铁路测量中大地坐标转换为独立平面坐标的方法及系统 |
CN107734638A (zh) * | 2017-11-17 | 2018-02-23 | 泉州市睿云智能科技有限公司 | 一种基于三角置心算法的定位方法及装置 |
-
2018
- 2018-07-11 CN CN201810756660.0A patent/CN108919322B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101394672A (zh) * | 2008-10-30 | 2009-03-25 | 上海大学 | 基于多径散射信息的高精度无线定位方法及系统 |
CN102149192A (zh) * | 2011-01-25 | 2011-08-10 | 南京信息工程大学 | 一种基于移动台合作的蜂窝网络无线定位方法 |
CN103152695A (zh) * | 2013-02-04 | 2013-06-12 | 太原理工大学 | 基于td-scdma系统的井下人员精确定位方法 |
CN103558602A (zh) * | 2013-08-14 | 2014-02-05 | 西北工业大学 | 一种用于多基地声纳配置方式的模拟退火定位方法 |
CN107064878A (zh) * | 2017-06-28 | 2017-08-18 | 山东大学 | 一种基于高精度gps的声源定位方法及其实现系统 |
CN107479078A (zh) * | 2017-07-21 | 2017-12-15 | 武汉大学 | 铁路测量中大地坐标转换为独立平面坐标的方法及系统 |
CN107734638A (zh) * | 2017-11-17 | 2018-02-23 | 泉州市睿云智能科技有限公司 | 一种基于三角置心算法的定位方法及装置 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111123323A (zh) * | 2019-12-31 | 2020-05-08 | 杭州电子科技大学 | 一种提高便携设备定位精度的方法 |
CN111123323B (zh) * | 2019-12-31 | 2022-04-01 | 杭州电子科技大学 | 一种提高便携设备定位精度的方法 |
JPWO2022054257A1 (zh) * | 2020-09-11 | 2022-03-17 | ||
WO2022054257A1 (ja) * | 2020-09-11 | 2022-03-17 | 三菱電機株式会社 | 測位システム、測位方法、および、測位プログラム |
JP7191278B2 (ja) | 2020-09-11 | 2022-12-16 | 三菱電機株式会社 | 測位システム、測位方法、および、測位プログラム |
GB2613716A (en) * | 2020-09-11 | 2023-06-14 | Mitsubishi Electric Corp | Positioning system, positioning method, and positioning program |
GB2613716B (en) * | 2020-09-11 | 2024-02-14 | Mitsubishi Electric Corp | Positioning system, positioning method, and positioning program |
Also Published As
Publication number | Publication date |
---|---|
CN108919322B (zh) | 2022-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Liu et al. | Kalman filter-based data fusion of Wi-Fi RTT and PDR for indoor localization | |
CN104048659B (zh) | 地图坐标系的转换方法和系统 | |
CN105813194B (zh) | 基于指纹数据库二次校正的室内定位方法 | |
CN109100731B (zh) | 一种基于激光雷达扫描匹配算法的移动机器人定位方法 | |
CN107044852B (zh) | 不平整状态下全站仪测量方法 | |
CN107490797B (zh) | 一种用于提高定位精度的伪卫星布局方法 | |
CN109917333B (zh) | 融合aoa观测量与tdoa观测量的无源定位方法 | |
CN108919322A (zh) | 一种采用角度信息转换的定位解算方法 | |
CN107820206B (zh) | 基于信号强度的非视距定位方法 | |
CN107271957B (zh) | 基于tdoa和toa的室内三维定位方法 | |
CN112469115B (zh) | 一种基于快速聚类多维标度fc-mds改进的无线传感器网络定位方法 | |
CN110996388B (zh) | 基于锚节点选择及随机抽样粒子群的DV-Hop定位方法 | |
CN112497223B (zh) | 涂敷机器人涂敷工艺参数的生成方法及装置 | |
CN111491366A (zh) | 基于无线通信基站修正目标三维定位方法、无线通信系统 | |
CN111397599A (zh) | 基于三角形匹配算法改进的iccp水下地磁匹配方法 | |
CN105279371B (zh) | 一种基于控制点的移动测量系统pos精度改善方法 | |
CN109341682B (zh) | 一种提高地磁场定位精度的方法 | |
CN109708631A (zh) | 一种基于手机模态识别的行人导航航向修正方法 | |
CN111982121A (zh) | 一种混合视距和非视距环境下的高精度定位方法 | |
CN109470251A (zh) | 一种用于组合导航系统中的部分反馈滤波方法 | |
CN109909999A (zh) | 一种获取机器人tcp坐标的方法和装置 | |
CN106526637A (zh) | 一种修正gps定位的方法及装置 | |
CN108924734B (zh) | 一种三维传感器节点定位方法及系统 | |
CN111609850B (zh) | 一种用于绳索悬挂式机器人定位补偿方法 | |
CN114245291A (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 |