Added calibrated compass sensor and began compass-imu fusion