一般社団法人 電子情報通信学会
THE INSTITUTE OF ELECTRONICS,
INFORMATION AND COMMUNICATION ENGINEERS

信学技報
IEICE Technical Report
SANE2017-7 (2017-05)

自律分散型センサフュージョンのためのバイアス推定
マルチエージェント型バイアス推定法
古川 英俊†
† 株式会社東芝 インフラシステムソリューション社
〒 212–8581 川崎市幸区小向東芝町 1 番地
E-mail: †hidetoshi.furukawa@toshiba.co.jp
あらまし

目標を観測する複数センサがネットワークに接続されたセンサネットワークにおいてセンサフュージョン

arXiv:1707.09827v1 [cs.SY] 31 Jul 2017

を行う場合，センサのバイアスが追跡している目標の相関処理や統合処理の精度に影響を与える．このため，センサの
バイアスを推定・補償する方法として，センサからの観測値を一箇所に集めて，カルマンフィルタによりセンサフュー
ジョンとバイアス推定を同時に実施する方法が提案されている．一方，センサネットワークにおけるセンサフュージョ
ンの構成は，センサからの観測値を統合する集中型や，各センサの追跡フィルタで処理した航跡を統合する分散型の
ほか，集中管理機構を必要としない自律分散型も提案されている．本稿では，自律分散型センサフュージョンにおい
てバイアスを推定・補償するためのマルチエージェント型バイアス推定法を提案する．
キーワード

センサネットワーク，センサフュージョン，バイアス，マルチエージェント

Bias Estimation for Decentralized Sensor Fusion
Multi-Agent Based Bias Estimation Method
Hidetoshi FURUKAWA†
† Toshiba Corporation Infrastructure Systems & Solutions Company
1 Komukaitoshiba-cho, Saiwai-ku Kawasaki-shi, Kanagawa 212–8581, Japan
E-mail: †hidetoshi.furukawa@toshiba.co.jp
Abstract In multi-sensor data fusion (or sensor fusion), sensor biases (or oﬀsets) often aﬀect the accuracy of the
correlation and integration results of the tracking targets. Therefore, to estimate and compensate the bias, several
methods are proposed. However, most methods involve bias estimation and sensor fusion simultaneously by using
Kalman ﬁlter after collecting the plot data together. Hence, these methods cannot support to fuse the track data
prepared by tracking ﬁlter at each sensor node. This report proposes the new bias estimation method based on
multi-agent model, in order to estimate and compensate the bias for decentralized sensor fusion.
Key words sensor network, sensor fusion, bias, multi-agent
一方，センサネットワークにおけるセンサフュージョンの構成

1. は じ め に

は，図 1 に示すように，センサからの観測値を一箇所に集めて

目標を観測する複数センサがネットワークに接続されたセン

統合する集中型（centralized）のセンサフュージョンである観

サネットワーク（sensor network）においてセンサフュージョ

測値融合（plot fusion）や，各センサの追跡フィルタで処理した

ン（sensor fusion）を行う場合，センサのバイアス（bias）が

航跡（track）を一箇所に集めて統合する分散型（distributed）

追跡している目標の相関処理や統合処理の精度に影響を与える．

のセンサフュージョンである航跡融合（track fusion）のほか，

このため，センサのバイアスを推定・補償する方法として，文

集中管理機構を必要としない自律分散型（decentralized）のセ

献 [1] には，センサからの観測値（plot）を一箇所に集めて，カ

ンサフュージョンである航跡融合も示されている [2]．従来法

ルマンフィルタによりセンサフュージョンとバイアス推定を同

は，観測値融合を行う集中型センサフュージョン（centralized

時に実施する方法（以降，従来法と呼ぶ）が提案されている．

sensor fusion）に適用することはできるが，航跡融合を行う分

― 35 ―
This article is a technical report without peer review, and its polished and/or extended version may be published elsewhere.
Copyright ©2017 by IEICE

て捉え，N 個のセンサ Si (i ∈ {1, ..., N }) から構成されるセ

ンサネットワークにおいて，センサ Si に対応するエージェン

ト Ai が，グローバル座標系の目標状態ベクトルを，他センサ

