AP_L1_Control : Addition of functions to return nav_bearing_cd and bearing_error_cd