publish covariance in format 64F
some bugfixes with stateSigma
Can now plot slam pose. Plus: crashes resolved with covariances.
EKF SLAM considers landmarks
Plus:
- message filter for slam to sync messages of odo and sensor
- crashes produce stack traces
- bugfix with slam pose publication