Initializing yaw orientation from magnetometer reading.

- added magnetometer biases (mag_bias/x and mag_bias/y) for hard-iron compensation.
- add two debug topics: imu/rpy/raw and imu/rpy/filtered. imu/rpy/raw can be used for computing mag. biases. imu/rpy/filtered topic is for user readability only. 
- added an option for tilt compensation and initializing yaw orientation from magnetometer reading.
We should only advertise these topics if `publish_debug_topic == true` (unless we make `publish_debug_topic` dynamically reconfigurable, in which case I would prefer leaving this as it is and always advertising the topics).