Initialize noise covariances
Merge branch 'colortrack' of https://github.com/jlfranco/gts into colortrack