ball tracking example ball tracking with the kalman

2
Ball Tracking with Kalman Filter Slide 1/7 Ball Tracking Example Robert B. Fisher School of Informatics University of Edinburgh c 2014, School of Informatics, University of Edinburgh Ball Tracking with Kalman Filter Slide 2/7 BALL TRACKING WITH THE KALMAN FILTER Ball physical model: Position: p t =(col t , row t ) Velocity: v t =(velcol t , velrow t ) Position update: p t = p t1 + v t1 Δt Velocity update: v t = v t1 + a t1 Δt Acceleration (gravity down): a t = (0,g ) State vector: x t =(col t , row t , velcol t , velrow t ) Initial state vector: random c 2014, School of Informatics, University of Edinburgh Ball Tracking with Kalman Filter Slide 3/7 Ball physics update Prediction: y t = Ax t1 + Bu t A= 1 0 Δt 0 0 1 0 Δt 0 0 1 0 0 0 0 1 Bu t = 0 0 0 g Δt Use Δt =1 c 2014, School of Informatics, University of Edinburgh Ball Tracking with Kalman Filter Slide 4/7 Rest of model Observation process: H= 1 0 0 0 0 1 0 0 Measurement noise: R= 0.285 0.005 0.005 0.046 System noise: Q = 0.01 × I c 2014, School of Informatics, University of Edinburgh

Upload: dinhngoc

Post on 14-Feb-2017

220 views

Category:

Documents


4 download

TRANSCRIPT

Page 1: Ball Tracking Example BALL TRACKING WITH THE KALMAN

Ball Tracking with Kalman Filter Slide 1/7

Ball Tracking Example

Robert B. Fisher

School of Informatics

University of Edinburgh

c©2014, School of Informatics, University of Edinburgh

Ball Tracking with Kalman Filter Slide 2/7

BALL TRACKING WITH THE

KALMAN FILTER

Ball physical model:

Position: ~pt = (colt, rowt)′

Velocity: ~vt = (velcolt, velrowt)′

Position update: ~pt = ~pt−1 + ~vt−1∆tVelocity update: ~vt = ~vt−1 + ~at−1∆tAcceleration (gravity down): ~at = (0, g)′

State vector: ~xt = (colt, rowt, velcolt, velrowt)′

Initial state vector: random

c©2014, School of Informatics, University of Edinburgh

Ball Tracking with Kalman Filter Slide 3/7

Ball physics update

Prediction: ~yt = A~xt−1 + B~ut

A =

1 0 ∆t 0

0 1 0 ∆t

0 0 1 0

0 0 0 1

B~ut =

0

0

0

g∆t

Use ∆t = 1

c©2014, School of Informatics, University of Edinburgh

Ball Tracking with Kalman Filter Slide 4/7

Rest of model

Observation process:

H =

1 0 0 0

0 1 0 0

Measurement noise:

R =

0.285 0.005

0.005 0.046

System noise: Q = 0.01 × I

c©2014, School of Informatics, University of Edinburgh

Page 2: Ball Tracking Example BALL TRACKING WITH THE KALMAN

Ball Tracking with Kalman Filter Slide 5/7

KALMAN FILTER SUCCESSES

SEE: homepages.inf.ed.ac.uk/rbf/......AVINVERTED/DEMOS/TRACK/demo.html 8:

21:

35: 42:

c©2014, School of Informatics, University of Edinburgh

Ball Tracking with Kalman Filter Slide 6/7

KALMAN FILTER FAILURES

14: BOUNCE OVERSHOOT 16: SLOW CATCH UP

59: GRAVITY PULLS DOWN AT REST

c©2014, School of Informatics, University of Edinburgh

Ball Tracking with Kalman Filter Slide 7/7

Ball tracking analysis

• KF smooths noisy observations (not so noisy

here) to give better estimates

• Could also estimate ball radius

• Could also plot boundary of 95% likelihood

of ball position - grows when fit is bad

• Dynamic model doesn’t work at bounce &

stop

c©2014, School of Informatics, University of Edinburgh