State Estimation and Motion Tracking for Spatially Diverse VLC Networks

Similar documents
SIGNAL STRENGTH LOCALIZATION BOUNDS IN AD HOC & SENSOR NETWORKS WHEN TRANSMIT POWERS ARE RANDOM. Neal Patwari and Alfred O.

Kalman Filter. Predict: Update: x k k 1 = F k x k 1 k 1 + B k u k P k k 1 = F k P k 1 k 1 F T k + Q

SIGNAL STRENGTH LOCALIZATION BOUNDS IN AD HOC & SENSOR NETWORKS WHEN TRANSMIT POWERS ARE RANDOM. Neal Patwari and Alfred O.

Optimization-Based Control

Using the Kalman Filter to Estimate the State of a Maneuvering Aircraft

Sensor Tasking and Control

Estimation of the Capacity of Multipath Infrared Channels

The Belief Roadmap: Efficient Planning in Belief Space by Factoring the Covariance. Samuel Prentice and Nicholas Roy Presentation by Elaine Short

Time Series Analysis

CALIFORNIA INSTITUTE OF TECHNOLOGY Control and Dynamical Systems. CDS 110b

Posterior Cramer-Rao Lower Bound for Mobile Tracking in Mixed Line-of-Sight/Non Line-of-Sight Conditions

ROBOTICS 01PEEQW. Basilio Bona DAUIN Politecnico di Torino

Location Determination Technologies for Sensor Networks

System identification and sensor fusion in dynamical systems. Thomas Schön Division of Systems and Control, Uppsala University, Sweden.

Probabilistic Fundamentals in Robotics. DAUIN Politecnico di Torino July 2010

Autonomous Navigation for Flying Robots

Rao-Blackwellized Particle Filtering for 6-DOF Estimation of Attitude and Position via GPS and Inertial Sensors

Data Fusion Kalman Filtering Self Localization

Smartphone sensor based orientation determination for indoor navigation

1 Kalman Filter Introduction

Sensor Fusion: Particle Filter

ELEC E7210: Communication Theory. Lecture 10: MIMO systems

2D Image Processing. Bayes filter implementation: Kalman filter

Autonomous Mobile Robot Design

Achievable Rate Region of the Zero-Forcing Precoder in a 2 2 MU-MISO Broadcast VLC Channel with Per-LED Peak Power Constraint and Dimming Control

L06. LINEAR KALMAN FILTERS. NA568 Mobile Robotics: Methods & Algorithms

Kalman Filter Computer Vision (Kris Kitani) Carnegie Mellon University

TSRT14: Sensor Fusion Lecture 1

Miscellaneous. Regarding reading materials. Again, ask questions (if you have) and ask them earlier

Bayes Filter Reminder. Kalman Filter Localization. Properties of Gaussians. Gaussians. Prediction. Correction. σ 2. Univariate. 1 2πσ e.

CS 532: 3D Computer Vision 6 th Set of Notes

Local Positioning with Parallelepiped Moving Grid

Lecture 2: From Linear Regression to Kalman Filter and Beyond

Machine Learning 4771

A Step Towards the Cognitive Radar: Target Detection under Nonstationary Clutter

Blind phase/frequency synchronization with low-precision ADC: a Bayesian approach

Lecture 2: From Linear Regression to Kalman Filter and Beyond

A Crash Course on Kalman Filtering

OPTIMAL ESTIMATION of DYNAMIC SYSTEMS

The Use of Short-Arc Angle and Angle Rate Data for Deep-Space Initial Orbit Determination and Track Association

Application of state observers in attitude estimation using low-cost sensors

SIMULTANEOUS STATE AND PARAMETER ESTIMATION USING KALMAN FILTERS

2D Image Processing. Bayes filter implementation: Kalman filter

Robotics. Mobile Robotics. Marc Toussaint U Stuttgart

CALIFORNIA INSTITUTE OF TECHNOLOGY Control and Dynamical Systems. CDS 110b

Kalman filtering and friends: Inference in time series models. Herke van Hoof slides mostly by Michael Rubinstein

Robotics 2 Target Tracking. Giorgio Grisetti, Cyrill Stachniss, Kai Arras, Wolfram Burgard

Lecture. Aided INS EE 570: Location and Navigation. 1 Overview. 1.1 ECEF as and Example. 1.2 Inertial Measurements

A fired-induced displacement estimation method for civil infrastructure. and Technology, Daejeon , Korea * Corresponding author

Probabilistic Graphical Models

Introduction to Unscented Kalman Filter

Mini-Course 07 Kalman Particle Filters. Henrique Massard da Fonseca Cesar Cunha Pacheco Wellington Bettencurte Julio Dutra

Kalman Filters for Mapping and Localization

The Kalman Filter ImPr Talk

Problem 1: Ship Path-Following Control System (35%)

Kernel Bayes Rule: Nonparametric Bayesian inference with kernels

UAVBook Supplement Full State Direct and Indirect EKF

EE 565: Position, Navigation, and Timing

