Some fixes to the kalman filter and polar plot.