data fusion in sensor networks - association for...
TRANSCRIPT
1
Hugh Durrant-Whyte1 IPSN April 2005 Hugh Durrant-Whyte2 IPSN April 2005
Data Fusion in Sensor Networks
Hugh Durrant-WhyteARC* Federation Fellow
ARC* Centre of Excellence for Autonomous SystemsThe University of Sydney, Australia
*ARC=Australian Research Council
Hugh Durrant-Whyte3 IPSN April 2005
Overview
• Decentralised Sensor Networks• Data Fusion in Decentralised Networks
• Structure of the problem• The essential DDF algorithm: SKIDS• Communication and Model Distribution: ISSS, OxNav• Timing and UAV demonstration: ANSER• The general Bayesian DDF: ANSER II
• Management and Control in Sensor Networks• Sensor Management• Trajectory Control• Search and Exploration
• Future Challenges
Hugh Durrant-Whyte4 IPSN April 2005
Decentralised Sensor Networks
• Endogenous Systems:• No central fusion• No central comms.• No global network
knowledge • Probabilistic Algorithms
• Tracking• Navigation• Bayes estimation
Sensor Node
Sensor
Fusion Processor
Communications Medium
Hugh Durrant-Whyte5 IPSN April 2005
Decentralised Data Fusion (DDF)
• State and state models• Observations and likelihood models• Distributed and decentralised estimation• The DDF algorithm
Hugh Durrant-Whyte6 IPSN April 2005
Data Fusion: State
• A track: of position and velocity for example• A field property: temperature/pressure field for example• A discrete property: Identity or label for example
tttt iit ≤≤= 0|)(),( xXx
A State is a shared across sensor nodes
2
Hugh Durrant-Whyte7 IPSN April 2005
Data Fusion: Observations
• A track observation: range, bearing, velocity for example• A local field observation: temperature/pressure for example• A discrete observation: presence/absence for example
tttt iitjj ≤≤= 0|)(),( zZz
An Observation is local to a sensor node
Njtj
t ∈= |ZZ
Hugh Durrant-Whyte8 IPSN April 2005
Data Fusion: The Sensor Model
( ))(|)( ttP j xz
( ))()(|)( txttP j =xz
Model Generation
( ))(|)()( ttztP jj xz =
Model Inference
( )xz |jP)(tjz ( ))(tj xΛ
Sensor Model couples local observations to common global state
Hugh Durrant-Whyte9 IPSN April 2005
Data Fusion: The State Model
( ))(|)( 1−ii ttP xx
State Model couples immediate states to global states
Temporal Encoding
( )11)(|)( −− = iii xttP xx
i-1 i
Structural Encoding
( )iij xP =xx |j
i
j
Hugh Durrant-Whyte10 IPSN April 2005
Data Fusion: The Essential Problem
( ) ( ) ( )∏ == −
jkjj
kk
kk tzPtPCtP )(||)(.|)( 1 xzZxZx
Observation Update
( ) ( ) ( ) )(|)()(|)(|)( 11
111
−−
−−− ∫= k
kkkk
kk tdtPttPtP xZxxxZx
Time/Structure Update
Conditional Independence of ObservationsRequire Marginal State at current time
Distributed and Decentralised versions of these equations can be constructed with superficial ease
Hugh Durrant-Whyte11 IPSN April 2005
Data Fusion: Distributed Sensing
...... ......
X
z1 znzi
Fusion Centre
P(zi|x)
Sensor i
P(z1|x)
Sensor 1
P(zn|x)
Sensor n
Λ1(x) Λi(x) Λn(x)
P(x|Zn)=C P(x) Π Λi(x)n
i=1
P(x)
Hugh Durrant-Whyte12 IPSN April 2005
Data Fusion: Distributed Fusion
......
X
z1 zn
Fusion Centre
P(z1|x)
Sensor 1
P(xk|z1)
P1(xk|z)
P(zn|x)
Sensor n
P(xk|zn)
Pn(xk|z)P(xk|Zn)
P(xk|Zn)=C P(xk-1) Πn
i=1
Pi(xk|z)P(xk-1|Zn)
k k-1
3
Hugh Durrant-Whyte13 IPSN April 2005
Data Fusion: Decentralised Fusion
......
X
z1 zn
P(z1|x)
Sensor 1
P(xk|z1)
P1(xk|z)
P(zn|x)
Sensor n
P(xk|zn)
Pn(xk|z)
P(xk|Zn)
Fusion Centre
P(xk|Zn)=C P(xk-1) Πn
i=1
Pi(xk|z)P(xk-1|Zn)
k k-1 Fusion Centre
P(xk|Zn)=C P(xk-1) Πn
i=1
Pi(xk|z)P(xk-1|Zn)
k k-1
P(xk|Zn)
Hugh Durrant-Whyte14 IPSN April 2005
Decentralised Data Fusion: The Linear Gaussian Case
( )Q0w ,)( Nk →)()1()( kkk GwFxx +−=
( ):)1(|)( −kkP xx
( )jj Nk R0v ,)( →)()()( kkk jjj vxHz +=
( ):)(|)( kkP j xz
( ) ( ))|(),|(ˆ);(|)( qpqppNpP q PxxZx →
Hugh Durrant-Whyte15 IPSN April 2005
The Information Filter
Bayes:
Log-Likelihood:
(Fisher or Canonical) Information Form:
( ) ( ) ( )∏−=j
jkk kkzPkPCkP )(|)(|)(.|)( 1 xZxZx
( ) ( ) ( ) KkkzPkPkPj
jkk ++= ∑− )(|)(ln|)(ln|)(ln 1 xZxZx
)|()|( 1 kkkk −= PY jjTjj k HRHI 1)( −=
)|(ˆ)|()|(ˆ 1 kkkkkk xPy −= )()( 1 kk jjTjj zRHi −=
Hugh Durrant-Whyte16 IPSN April 2005
The Information Filter
Observation updates are simple sums (unlike KF):
∑+−=j
j kkkkk )()1|(ˆ)|(ˆ iyy
∑+−=j
j kkkkk )()1|()|( IYY
[ ])()|()|(ˆ)|(ˆ)|1(ˆ kkkkkkkkk BuYyΩyy ++=+
)()()()|()|1( kkkkkkk TΩΣΩYY −=+
Time/Structure updates are Dual to state (KF) Observation Updates :
Hugh Durrant-Whyte17 IPSN April 2005
Implementation of the Decentralised Information Filter
Σ in(k), In(k)
zn(k)
k k-1
HTR-1n n
Prediction
yn(k|k-1), Yn(k|k-1)^
yn(k|k), Yn(k|k)~ ~
Sensor node nΣ
~[y1(k|k)-y1(k|k-1)]
Σ i1(k), I1(k)
z1(k)
HTR-111
Prediction
Sensor node 1
Σy1(k|k-1), Y1(k|k-1)^
y1(k|k), Y1(k|k)~~
k k-1
Σ i2(k), I2(k)
z2(k)
k k-1
HTR-12 2y2(k|k), Y2(k|k)~ ~
y2(k|k-1), Y2(k|k-1)^Prediction
Sensor node 2
Σ
~[y2(k|k)-y2(k|k-1)]
~[yn(k|k)-yn(k|k-1)]
Hugh Durrant-Whyte18 IPSN April 2005
SKIDS
• “European First Framework” Project 1986-1991: Distributed/Decentralised Tracking in Civilian Environments
• Sensors• Multiple cameras each with embedded
processing• Optical barriers, acoustic sensing
• Algorithms• DDF position/velocity tracking• Distributed data association and identification• Fully connected
4
Hugh Durrant-Whyte19 IPSN April 2005
SKIDS (1989 Demo)
Hugh Durrant-Whyte20 IPSN April 2005
Three Issues Arising From SKIDS
• Communication:• Non-fully connected networks• Time-varying and ad-hoc networks• Communications management
• Modelling States:• Partial and distributed models at nodes• Estimation of field-like properties• Non-Gaussian posteriors
• Control:• Sensor Placement• Sensor Management
Hugh Durrant-Whyte21 IPSN April 2005
Communication: Operation of Sensor Nodes
• Nodes fuse information from:• Local observations, Local predictions, and • Communicated information
• Focus on Channels (the Channel Filter):• Communicate local information gain• Assimilate information gains from neighbourhood
Σ
Σ
i(k)
yi(k|k)
yi(k|k-1)
yi(k|k)~∆ypj(k|k)
Channel Filters
Prediction
Preprocess
∆ypi(k|k)
ChannelManager
Sensor Node ∆yqj(k|k)
Hugh Durrant-Whyte22 IPSN April 2005
Operation of Channels
( | )iI X Z
iZ
( | ) ( | )i i jI X Z I X Z Z→ ∩
( | )iI X Z
Hugh Durrant-Whyte23 IPSN April 2005
( | )iI X Z
Operation of Channels
( | )iI X Z
iZ
( | )i jI X Z Z∩
jZ
( | )i jI X Z Z∪
Hugh Durrant-Whyte24 IPSN April 2005
Operation of Channels
iZ jZ
( | )i jI X Z Z∪
( | ) ( | )i j i jI X Z Z I X Z Z∪ → ∩
( | ) ( | )i j i jI X Z Z I X Z Z∪ − ∩( | )i jI X Z Z∪
5
Hugh Durrant-Whyte25 IPSN April 2005
Operation of Channels
( | )i jI X Z Z∪
( | )i jI X Z Z∩
( | )i jI X Z Z∪
Hugh Durrant-Whyte26 IPSN April 2005
Scaling The Network
( | )i jI X Z Z∪
( | )i jI X Z Z∩
( | )i jI X Z Z∪
( | )i jI X Z Z∪
( | )QI X Z
( | )QI X Z
( | )i j QI X Z Z Z∪ ∪
Hugh Durrant-Whyte27 IPSN April 2005
Building Large Networks
• Information propagates through network• Without increase in local bandwidth req.• Within locality constraints of algorithms
• Broadcast, and tree networks:• Optimal (central equivalent) results• At the cost of network robustness
• Arbitrary and ad-hoc Networks:• Common Information not captured by Channels• Either local spanning trees or• Conservative update policies (CI, Mutual Info.)
Hugh Durrant-Whyte28 IPSN April 2005
Sub-Model Distribution
)()( kk jj xHz =
)()( kk jjj xCz =
jjj TCH =
)()( kk jj xTx =
Identification of Locally Observable Sub-States:
+= iii kk TFTF )()( += iii kk TGTG )()(Construction of Local Transition and Noise Models:
+== jiji
jji
ij kk TTVxVx ),()(
Generation of Inter-Nodal Communication Models:
Hugh Durrant-Whyte29 IPSN April 2005
ISSS: 1989-1993
• Objectives:• Demonstrate scalability of DDF methods to systems
~100s sensors/nodes• Explore network connectivity issues and communication
policies• Implement and validate model decentralisation principles• Fault detection and robust recovery
• Implementation• A mock-up (nuclear) power plant model• Primary water coolant, secondary air coolant• Boiler, heat exchangers, pumps, by-pass circuits• Measurement of pressures, temperatures, flows, etc
Hugh Durrant-Whyte30 IPSN April 2005
ISSS: Sensor Network
• Network• 250 sensors (temperature,
pressure, flow)• 45 control points (valves,
power)• 22 distributed processing nodes
6
Hugh Durrant-Whyte31 IPSN April 2005
ISSS: Sensor Nodes
Hugh Durrant-Whyte32 IPSN April 2005
ISSS: Results and Conclusions
• Communications• Spanning tree algorithms work well in this slowly varying problem• Optimal network communication provably not possible in general
• Model Distribution• Models vary with time and must be re-learnt periodically• Mutual Information provides the best method for doing this
Hugh Durrant-Whyte33 IPSN April 2005
OxNav (1991-1995)
• Objectives:• Modular, Decentralised
Mobile Robotics• Fully Modular Sensors
and Actuators• Fully Decentralised
Navigation and Control
Drive SystemNodes
Sonar SensingNodes
Hugh Durrant-Whyte34 IPSN April 2005
Decentralised Navigation
• A Feature-Based Navigator
• Using a tracking sonar to lock-on and track stable features
• Decentralised Information filter for estimating platform and feature locations (origin of the SLAM algorithm)
• Bayes estimator for feature identity/type
Hugh Durrant-Whyte35 IPSN April 2005
Decentralised and Scalable Control
• Modular, self-contained driven and/or steered wheel units
• A reference with respect to a “virtual” wheel
• No local knowledge of other wheels or platform geometry
• Decentralised information filter closes loop
• A reconfigurable decentralised PID/LQG controller
Hugh Durrant-Whyte36 IPSN April 2005
OxNav: Results and Conclusions
• Decentralised Estimation• Fundamental Bayes form gives useful insight• Structure of hybrid mobile/stationary tracking prob.
• Decentralised Control• Mutual information is key to sensor management
and active data association• Bayes, rather than complementary LQG is the right
approach to general control problems• In 1995, limited interest in sensor networks so
I emigrated to Australia to do Field Robotics
7
Hugh Durrant-Whyte37 IPSN April 2005
ANSER (1999-2003) Autonomous Navigation and Sensing Experimental Research
• Objectives:• To deploy a fully decentralised data fusion system on a group of four or
more UAVs• To demonstrate functions of target tracking and simultaneous localisation
and mapping, decentralised on many sensors in a network of platforms• To demonstrate, algorithmically and practically, key network-centric
features: Modularity, Scalability, Flexibility and Survivability
Hugh Durrant-Whyte38 IPSN April 2005
Flight Platforms
• Four Platforms – Delta Wing Configuration• Max Speed – 80kts• Payload Capacity – 20kg• Wing Span – 3m• Multiple Sensors per platform• All modular pay-loads• All parts interchangeable
Hugh Durrant-Whyte39 IPSN April 2005
On-Board Components
Vehicle Bus (CAN)
FlightSensors GPS/IMU
GPS/IMUand FlightController
Flight ModeSwitch
Actuators
Air-GroundModem
Environment Bus (CAN)
Radar Node
Air-to-AirCommunications
Radar
Laser Node Vision Node
CameraLaserScanner
Flight Sensors
Mission Sensors
Hugh Durrant-Whyte40 IPSN April 2005
Hugh Durrant-Whyte41 IPSN April 2005
Mission Planning System
Hugh Durrant-Whyte42 IPSN April 2005
Overall DDF Communications Schematic
S1 S2 S3 S4
S1 S2 S3 S4
S1 S2 S3 S4
S1 S2 S3 S4
DDF DDF DDF DDF
DDF DDF DDF DDF
DDF DDF DDF DDF
DDF DDF DDF DDF
Ground Station
UAV1 UAV2
UAV3 UAV4
8
Hugh Durrant-Whyte43 IPSN April 2005
Mission Control
Hugh Durrant-Whyte44 IPSN April 2005
Multi-Vehicle Flights (2000-2001)
Hugh Durrant-Whyte45 IPSN April 2005
3 Vehicle Flight Test (2002)
Hugh Durrant-Whyte46 IPSN April 2005
ANSER Mission Data
Hugh Durrant-Whyte47 IPSN April 2005
3 Vehicle – 4 Nodes Flight Test
Hugh Durrant-Whyte48 IPSN April 2005
ANSER: Conclusions
• Information Communications is key:• Timing, delay, asequent and burst communication• Maintaining integrity, extensible network operation• Channel and information management
• Data Fusion issues:• Registration and platform bias estimation• Cross-platform data association• Weak target information not captured well by
information filter alone• Commercial issues
• BAE Systems Chairman’s Gold Award• Output integrated in to a number of on-going UK,
US and Australian Defence programmes• (After 15 years of work !)
9
Hugh Durrant-Whyte49 IPSN April 2005
ANSER II: 2004-2006
• Objectives• General Bayesian DDF• Heterogeneous
Information Sources• Inferences from weak
sources• Rapid exploitation of
network data
Hugh Durrant-Whyte50 IPSN April 2005
Bayesian DDF Node Structure
zi(k)
Time Update(Convolution)
Preprocessand FeatureExtraction
Sensor Node
P
QObservationUpdate
(Multiplication)
Channel Filter
Channel Filter
DensityFitting
LikelihoodModel
ChannelManager
Assimilation(Multiplication)
Pi(z|x)
Pi(z=zi(k)|x)
P(xk|Zk-1,zi(k))
P(xk|Zk-1) P(xk|Zk-1,zi(k))
P(xk|Zk)
P(xk|zQ,zP)
Hugh Durrant-Whyte51 IPSN April 2005
Generation of Likelihood Models
s
z x
( ) ( ) ( ) ( )ssxsxzsxz PPPP |,|,, =
P(z | x,s)=P(z|x=[x,s]) is the required likelihood for inference
Hugh Durrant-Whyte52 IPSN April 2005
Cross-Platform Fusion
• Bayesian DDF implemented using GMMs
• Variational EM does local estimation of GMM
Hugh Durrant-Whyte53 IPSN April 2005
Human DDF Node
• Human operator input:• Metric Information• Labels• Context
• On-line estimation of “operator likelihood”
s
rz
x l
hz
Hugh Durrant-Whyte54 IPSN April 2005
Decentralised Sensor Management
• How to best acquire target information:• Which sensor to point• What direction to point the sensor in• What trajectory for the aircraft• What to communicate between platforms
• Require solutions that:• Coordinate decentralised sensor actions • Scale to large inhomogeneous networks
• Algorithms which are “information-seeking”
10
Hugh Durrant-Whyte55 IPSN April 2005
Mutual Information Gain as a Control Metric
• Mutual Information is an a priori measure of average Information gain following observation
=
))(P())()(P(logE))(:)((
tttttI
xz|xzx Measures “compression”
of posterior density
Choose the sequence of observations z(t) which maximise mutual information gain over a horizonObservations depend on platform state x(t) State is governed by some control input u(t)Choose u(t) to maximise information gain
Hugh Durrant-Whyte56 IPSN April 2005
Mutual Information in DDF
• Mutual Information or information gain, is exactly what is communicated in the DDF
• Suggests a Decentralised (Greedy) management and control algorithm:• Order strategies according to local information gain• Communicate options as information gain• Select action which maximises gain for the group
• Appropriate to both sensor management and platform control tasks
Hugh Durrant-Whyte57 IPSN April 2005
Trajectory Control: A Canonical Example
• Bearings-only observation of a point-target from a moving platform
−−
=)(ˆcos)(ˆcos)(ˆsin
)(ˆcos)(ˆsin)(ˆsin)(ˆ
1)(2
2
22 tttttt
trt
θθθθθθ
σ ββI
For a single platformsolutions are Helical
Hugh Durrant-Whyte58 IPSN April 2005
Multiple Platform Management
• For a group of platforms:• Solutions are parabolas• Different initial locations
and prior information give different solution sets
Hugh Durrant-Whyte59 IPSN April 2005
Two Vehicle Cooperative Tracking
Hugh Durrant-Whyte60 IPSN April 2005
Decentralised Multi-Target Multi- Platform Tracking: Robustness and Scaling
11
Hugh Durrant-Whyte61 IPSN April 2005
Control as Gradient Ascent in Information Space: The Surfing Analogy
Hugh Durrant-Whyte62 IPSN April 2005
DDF/D-Control Algorithm Implementation
ConventionalDDF Node
InternodeNegotiation
Local Controller
Hugh Durrant-Whyte63 IPSN April 2005
Cooperative Control for Target Detection BAE Systems & UK MOD
Hugh Durrant-Whyte64 IPSN April 2005
Nature of Information Maximisation Control
• Information gain problems:• Are integral pay-off problems• And turn out to have simple product/sum
structures that are easily distributed• Information gain problems include:
• Target tracking/surveillance/reconnaissance• Exploration and area covering
• Information gain admits useful solutions and potential insights into the multi-agent coordination problem
Hugh Durrant-Whyte65 IPSN April 2005
Exploration and Search
• Exploration/Search are information seeking activities:• Find unseen areas• Seek “interesting” things
• An integral pay-off problem with a DDF-like solution• Heterogenous information sources• Heterogeneous control
Hugh Durrant-Whyte66 IPSN April 2005
Exploration: Multiple-Objectives
Information
Localisation
Time
12
Hugh Durrant-Whyte67 IPSN April 2005 Hugh Durrant-Whyte68 IPSN April 2005
Search: Multiple Sensors, Bayesian Models
• Objective: Minimise expected time to first detection:• Establish a prior for the area to be searched• Communicate expected information gain for
different headings• Select a path which minimises posterior entropy
• Motion models for priors can be used to exploit domain knowledge
Hugh Durrant-Whyte69 IPSN April 2005
Node-to-Node Negotiation
Hugh Durrant-Whyte70 IPSN April 2005
Multi-UAV Search
• Cooperative Exploration, Search and Tracking
• Scalable solutions • Use of domain knowledge
AOARD/AFOSR
Hugh Durrant-Whyte71 IPSN April 2005
Exploiting Domain Knowledge:Example of Wind-Gust Data
Hugh Durrant-Whyte72 IPSN April 2005
Exploiting Domain Knowledge: Example of Soft Constraints
13
Hugh Durrant-Whyte73 IPSN April 2005
Exploiting Domain Knowledge: Example of Hard Constraints
Hugh Durrant-Whyte74 IPSN April 2005
Data Fusion in Sensor Networks:Where to Next ?
• There is scope for a general computational model of data fusion in sensor networks:• Bayesian/probabilistic• Explicit information-theoretic communication• Use of mutual-information to learn state coupling• Deployable in modular and reusable form
• Future development of higher-level fusion functions: • Bayesian network models for situation understanding• Information-theoretic management and control• Exploitation of human and other weak-source data
• Realistic and challenging application development• Identification of key applications• Sharing of data sets
Hugh Durrant-Whyte75 IPSN April 2005