Sj (j ∈ {1, ..., N }, j =
| i) に対応するエージェント Aj からの

同一目標のグローバル座標系の目標状態ベクトルに基づいて更
新するという局所的な相互作用により，大域的な機能として，
同一目標を媒体としてセンサネットワーク全体のバイアスを推
定・補償するものである [4], [5]．

3. 自律分散型センサフュージョンのためのバイ
アス推定
ここでは，図 2 に示す自律分散型センサフュージョンにおい
てバイアスを推定・補償するマルチエージェント型バイアス推
定法（以降，提案法と呼ぶ）について述べる．

3. 1 提案法の処理概要
N 個のセンサ Si から構成されるセンサネットワークにおい
て，センサ Si に対応するエージェント Ai は，センサ Si の位
置を座標原点とするローカル座標系と，全エージェントが共有
するグローバル座標系の 2 つの座標系を持ち，その処理概要は，
以下のとおりとなる．
センサ Si に対応するエージェント Ai は，センサ Si が観測
している目標 Tl (l ∈ {1, ..., L}) に対する時刻 tk−1 のバイアス
を考慮したグローバル座標系の目標状態ベクトル x̂il (k − 1) と

センサ Sj に対応するエージェント Aj からの目標 Tl のバイア

スを考慮したグローバル座標系の目標状態ベクトル x̂jl (k − 1)

を用いて，下式のように，時刻 tk−1 の相互作用を考慮したグ

ローバル座標系の目標状態ベクトル（以降，相互作用ベクトル
と呼ぶ）x̃il (k − 1) を算出する．

x̃il (k − 1) = x̂il (k − 1)

+ εl
aijl (x̂jl (k − 1) − x̂il (k − 1))

(1)

j

ここで，εl は重みを表す．また，aijl は，センサ Si とセンサ

図1

センサフュージョンの構成の分類

Fig. 1 Structures of sensor fusion.

散型センサフュージョン（distributed sensor fusion）や自律分
散型センサフュージョン（decentralized sensor fusion）に適用
することはできない．
本稿では，自律分散型センサフュージョンにおいてバイアス
を推定・補償するためのマルチエージェント型バイアス推定法
を提案する．

2. マルチエージェント型バイアス推定法
マルチエージェント型バイアス推定法とは，センサネット
ワーク全体を，複数エージェントの局所的な相互作用をもとに

図 2 提案法のシステム構成

大域的な機能を発現するマルチエージェントシステム [3] とし

Fig. 2 System structure of the proposed method.

― 36 ―

Sj が共に目標 Tl （すなわち，同一目標）を観測している場合

ここで，Δri (k) と Δθi (k) は，それぞれ距離系と角度系のバイ

は 1，その他は 0 とする．

アスの推定値を表す．

次に，センサ Si に対応するエージェント Ai は，センサ Si

このとき，式 (1) に対応し，センサ Si の目標 Tl に対する時

が観測している目標 Tl に対する時刻 tk−1 のグローバル座標

刻 tk のグローバル座標系の相互作用ベクトル x̃il (k) は，下式

系の相互作用ベクトル x̃il (k − 1)，同ローカル座標系の目標状

で表されるものとする．


x̃il (k)
x̃il (k) =
ỹil (k)

態ベクトル ŷil (k − 1)，センサ Si の時刻 tk−1 のグローバル座

標系のセンサ状態ベクトル zi (k − 1) を用いて，下式の逆問題

を解くことにより，センサ Si の時刻 tk−1 のバイアスベクトル

ここで，相互作用ベクトル x̃il (k) の要素である x̃il (k) と ỹil (k)

bi (k − 1) を推定する．
x̃il (k − 1) = f (ŷil (k − 1), zi (k − 1), bi (k − 1))

(7)

は，それぞれグローバル座標系の x 軸と y 軸の座標値を表す．

(2)

更に，センサ Si に対応するエージェント Ai は，センサ Si
が観測している目標 Tl に対する時刻 tk のローカル座標系の目

同様に，式 (3) に対応し，センサ Si の目標 Tl に対する時刻

tk のバイアスを考慮したグローバル座標系の目標状態ベクトル
x̂il (k) は，下式で表されるものとする．

