Added frames argument
Plot statecov, use trackid arg for state cov filtering
Plot velocity
Update predictedLoc, improved debug
Added constrainVelocity
Reduced process noise
Limit range to 'maxrange'
Update args to tracker.update, removed call to moveintoshadows() (done in tracker now)
Reduced win bounds
Adjust angle to be in ]-pi,pi]