Code changes to hold heading. Yaw stick now changes the heading which the copter tries to maintain