標状態ベクトル ŷil (k)，センサ Si の時刻 tk のグローバル座標
系のセンサ状態ベクトル zi (k)，センサ Si の時刻 tk−1 のバイ
アスベクトル bi (k − 1) を用いて，下式のように，時刻 tk のバ

x̂il (k) =



x̂il (k)
ŷil (k)



(8)

イアスを考慮したグローバル座標系の目標状態ベクトル x̂il (k)

ここで，目標状態ベクトル x̂il (k) の要素である x̂il (k) と ŷil (k)

を算出する．

は，それぞれグローバル座標系の x 軸と y 軸の座標値を表す．
また，便宜上，変数の時刻を表すパラメータを省略し，相互

x̂il (k) = f (ŷil (k), zi (k), bi (k − 1))

(3)

提案法では，上記の処理を繰り返し実施することで，エー
ジェントが算出する同一目標のバイアスを考慮したグローバル
座標系の目標状態ベクトルを漸近的に一致させ，センサネット

作用ベクトル x̃il (k) または目標状態ベクトル x̂il (k) を xil で表
すと，xil = f (ŷil , zi , bi ) の変換は，下式となる．



xil
yil



=f

ワーク全体のバイアスを推定・補償する．

=

3. 2 提案法の処理内容の具体例
次に，距離系と角度系にバイアスが存在する移動しない 2 次
元センサから構成されるセンサネットワークを例に，提案法の
センサ Si のグローバル座標系のセンサ状態ベクトル zi (k)

zi (k) =

xi
yi

,

θil

xi
yi

 
,

Δri
Δθi



(ril − Δri ) sin (θil − Δθi ) + xi

(ril − Δri ) cos (θil − Δθi ) + yi

(9)



ここでセンサ数 N = 4，目標数 L = 4 として，センサ S1 が，
を観測している状況を例に，センサ S1 に対応するエージェン
ト A1 が行う処理内容を説明する．

は，下式で表されるものとする．



 

ril

センサ S2 と共に目標 T1 を観測し，センサ S4 と共に目標 T4

処理内容の具体例を述べる．







エージェント A1 は，グローバル座標系の相互作用ベクト

(4)

ここで，xi と yi は，それぞれグローバル座標系における x 軸
と y 軸の位置の座標値を表す．

ル x̃11 (k − 1) と x̃14 (k − 1) を算出する．グローバル座標系の
相互作用ベクトル x̃11 (k − 1) は，センサ S1 の目標 T1 に対す

るバイアスを考慮したグローバル座標系の目標状態ベクトル

x̂11 (k − 1) と，共に目標 T1 を観測しているセンサ S2 に対応

センサ Si が観測している目標 Tl に対する時刻 tk の（セン

するエージェント A2 が算出したバイアスを考慮したグローバ

サ Si の位置を座標原点とする）ローカル座標系の目標状態ベ

ル座標系の目標状態ベクトル x̂21 (k − 1) を用いて，下式で算出

クトル ŷil (k) は，下式で表されるものとする．

ŷil (k) =



ril (k)
θil (k)



する．

(5)

ここで，ril (k) は，距離系のバイアス（未知数）の影響を受け

x̃11 (k − 1) = x̂11 (k − 1)

+ ε1
a1j1 (x̂j1 (k − 1) − x̂11 (k − 1))
j

たセンサ Si から目標 Tl までの距離を表し，θil (k) は，角度系

= x̂11 (k − 1) + ε1 (x̂21 (k − 1) − x̂11 (k − 1))

のバイアス（未知数）の影響を受けたセンサ Si から目標 Tl へ

= (1 − ε1 ) x̂11 (k − 1) + ε1 x̂21 (k − 1)
(10)

の角度を表す．
また，センサ Si の時刻 tk のバイアスベクトル bi (k) は，下
式で表されるものとする．

bi (k) =



Δri (k)
Δθi (k)



同様に，グローバル座標系の相互作用ベクトル x̃14 (k − 1) は，

センサ S1 の目標 T4 に対するバイアスを考慮したグローバル座

(6)

