Subscribe to imu topic for heading