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