没有合适的资源?快使用搜索试试~ 我知道了~
对于多传感器多目标跟踪问题,系统偏差对航迹融合精度有较大影响,因此在信息融合系统中,首先要对各传感器的系统偏差进行估计,而在含错误关联和观测野值的复杂环境下,传统系统偏差估计方法的性能会严重退化.对此,提出一种具有递推形式的近似最小一乘稳健估计算法,以减少异常噪声对偏差估计的不利影响.使用平方根平滑逼近函数替代最小一乘法的目标函数,基于牛顿方向及其秩1修正推导出该方法的递推求解框架.基于条件数分析,证明所提出算法的数值稳定性好于Huber方法.通过两个仿真算例,将所提出算法与已有其他算法进行对比验证.仿真结果表明,在含错误关联和观测野值的条件下,所提出算法可以改善偏差估计精度,并且明显好于已有的其他算法.
资源推荐
资源详情
资源评论
第 34卷 第 3期 控 制 与 决 策 Vol.34 No.3
2019年 3月 Control and Decision Mar. 2019
文章编号: 1001-0920(2019)03-0495-08 DOI: 10.13195/j.kzyjc.2017.1204
基于递推近似最小一乘的多传感器系统
偏差稳健估计算法
郭蕴华
1†
, 汪敬东
1
, 任文峰
1
, 胡 义
1
, 牟军敏
2
(1. 武汉理工大学 船舶动力工程技术交通行业重点实验室,
武汉 430063;2. 武汉理工大学 航运学院,武汉 430063)
摘 要: 对于多传感器多目标跟踪问题, 系统偏差对航迹融合精度有较大影响, 因此在信息融合系统中, 首先要对
各传感器的系统偏差进行估计, 而在含错误关联和观测野值的复杂环境下, 传统系统偏差估计方法的性能会严重
退化. 对此,提出一种具有递推形式的近似最小一乘稳健估计算法, 以减少异常噪声对偏差估计的不利影响. 使用
平方根平滑逼近函数替代最小一乘法的目标函数, 基于牛顿方向及其秩 1 修正推导出该方法的递推求解框架. 基
于条件数分析, 证明所提出算法的数值稳定性好于 Huber 方法. 通过两个仿真算例, 将所提出算法与已有其他算法
进行对比验证. 仿真结果表明, 在含错误关联和观测野值的条件下, 所提出算法可以改善偏差估计精度, 并且明显
好于已有的其他算法.
关键词: 偏差估计;传感器配准;最小一乘法;稳健估计;牛顿方向;秩1修正
中图分类号: TP212.9 文献标志码: A
Multi-sensor bias robust estimation based on recursive approximate least
absolute deviation
GUO Yun-hua
1†
, WANG Jing-dong
1
, REN Wen-feng
1
, HU Yi
1
, MOU Jun-min
2
(1. Key Lab of Marine Power Engineering & Technology of Ministry of Communications,Wuhan University of
Technology,Wuhan 430063,China;2. School of Navigation,Wuhan University of Technology,Wuhan 430063,
China)
Abstract: For the problem of multisensor-multitarget tracking, the sensor bias has g reat influence on the accuracy
of track fusion. Thus, the sensor bias should be estimated at first in the system of information fusion. However the
performance of the traditional methods of bias estimation will degrade dramatically in the complex environment that
exists the misassociations and observed outliers. Therefore, an algorithm of robust estimation based on the recursive
approximate least absolute deviation (RALAD) is proposed, aiming to decrease the adverse impacts of the misassociations
and observed outliers. A smooth approximate function in the square-root form is used to replace the least absolute cost
function, and the recursive framework is derived based on the Newton method and its rank-one modification. It is verified
by the condition number analysis that the proposed algorithm has better numerical stability than the Huber-based method.
Performance comparisons between the proposed and existing algor ithms are carried out through two simulation examples.
The results show that the proposed algorithm is obviously superior to the existing algorithms, and it can improve the
estimation accuracy significantly in the case of the misassociations and observed outliers.
Keywords: bias estimation;sensor registration;least absolute deviation;robust estimation;Newton direction;rank
one update
0
在目标跟踪领域, 多传感器信息融合被认为是
一种可以提高精度和可靠性的方法
[1]
. 但在实际工程
中, 由于传感器量测存在系统偏差, 可能导致融合性
能不升反降. 因此, 在信息融合过程中, 首先需要对系
统偏差进行估计, 常用的方法包括: EX 方法
[2]
、极大
收稿日期: 2017-09-13;修回日期: 2017-12-05.
基金项目: 国家自然科学基金项目 (51579201).
责任编委: 俞立.
作者简介: 郭蕴华 (1975−), 男, 教授, 博士, 从事信息融合及工程优化等研究;汪敬东 (1993−), 男, 硕士生, 从事信
息融合的研究.
†
通讯作者. E-mail: wtugyh@163.com.
496 控 制 与 决 策 第34卷
似然法
[3-4]
、基于贝叶斯的联合估计与辨识
[5]
等. 近年
来, Lan等
[6]
提出了基于最大期望的联合跟踪算法, 兼
顾了状态估计的误差和模型参数辨识的偏差; Yong
等
[7]
提出一种仅基于目标位置的偏差配准算法, 以得
到对目标机动性不敏感的估计结果; Taghavi 等
[8]
提
出一种适用于分布式跟踪系统的偏差估计算法, 该
算法不需使用滤波增益信息. 然而, 这些算法都是基
于最小二乘框架,当出现错误关联和观测野值时估计
精度会严重下降
[9]
. 为此, Du 等
[10]
提出一种针对角
度的广义最小二乘估计算法, 去掉了斜距离的估计,
从而提高了角度估计精度; Taghavi等
[11]
提出一种基
于三角剖分的针对角度偏差的估计算法, 可用于较大
噪声环境中; 田威等
[12]
提出一种基于最小平方中值
(LMedS) 的稳健估计器, 用于出现错误关联时的偏差
估计.
通常, 最小二乘法受野值影响较大, 稳健性较
差. 对此, 研究人员提出了稳健估计的方法. Huber
[13]
提出一种光滑的分段函数,用最小二乘法替换最小一
乘法中不可求导的部分, 以实现计算的稳健估计; 吴
昊等
[14]
提出了一种基于广义 M 估计的鲁棒滤波算
法以减小异常误差对非线性物理系统的影响; Chang
等
[15]
分析了 Huber、Hampel、IGG 等几种 M 估计算
法的性能,这些算法在含有突出干扰的情况下仍具有
较好的估计性能; Khodabandeh 等
[16]
提出一种 L
1
范
数估计算法, 将最小一乘问题等效为含等式约束的
线性规划问题, 使用 Dikin 法求解, 能得到较高精度,
但其时间复杂度仍然较大; Zeng 等
[17]
提出一种基于
三角模糊数的模糊最小一乘估计算法, 该算法具有
较好的稳健性; Liu 等
[18]
提出一种 L
1
范数的估计算
法, 将最小一乘问题转换为带二次等式约束的最小
化问题, 使用迭代阈值收缩算法 (ISTA)求解; Xu等
[19]
提出一种三角函数形式下的近似最小一乘函数, 但由
于tanh函数本身的性质, 该算法的稳健性反而受到影
响; Caccetta等
[20]
提出了一种具有全局二次收敛性质
的最小一乘近似函数.
利用文献 [20] 中的近似函数, 本文提出一种基
于递推近似最小一乘 (Recursion approximate least
absolute deviation, RALAD) 的多传感器偏差估计算
法. 该算法使 用 一个平方根 平 滑逼近函数 替 代最
小一乘 目标函数, 并 具有基于 牛顿法的 递推求解
框架. 通过 Monte-Carlo 仿真实验, 与 EX 算法、基于
Huber 的 M 估计算法、LMedS 算法进行对比分析. 仿
真结果表明, 本文算法可以提高偏差估计精度, 实时
性较好.
1 多传感器偏差估计模型
1.1 运动模型和测量模型
在以大地为基准的笛卡尔坐标系中, 目标的运动
模型可以描述为
X
k
= F X
k−1
+ v
k−1
. (1)
其中: X
k
= [x
k
y
k
z
k
˙x
k
˙y
k
˙z
k
]
T
; v
k−1
为过
程噪声, 假定其为零均值高斯白噪声, 其方差 Q
k
=
E[v
k
v
T
k
]; F 为状态转移矩阵.
考虑两个位置坐标为I、J 的传感器 i 和j 的多目
标跟踪场景. 对于第 l (l = 1, 2, · · · , N )个目标, 传感
器 i 在 k 时刻的量测为 Z
m
i,k,l
= [r
m
i,k,l
β
m
i,k,l
ϵ
m
i,k,l
]
T
,
kr
m
i,k,l
、β
m
i,j,k
和ϵ
m
i,k,l
分别为斜距离量测、方位角量测
和高低角量测. Z
m
i,k,l
在笛卡尔坐标系下的转换量测
为
Z
i,k,l
=
x
m
i,k,l
y
m
i,k,l
z
m
i,k,l
=
r
m
i,k,l
cosϵ
m
i,k,l
cosβ
m
i,k,l
r
m
i,k,l
cosϵ
m
i,k,l
sinβ
m
i,k,l
r
m
i,k,l
sinϵ
m
i,k,l
. (2)
应用泰勒展开式,并忽略高阶项,得到
Z
i,k,l
= HX
i,k,l
+ B
i,k.l
b
i
+ w
i,k,l
. (3)
其中: H = [I
3
O
3
];系统偏差b
i
= [∆r
i
∆β
i
∆ϵ
i
]
T
;
转换测量噪声w
i,k,l
为零均值高斯白噪声, 且R
i,k,l
=
E[w
i,k,l
w
T
i,k,l
];系统偏差转移矩阵B
i,k,l
可表示为
B
i,k,l
=
cosϵ
i,k,l
cosβ
i,k,l
−r
i,k,l
cosϵ
i,k,l
sinβ
i,k,l
cosϵ
i,k,l
sinβ
i,k,l
r
i,k,l
cosϵ
i,k,l
cosβ
i,k,l
sinϵ
i,k,l
0
→
←
−r
i,k,l
sinϵ
i,k,l
cosβ
i,k,l
−r
i,k,l
sinϵ
i,k,l
sinβ
i,k,l
r
i,k,l
cosϵ
i,k,l
. (4)
传感器 j 的测量方程同传感器 i, 不再复述. 在 k
时刻,可以构造差分量测方程
Z
k,l
= B
k,l
b + w
k,l
. (5)
其中: Z
k,l
= Z
i,k,l
−Z
i,k,l
+(I −J); B
k,l
= [B
i,k,l
−
B
j,k,l
]; b = [b
i
b
j
]
T
, b
i
和b
j
分别为两传感器系统偏
差; w
k,l
= w
i,k,l
− w
j,k,l
, 且 R
k,l
= E[w
k,l
w
T
k,l
] =
R
i,k,l
+ R
j,k,l
. 对于式 (5), 可以采用传统的最小二乘
法进行求解,其目标函数为
J(
ˆ
b) =
min
b
k
l
(Z
k,l
− B
k,l
ˆ
b)
T
R
−1
k,l
(Z
k,l
− B
k,l
ˆ
b). (6)
剩余7页未读,继续阅读
资源评论
weixin_38626984
- 粉丝: 5
- 资源: 922
上传资源 快速赚钱
- 我的内容管理 展开
- 我的资源 快来上传第一个资源
- 我的收益 登录查看自己的收益
- 我的积分 登录查看自己的积分
- 我的C币 登录后查看C币余额
- 我的收藏
- 我的下载
- 下载帮助
最新资源
资源上传下载、课程学习等过程中有任何疑问或建议,欢迎提出宝贵意见哦~我们会及时处理!
点击此处反馈
安全验证
文档复制为VIP权益,开通VIP直接复制
信息提交成功