Copter: Fast atan and tan functions
Copter: WP_Nav initialisation of acceleration variables