一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

一种基于单站测距的偏差减小多维标度分析定位方法

2023-02-20 14:03:53 来源:中国专利 TAG:

技术特征:
1.一种基于单站测距的偏差减小多维标度分析定位方法,其特征在于:该方法具体包括以下步骤:步骤一:定义第m时刻观测站与目标之间的距离信息;步骤二:定义坐标矩阵如下:其中1
m
表示一个全为1的m
×
1维的向量,p=[p
x
,p
y
]
t
表示目标的位置信息,s表示m个时刻观测站的坐标集合矩阵:s=[s1,s2,...,s
m
]
t
s
m
=[s
m,x
,s
m,y
]
t
表示第m个时刻观测站的位置信息,m=1,2,...,m;定义的标量积矩阵v=xx
t
,矩阵v是一个秩为2的一个正定矩阵,矩阵v中各个元素表示为:其中d
m
与d
n
表示目标与第m与n个时刻观测站之间的距离,d
mn
表示第n个时刻观测站与第m个时刻观测站之间的距离,表示为:其中m,n=1,2,...,m;定义了多维相似伪线性模型:cz=0
m
其中c=va,[ ]

表示矩阵的伪逆表达,z=[1,p
x
,p
y
]
t
,0
m
表示一个元素全为零的m
×
1维向量;步骤三:在实际情况当中由于测量值是有偏的,那么导致多维相似伪线性模型也是有偏的,即:其中矩阵表示包含测量噪声的标量积矩阵,对标量积矩阵进行泰勒展开并忽略噪声高阶项得到:其中矩阵

v为标量积矩阵噪声分量的补偿矩阵,矩阵v
o
表示不含噪声的标量矩阵,其中矩阵

v表达式如下所示:即:即:
即:其中表示第m个时刻不含噪声的无偏测量值,q
m
表示测量误差;步骤四:建立优化函数表达式,如下所示:其中:其中:其中:其中:表示包含测量噪声c矩阵,其中a
m1
表示a矩阵第m行第1列的元素,d
m
表示第m个时刻观测站与目标之间的距离,其中m=1,2,...,m;将多维相似伪线性模型的目标定位问题转化为一个约束总体最小二乘问题,得到如下无约束优化表达式:其中w
p
=g1 p
x
g2 p
y
g3;步骤五:利用最小二乘目标估计方法对多维相似伪线性模型进行解算,求解目标的位
置信息:其中p
ls
表示多维相似伪线性最小二乘方法下目标估计值,a1表示矩阵a的第一列,a2表示矩阵a的后两列,表示含有测量噪声的标量积矩阵;步骤六:建立牛顿迭代算法的迭代公式,将多维相似伪线性最小二乘方法下目标估计值设为牛顿迭代算法的初值:其中p
n
表示牛顿迭代中n次的目标位置信息;梯度向量海森矩阵其中其中步骤七:将牛顿算法进行多次迭代,输出目标位置信息。2.根据权利要求1所述的一种基于单站测距的偏差减小多维标度分析定位方法,其特征在于:所述的定义第m时刻观测站与目标之间的距离信息,其表达式如下:但是在实际情况当中,测量是含有噪声的,那么上式为:但是在实际情况当中,测量是含有噪声的,那么上式为:表示第m个时刻实际测量值,其中测量噪声协方差矩阵为:q=e(qq
t
)=diag(σ2,σ2,...,σ2)
ꢀꢀ
(2)。上式q表示一个对角元素全为σ2的m
×
m维的对角矩阵,q表示噪声向量。3.根据权利要求1所述的一种基于单站测距的偏差减小多维标度分析定位方法,其特征在于:步骤七中迭代的次数为5-8次。

技术总结
本发明公开了一种基于单站测距的偏差减小多维标度分析定位方法。该方法首先根据测量值中观测站与目标之间的几何关系,建立了多维相似伪线性模型;接着设置优化函数,最后通过牛顿迭代算法进行求解。本发明方法是一种一般意义下的基于单站测距的定位方法,相较于传统的伪线性方法、极大似然方法具有更高的定位精度。度。度。


技术研发人员:王方舒 骆吉安
受保护的技术使用者:杭州电子科技大学
技术研发日:2022.11.08
技术公布日:2023/2/3
再多了解一些

本文用于创业者技术爱好者查询,仅供学习研究,如用于商业用途,请联系技术所有人。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献