ECONOMETRIC METHODS II: TIME SERIES LECTURE NOTES ON THE KALMAN FILTER. The Kalman Filter. We will be concerned with state space systems of the form

Quaternion based Extended Kalman Filter

RESEARCH OBJECTIVES AND SUMMARY OF RESEARCH

Linear Dynamical Systems

Data assimilation with and without a model

Isobath following using an altimeter as a unique exteroceptive sensor

RECENTLY, light emitting diode (LED) based visible light

Lecture Notes 4 Vector Detection and Estimation. Vector Detection Reconstruction Problem Detection for Vector AGN Channel

Lecture 10 Linear Quadratic Stochastic Control with Partial State Observation

Electrical Engineering Written PhD Qualifier Exam Spring 2014

EKF and SLAM. McGill COMP 765 Sept 18 th, 2017

ESTIMATOR STABILITY ANALYSIS IN SLAM. Teresa Vidal-Calleja, Juan Andrade-Cetto, Alberto Sanfeliu

Initial Orbit Determination Using Stereoscopic Imaging and Gaussian Mixture Models

Fundamentals of attitude Estimation

VN-100 Velocity Compensation

Energy Efficiency and Load Balancing in Next-Generation Wireless Cellular Networks

Timing Recovery at Low SNR Cramer-Rao bound, and outperforming the PLL

Research Article Error Modeling, Calibration, and Nonlinear Interpolation Compensation Method of Ring Laser Gyroscope Inertial Navigation System

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics

Nonlinear Estimation Techniques for Impact Point Prediction of Ballistic Targets

Robotics 2 Target Tracking. Kai Arras, Cyrill Stachniss, Maren Bennewitz, Wolfram Burgard

A Study of Covariances within Basic and Extended Kalman Filters

ON ENTRY-WISE ORGANIZED FILTERING. E.A. Suzdaleva

EE 570: Location and Navigation

Lecture 9: Modeling and motion models

Nonlinear and/or Non-normal Filtering. Jesús Fernández-Villaverde University of Pennsylvania

Probabilistic Fundamentals in Robotics

SLAM Techniques and Algorithms. Jack Collier. Canada. Recherche et développement pour la défense Canada. Defence Research and Development Canada

Object Tracking using Kalman and Particle filtering Techniques

A Comparison of the EKF, SPKF, and the Bayes Filter for Landmark-Based Localization

Lecture 16: State Space Model and Kalman Filter Bus 41910, Time Series Analysis, Mr. R. Tsay

Linear-Quadratic-Gaussian (LQG) Controllers and Kalman Filters

Dual Estimation and the Unscented Transformation

Simultaneous state and input estimation of non-linear process with unknown inputs using particle swarm optimization particle filter (PSO-PF) algorithm

Adaptive Particle Filter for Nonparametric Estimation with Measurement Uncertainty in Wireless Sensor Networks

Trust Degree Based Beamforming for Multi-Antenna Cooperative Communication Systems

Information Exchange in Multi-rover SLAM

Optimization-Based Control

MODELLING ANALYSIS & DESIGN OF DSP BASED NOVEL SPEED SENSORLESS VECTOR CONTROLLER FOR INDUCTION MOTOR DRIVE

A Theoretical Overview on Kalman Filtering

Robot Localization and Kalman Filters

Transcription:

State Estimation and Motion Tracking for Spatially Diverse VLC Networks GLOBECOM Optical Wireless Communications Workshop December 3, 2012 Anaheim, CA Michael Rahaim mrahaim@bu.edu Gregary Prince gbprince@bu.edu Dr. Thomas D.C. Little tdcl@bu.edu 1

Outline Motivation Visible Light Communication Kalman Filtering System Model Results and Conclusions 2

Consider This We live in a society where access to information is ubiquitous. 3

Motivation: Indoor Localization Personalized local information Augmented knowledge of surroundings Targeted advertisement Indoor navigation Communication Systems Handover in VLC or heterogeneous networks Traffic routing based on dynamic traffic patterns We propose a novel state estimation model Approximates user location and motion path Predicts future state through use of recursive estimation 4

Visible Light Communication (VLC) Intensity Modulation / Direct Detection (IM/DD) Dual Purpose System Fully functional lighting system Wireless data communication Benefits Dual use Secure connections Unregulated spectrum Signal Directionality 20 Mb/s 20 Mb/s 20 Mb/s High bandwidth density 20 Mb/s 5

VLC Channel Model Transmitted power, P t, distance, D, receiver area, A r, and angle at the transmitter and receiver account for LOS received power. P r = P tt φ A r g θ D 2 LEDs and photodiodes have an angle dependent gain typically modeled as T φ = n+1 22 cccn φ g θ = ccc θ 6

VLC Network Considerations Fast and accurate handover protocols are necessary to maintain connectivity throughout the environment. HHO: Transfer between VLC channels VHO: Transfer between media (e.g. VLC to RF) RSI allows for basic handover methods, but motion tracking provides an opportunity for predictive methods. Horizontal Handover (HHO) Vertical Handover (VHO) 7

