TODO Add bearing plots to live view Clean up source code Tune covariance matrix Cartesian Cartesian coords don't make sense. You can't define any real covarience Modified Polar Coordinate Do make sense, but can be a bit finiky.