Nav Filter : Added processing to convert IMU data.

Also includes a tidy-up