Kalman Filtering Discrete time linear state models can be employed to describe the behavior of dynamic systems. x t + 1 = Ax t + Gw t Kalman Filters observe a series of noisy measurements, then recursively estimate the system state and predict the next state. 1. Initialization 2. Prediction 3. Measurement 4. Update y t = Cx t + Hv t Since measurement in our system is non-linear, we observe extensions of the basic KF. Extended Kalman Filter (EKF) Unscented Transform (UT) 8

System Model Empty 6m X 6m X 4m room with grid or cell layout. New user location is normally distributed with expected value below a hotspot. Users move with zero mean acceleration in the x and y direction. Observe a linear state model, x t, with transition matrix, A, and nonlinear measurement, y. x t + 1 = AA t + w t y t = h x t, t + v t Process noise, w, and measurement noise, v, are independent, zero-mean, Gaussian white noise with covariance matrices Q and R, respectively. 9

System Model Scenario I Receiver is directed perpendicular to floor, such that φ = θ. State represents position and velocity in x and y. Measurement observes signal power from the set of transmitters. x = x, V x, y, V y y = P r,1j, P r,2j,, P r,9j + v t A I = P r,1j is dependent on φ ii, θ ii, and D ii. D ii 2 = X i x 2 + Y i y 2 + Z i z 2 φ ii = θ ii = arctan X i x 2 + Y i y 2 Z i z Q I = q 1 dd 0 0 0 1 0 0 0 0 1 dd 0 0 0 1 dd 3 3 dd 2 2 dd 2 2 0 0 0 0 0 0 dd 0 0 R I = r sss I 9xx dd 3 3 dd 2 2 dd 2 10 2 dd

System Model Scenario II Incorporate device rotation in the state model. A II = A I 0 1 0 0 0 1 x = x, V x, y, V y, θ ee, θ aa Q II = The acceptance angle, θ ii, is now dependent on θ ee and θ aa. Q I 0 0 q θ dd 0 0 q θ dd V rr = cos θ ee sin θ aa, sin θ ee sin θ aa, cos θ aa V tt,i = X i x, Y i y, Z i z Tx cos θ ii = V rr V tt,i V rr V tt,i V tt θ V rr 11

System Model Scenario III Additional measurements for θ ee and θ aa are included. y = P r,1j, P r,2j,, P r,9j, θ ee, θ aa + v t R III = R I 0 0 r θ I 2xx We aim to show that additional sensors (e.g. accelerometers or gyroscopes) can improve performance in a realistic scenario. 12

Results We first observe Cramer Rao Bounds (CRB) for the simulated data. Cramer Rao Bounds for multiple sampling rates Cramer Rao Bounds for multiple transmitter orders 13

Results We next compare estimations to the actual position and velocity. Simulation results for the Extended Kalman Filter Simulation results for the Unscented Filter 14

Results Cellular and grid layouts show similar performance; however the initial distribution in the cellular scenario was not located directly below a transmitter. Simulation results comparing grid and cellular layouts 15

Results Scenario II shows a significant performance loss over Scenario I; however the additional sensors in Scenario III provide similar performance to that of Scenario I. Simulation results comparing scenarios I, II, and III 16

Conclusions We have provided a novel state estimation model leveraging the lighting infrastructure to approximate user location and motion under realistic conditions. Simulation results on an empty room show position and velocity results with average error of 5cm and 10cm/s, respectively. We recognize that additional complexities occur due to dynamic signal conditions from obstructions and signal reflections. Non-ideal luminaire output Receiver Optics Multipath Signals User obstruction Results are applicable for positioning systems and asset tracking as well as assisted handover or beam steering for indoor VLC networks 17

Questions Acknowledgment: This work was supported primarily by the Engineering Research Centers Program of the National Science Foundation under NSF Cooperative Agreement No. EEC-0812056. 18

19

Table of Parameters Parameter Phase I Phase II / III System Parameters P t (W) 5 5 A r (mm 2 ) 300 300 dt (ms) 0.2, 0.5, 1 0.2 n 1,2,3,4 1 Initial Expectations E[x,y] (m) [0.99, 0.99] [0.99, 0.99] E[V x,v y ] (m/s) [0.8, 0.8] [0.8, 0.8] E[θ el,θ az ] ( ) - [0,0] Σ[x,y] (m) [0.5,0.5] [0.5,0.5] Σ[V x,v y ] (m/s) [0.2,0.2] [0.2,0.2] Σ[θ el,θ az ] ( ) - [ π 180 4 Noise Parameters r sig 3.5 10 8 3.5 10 8 r θ - π 360 q 10 2 10 2 q θ - π 360 20

Kalman Filter Details Prediction x t+1 t = Ax t t + Bu t + GE w t Σ t+1 t = AΣ t t A T + GGG T y t+1 t = Cx t t + Du t + HE v t Estimation Innovations Kalman Gain x t+1 t+1 = x t+1 t + K t+1 v t+1 Σ t+1 t+1 = I CK t+1 Σ t+1 t v t+1 = y t+1 y t+1 t K t+1 = Σ t+1 t C T CΣ t+1 t C T + R 1 21