Fix os5000 driver to publish data to ROS

Correct format for parsing data from compass
Correct format for publishing IMU message