Turn North Control

Added Turn North Control. On auto pilot, quad will yaw north (or
whatever direction) with PI Control. Tuning is still necessary. Also,
throttle, aileron, and elevator are still available during auto-pilot.