AP_NavEKF : Added public method for trig accessors and removed un-used code