標系の目標状態ベクトル x̂14 (k − 1) と，共に目標 T4 を観測し

ているセンサ S4 に対応するエージェント A4 が算出したバイア

― 37 ―

スを考慮したグローバル座標系の目標状態ベクトル x̂44 (k − 1)
を用いて，下式で算出する．

15
10
y (km)

x̃14 (k − 1) = x̂14 (k − 1)

a1j4 (x̂j4 (k − 1) − x̂14 (k − 1))
+ ε4
j

5
0

= x̂14 (k − 1) + ε4 (x̂44 (k − 1) − x̂14 (k − 1))

−5
−10 −5

= (1 − ε4 ) x̂14 (k − 1) + ε4 x̂44 (k − 1)
(11)

0

5

10

15

20

x (km)

次に，エージェント A1 は，算出したグローバル座標系の相
図 3 シミュレーション条件 1（センサと目標の配置）

互作用ベクトル x̃11 (k − 1) と x̃14 (k − 1)，ローカル座標系の目

Fig. 3 Simulation scenario 1.

標状態ベクトル ŷ11 (k − 1) と ŷ14 (k − 1)，センサ S1 のグロー
バル座標系のセンサ状態ベクトル z1 (k − 1) を用いて，下式の

逆問題を解くことにより，センサ S1 の時刻 tk−1 のバイアスベ

15

クトル b1 (k − 1) を推定する．

10

⎩ x̃

14

y (km)

⎧
⎨ x̃11 (k − 1) = f (ŷ11 (k − 1), z1 (k − 1), b1 (k − 1))
(k − 1) = f (ŷ14 (k − 1), z1 (k − 1), b1 (k − 1))

5
0

(12)

−5
−10 −5

更に，エージェント A1 は，センサ S1 が観測している目標

T1 と T4 に対する時刻 tk のローカル座標系の目標状態ベクト
ル ŷ11 (k) と ŷ14 (k)，センサ S1 のグローバル座標系のセンサ状
態ベクトル z1 (k)，センサ S1 の時刻 tk−1 のバイアスベクトル

0

5 10
x (km)

15

20

図 4 シミュレーション条件 2（センサと目標の配置）

b1 (k − 1) を用いて，センサ S1 のバイアスを考慮したグローバ

Fig. 4 Simulation scenario 2.

ル座標系の目標状態ベクトル x̂11 (k) と x̂14 (k) を算出する．

⎧
⎨ x̂11 (k) = f (ŷ11 (k), z1 (k), b1 (k − 1))
⎩ x̂

差は，平均 0 の白色正規雑音とし，標準偏差を距離系 10m，角

(13)

14 (k) = f (ŷ14 (k), z1 (k), b1 (k − 1))

度系 0.1◦ とする．

4. 2 シミュレーション結果

そして，それぞれのセンサに対応するエージェントが，上記

20 回のモンテカルロシミュレーションを実施し，RMS（Root
Mean Square）を評価する．

と同様の処理を繰り返し実施する．

シミュレーション条件 1 に対応するシミュレーション結果と

4. シミュレーション

して，グローバル座標系の目標状態ベクトル間の位置の差を図

距離系と角度系にバイアスが存在する 2 次元センサから構成

5，距離系と角度系のバイアス推定値の残差（バイアス推定値と

されるセンサネットワークを用いた数値シミュレーションによ

バイアス真値の差）を図 6 に示す．同様に，シミュレーション

り，提案法の基本機能を確認する．

条件 2 に対応するシミュレーション結果を図 7 と図 8 に示す．
図 5 と図 7 のシミュレーション結果から，バイアスを考慮し

4. 1 シミュレーション条件
シミュレーション条件 1 では，図 3 に示すように，2 次元空

たグローバル座標系の目標状態ベクトル間の位置の差（図中の

間のそれぞれ (0km, 0km) と (10km, 0km) に固定センサ S1 と

「w BC」）は，バイアスを考慮しないグローバル座標系の目標

S2 が配置され，それぞれ (0km, 5km) と (10km, 5km) の位置

状態ベクトル間の位置の差（図中の「w/o BC」）よりも，グ

にある固定目標 T1 と T2 に対して，センサ S1 と S2 が共に目標

