CN111157947B - 一种基于最小二乘法的提高测距精度方法 - Google Patents
一种基于最小二乘法的提高测距精度方法 Download PDFInfo
- Publication number
- CN111157947B CN111157947B CN201911416460.1A CN201911416460A CN111157947B CN 111157947 B CN111157947 B CN 111157947B CN 201911416460 A CN201911416460 A CN 201911416460A CN 111157947 B CN111157947 B CN 111157947B
- Authority
- CN
- China
- Prior art keywords
- ranging
- equation
- improving
- observation
- square method
- 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
- 238000000034 method Methods 0.000 title claims abstract description 61
- 239000011159 matrix material Substances 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 13
- 238000005259 measurement Methods 0.000 claims description 4
- JXASPPWQHFOWPL-UHFFFAOYSA-N Tamarixin Natural products C1=C(O)C(OC)=CC=C1C1=C(OC2C(C(O)C(O)C(CO)O2)O)C(=O)C2=C(O)C=C(O)C=C2O1 JXASPPWQHFOWPL-UHFFFAOYSA-N 0.000 claims description 2
- 230000009286 beneficial effect Effects 0.000 abstract description 4
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
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/14—Determining absolute distances from a plurality of spaced points of known location
- G01S5/145—Using a supplementary range measurement, e.g. based on pseudo-range measurements
Abstract
本发明实施例提供的一种基于最小二乘法的提高测距精度方法,与现有技术相比,本发明的有益效果包含:本发明采集m颗卫星的坐标信息,建立非线性化的坐标方程,并按照预设方法将非线性化的坐标方程转换成线性化测距方程,然后利用最小二乘法来求解用户坐标,用户坐标经过若干次迭代计算之后,计算误差可以直至符合预设条件后,停止迭代,在本发明实施例中,迭代条件为Th=10‑6;以此来得到精确度的目标用户坐标,因此,本发明的算法可实现用户坐标的快速、高精度定位。
Description
技术领域
本发明涉及超宽带测距领域技术领域,特别是涉及一种基于最小二乘法的提高测距精度方法。
背景技术
目前广泛应用的定位方式为基站定位。基站定位主要应用于手机用户、GPS手持端等,例如中国移动动感地带提供的动感位置查询服务,谷歌手机地图等各类手机地图软件中的粗略定位,和GPS配合产生的A-GPS等等都是利用基站定位来实现的。但是上述基站定位的缺点是基站定位的精度较低以及GPS定位无法在室内使用。
基于上述,基于北斗系统精准定位的计算方法可以提高定位精度,实现对用户目标的准确定位。
发明内容
本发明实施例的目的在于提供一种基于最小二乘法的提高测距精度方法,以提高定位精度。具体技术方案如下:
本发明实施例提供了一种基于最小二乘法的提高测距精度方法,包括:
S110.获取m组待检测观测值;其中,所述待检测观测值为有卫星定位的目标用户坐标;
S120.设置非线性化的坐标方程,并设置非线性最小二乘迭代初始值;
S130.将所述初始值代入预设方程内,得到验测距误差ΔL
S140.计算所述待检测观测值的测距方向余弦向量u和观测矩阵H
S150.根据所述余弦向量u、所述观测矩阵H以及m组待检测观测值,将所述非线性化的坐标方程线性化,得到线性化测距方程;
S160.求解所述线性化测距方程,得到估计误差向量
S170.按照预设方法对所述估计误差向量进行更新迭代,并重复步骤S130步骤S160,直至符合预设条件,停止更新迭代;其中,所述预设条件为/>Th=10-6;
S180.符合所述预设条件的为所述待检测观测值的坐标。
可选的,所述初始值的表达式为或上一时刻的估计值,即/>
可选的,验测距误差ΔL的计算方法为:
假设TAG坐标的估计值是则对测距方程式在/>处进行一阶Taylor展开,得到:
令:
可选的,测距方向余弦向量u和观测矩阵H的计算方法为:
令:
可选的,利用m组待检测观测值,并舍去二阶及以上误差,则线性化测距方程为:
可选的,利用所述线性化测距方程计算验测距误差ΔL,得到:
其中,
可选的,所述估计误差向量的表达式为:
其中,H是观测矩阵,H为雅克比矩阵。
本发明实施例提供的一种基于最小二乘法的提高测距精度方法,与现有技术相比,本发明的有益效果包含:本发明采集m颗卫星的坐标信息,建立非线性化的坐标方程,并按照预设方法将非线性化的坐标方程转换成线性化测距方程,然后利用最小二乘法来求解用户坐标,用户坐标经过若干次迭代计算之后,计算误差可以直至符合预设条件后,停止迭代,在本发明实施例中,迭代条件为绝对值小于10-6;以此来得到精确度的目标用户坐标,因此,本发明的算法可实现用户坐标的快速、高精度定位。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍。
图1为本发明实施例提供的一种基于最小二乘法的提高测距精度方法的方法流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行描述。
为了解决现有技术中压力传感器精度较差的问题,本发明实施例提供了一种基于最小二乘法的提高测距精度方法。
第一方面,请参见图1,本发明实施例提供了一种基于最小二乘法的提高测距精度方法,包括:
S110.获取m组待检测观测值;其中,所述待检测观测值为有卫星定位的目标用户坐标;
S120.设置非线性化的坐标方程,并设置非线性最小二乘迭代初始值;
S130.将所述初始值代入预设方程内,得到验测距误差ΔL
S140.计算所述待检测观测值的测距方向余弦向量u和观测矩阵H
S150.根据所述余弦向量u、所述观测矩阵H以及m组待检测观测值,将所述非线性化的坐标方程线性化,得到线性化测距方程;
S160.求解所述线性化测距方程,得到估计误差向量
S170.按照预设方法对所述估计误差向量进行更新迭代,并重复步骤S130步骤S160,直至符合预设条件,停止更新迭代;其中,所述预设条件为/>Th=10-6;
S180.符合所述预设条件的为所述待检测观测值的坐标。
具体的,本发明实施例提供的一种基于最小二乘法的提高测距精度方法,与现有技术相比,本发明的有益效果包含:本发明采集m颗卫星的坐标信息,建立非线性化的坐标方程,并按照预设方法将非线性化的坐标方程转换成线性化测距方程,然后利用最小二乘法来求解用户坐标,用户坐标经过若干次迭代计算之后,计算误差可以直至符合预设条件后,停止迭代,在本发明实施例中,迭代条件为绝对值小于10-6;以此来得到精确度的目标用户坐标,因此,本发明的算法可实现用户坐标的快速、高精度定位。
进一步的,所述初始值的表达式为或上一时刻的估计值,即/>
进一步的,验测距误差ΔL的计算方法为:
假设TAG坐标的估计值是则对测距方程式在/>处进行一阶Taylor展开,得到:
令:
进一步的,测距方向余弦向量u和观测矩阵H的计算方法为:
令:
进一步的,利用m组待检测观测值,并舍去二阶及以上误差,则线性化测距方程为:
进一步的,利用所述线性化测距方程计算验测距误差ΔL,得到:
其中,
进一步的,所述估计误差向量的表达式为:
其中,H是观测矩阵,H为雅克比矩阵。
本发明实施例提供的一种基于最小二乘法的提高测距精度方法,与现有技术相比,本发明的有益效果包含:本发明采集m颗卫星的坐标信息,建立非线性化的坐标方程,并按照预设方法将非线性化的坐标方程转换成线性化测距方程,然后利用最小二乘法来求解用户坐标,用户坐标经过若干次迭代计算之后,计算误差可以直至符合预设条件后,停止迭代,在本发明实施例中,迭代条件为绝对值小于10-6;以此来得到精确度的目标用户坐标,因此,本发明的算法可实现用户坐标的快速、高精度定位。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相似要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相似相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。以上所述仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本发明的保护范围内。
Claims (7)
1.一种基于最小二乘法的提高测距精度方法,其特征在于,包括:
S110.获取m组待检测观测值;其中,所述待检测观测值为有卫星定位的目标用户坐标;
S120.设置非线性化的坐标方程,并设置非线性最小二乘迭代初始值;
S130.将所述初始值代入预设方程内,得到验测距误差ΔL
S140.计算所述待检测观测值的测距方向余弦向量u和观测矩阵H
S150.根据所述余弦向量u、所述观测矩阵H以及m组待检测观测值,将所述非线性化的坐标方程线性化,得到线性化测距方程;
S160.求解所述线性化测距方程,得到估计误差向量
S170.按照预设方法对所述估计误差向量进行更新迭代,并重复步骤S130步骤S160,直至符合预设条件,停止更新迭代;其中,所述预设条件为/>Th=10-6;
S180.符合所述预设条件的为所述待检测观测值的坐标。
2.根据权利要求1所述的基于最小二乘法的提高测距精度方法,其特征在于,所述初始值的表达式为或上一时刻的估计值,即/>
3.根据权利要求1所述的基于最小二乘法的提高测距精度方法,其特征在于,验测距误差ΔL的计算方法为:
假设TAG坐标的估计值是则对测距方程式在/>处进行一阶Taylor展开,得到:
令:
4.根据权利要求1所述的基于最小二乘法的提高测距精度方法,其特征在于,测距方向余弦向量u和观测矩阵H的计算方法为:
令:
5.根据权利要求1所述的基于最小二乘法的提高测距精度方法,其特征在于,利用m组待检测观测值,并舍去二阶及以上误差,则线性化测距方程为:
6.根据权利要求5所述的基于最小二乘法的提高测距精度方法,其特征在于,利用所述线性化测距方程计算验测距误差ΔL,得到:
其中,
7.根据权利要求6所述的基于最小二乘法的提高测距精度方法,其特征在于,所述估计误差向量的表达式为:
其中,H是观测矩阵,H为雅克比矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911416460.1A CN111157947B (zh) | 2019-12-31 | 2019-12-31 | 一种基于最小二乘法的提高测距精度方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911416460.1A CN111157947B (zh) | 2019-12-31 | 2019-12-31 | 一种基于最小二乘法的提高测距精度方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111157947A CN111157947A (zh) | 2020-05-15 |
CN111157947B true CN111157947B (zh) | 2023-08-08 |
Family
ID=70560305
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911416460.1A Active CN111157947B (zh) | 2019-12-31 | 2019-12-31 | 一种基于最小二乘法的提高测距精度方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111157947B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2113786A1 (en) * | 2008-04-30 | 2009-11-04 | GMV Aerospace and Defence S.A. | Method for autonomous determination of protection levels for GNSS positioning based on navigation residuals and an isotropic confidence ratio |
WO2018024751A1 (fr) * | 2016-08-02 | 2018-02-08 | Thales | Systeme et procede global de geolocalisation a partir de mesures de distances et de positions d'ancres imprecises |
CN110286395A (zh) * | 2019-07-11 | 2019-09-27 | 国网上海市电力公司 | 一种北斗系统定位精度计算方法 |
CN110501736A (zh) * | 2019-08-28 | 2019-11-26 | 武汉大学 | 利用视觉影像和gnss测距信号紧耦合定位系统与方法 |
-
2019
- 2019-12-31 CN CN201911416460.1A patent/CN111157947B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2113786A1 (en) * | 2008-04-30 | 2009-11-04 | GMV Aerospace and Defence S.A. | Method for autonomous determination of protection levels for GNSS positioning based on navigation residuals and an isotropic confidence ratio |
WO2018024751A1 (fr) * | 2016-08-02 | 2018-02-08 | Thales | Systeme et procede global de geolocalisation a partir de mesures de distances et de positions d'ancres imprecises |
CN110286395A (zh) * | 2019-07-11 | 2019-09-27 | 国网上海市电力公司 | 一种北斗系统定位精度计算方法 |
CN110501736A (zh) * | 2019-08-28 | 2019-11-26 | 武汉大学 | 利用视觉影像和gnss测距信号紧耦合定位系统与方法 |
Non-Patent Citations (1)
Title |
---|
郭秋英,胡振琪.GPS测码伪距绝对定位的几种算法.测绘科学.2005,(05),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN111157947A (zh) | 2020-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106772478B (zh) | 一种基于历元-星间差分约束的定位方法 | |
CN106885576B (zh) | 一种基于多点地形匹配定位的auv航迹偏差估计方法 | |
CN110031877B (zh) | 一种基于grnn模型的区域nwp对流层延迟改正方法 | |
CN108254766B (zh) | 一种卫星抗多径误差方法 | |
CN106324620A (zh) | 一种不依赖地表气象数据实时测量的对流层天顶延迟方法 | |
KR20180091372A (ko) | 레이더의 표적 위치 추적 방법 | |
CN110132281B (zh) | 一种基于询问应答模式的水下高速目标高精度自主声学导航方法 | |
CN107167119B (zh) | 投影变形的数据处理方法 | |
CN112034431A (zh) | 一种雷达和rtk的外参标定方法及装置 | |
CN101907705B (zh) | 通用的多源遥感影像几何校正模型联合平差方法 | |
CN111157947B (zh) | 一种基于最小二乘法的提高测距精度方法 | |
CN105094051B (zh) | 运动平台系统的平面定位补偿方法 | |
CN110207721B (zh) | 一种考虑残差分布的无效地形匹配结果识别方法 | |
CN107270943B (zh) | 一种相关两维的惯性导航落点精度评估方法 | |
CN110595479B (zh) | 一种基于icp算法的slam轨迹评估方法 | |
CN111208535B (zh) | 一种基于国际参考电离层总电子含量异常值修正的计算方法 | |
CA2675310C (en) | Method for evaluation of sensor measured values | |
CN107995684B (zh) | 提升位置指纹的wlan室内定位精度方法及系统 | |
US20220377499A1 (en) | Characterizing height above terrain confidence | |
CN112068099B (zh) | 基于误差补偿的多辐射源快速定位测速方法和装置 | |
CN109282816B (zh) | 一种利用三角形约束的测距定位误差抑制方法 | |
CN113821766A (zh) | 一种海洋声学导航系统误差改正方法 | |
CN107727096B (zh) | 基于有效节点筛选的auv地形匹配定位方法 | |
CN105259564B (zh) | 一种星载和差比幅单脉冲测向定位方法、装置及系统 | |
CN115379559A (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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20230704 Address after: 201000 Room 401 and Room 402, Building 5, No. 690 Bibo Road, China (Shanghai) Pilot Free Trade Zone, Pudong New Area, Shanghai Applicant after: Shanghai Xingsi Semiconductor Co.,Ltd. Address before: 710065 10th floor, block C, Xi'an National Digital publishing base, 996 Tiangu 7th Road, Yuhua Street office, high tech Zone, Xi'an City, Shaanxi Province Applicant before: XI'AN AEROSPACE HUAXUN TECHNOLOGY Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |