Copter: conditional yaw fix

waypoint command was setting auto_yaw_mode when it was run after the
do-cmd
yaw_look_at_heading was being set to current heading which was
overwriting the caller's desired heading
Mission: fix example sketch after GPS lib changes