ローバル座標系の目標状態ベクトル間の位置の差が小さくなっ

T1 と T2 を観測しているものとする．また，シミュレーション

ており，提案法のバイアス推定・補償の効果を確認できる．

条件 2 では，図 4 に示すように，2 次元空間のそれぞれ (0km,

また，図 6 のシミュレーション結果から，横軸の時間 tk が

0km) と (10km, 0km) に固定センサ S1 と S2 が配置され，そ

増加するにつれてバイアス推定値の残差が 0 に漸近しており，

れぞれ (0km, 10km) と (10km, 10km) の位置にある固定目標

バイアス推定値がバイアス真値に近づいている（すなわち、バ

T1 と T2 に対して，センサ S1 と S2 が共に目標 T1 と T2 を観

イアス推定・補正ができている）ことが分かる一方，図 8（特

測しているものとする．ここで，センサ S1 のバイアスの真値

に距離系の残差）からは，バイアス推定値がバイアス真値に近

◦

は距離系 10m，角度系 0.1 とし，センサ S2 のバイアスの真値
◦

は距離系 20m，角度系 0.2 とする．また，各センサの観測誤

づいておらず，バイアス補正ではなくバイアス補償となってい
ることが分かる．

― 38 ―

5. ま と め
本稿では，自律分散型センサフュージョンにおけるバイアス
の推定・補償を目的とし，センサネットワーク全体を複数エー
ジェントの局所的な相互作用をもとに大域的な機能を発現する
マルチエージェントシステムとして捉え，マルチエージェント
モデルを用いてセンサのバイアスを推定・補償する新しいバイ
アス推定法を提案した．
簡易なモデルを用いた計算機シミュレーションにより基本機
能の確認を行い，センサのバイアスを推定・補償できることを
確認した．
文

献

[1] B.A. van Doorn, H.A.P. Blom, “Systematic error estimation in multisensor fusion systems,” Proc. SPIE 1954, Signal and Data Processing of Small Targets 1993, pp.450-461,
Oct. 1993.
[2] 鏡慎吾，石川正俊，“センサフュージョン―センサネットワーク
の情報処理構造―，” 信学論 (A), vol.J88-A, no.12, pp.14041412, Dec. 2005．
[3] 東俊一，永原正章（編著），石井秀明，林直樹，桜間一徳，畑中
健志（共著），マルチエージェントシステムの制御，コロナ社，
2015．
[4] 古川英俊，“マルチエージェントモデルによる分散型バイアス誤
差推定，” 2016 信学ソ大，B-2-16．
[5] 古川英俊，“分散型センサデータ融合のためのバイアス誤差推
定―マルチエージェント型バイアス誤差推定法―，” 信学技報,
vol.116, no.252, SANE2016-41, pp.13-16, Oct. 2016．

― 39 ―

10

2

10

1

1

10

10

10

10
w/o BC
w BC

0

0

50

100

150

10

200

2

10

1

w/o BC
w BC

0

0

50

100

150

200

2

1

10

10

2

10
w/o BC
w BC

0

0

50

100

150

10

200

図 5 2 つのグローバル座標系の目標状態ベクトル間の位置の差

w/o BC
w BC

0

0

50

100

150

200

図 7 2 つのグローバル座標系の目標状態ベクトル間の位置の差

（シミュレーション条件 1）
Fig. 5 Diﬀerence between the two tracks

（シミュレーション条件 2）
Fig. 7 Diﬀerence between the two tracks

(simulation scenario 1).

(simulation scenario 2).

10

2

10

1

1

10

10

10

10

10

2

10

0

0

50

100

150

10

200

0

10

−1

10

−2

0

50

100

150

10

200

0

0

50

100

150

200

50

100

150

200

0

−1

−2

0

図 6 距離系と角度系のバイアス推定値の残差

図 8 距離系と角度系のバイアス推定値の残差

（シミュレーション条件 1）
Fig. 6 Residual error in estimated bias of range and angle

（シミュレーション条件 2）
Fig. 8 Residual error in estimated bias of range and angle

(simulation scenario 1).

(simulation scenario 2).

― 40 ―

