rtl resets yaw to same as when armed - unless user specifies otherwise
changed yaw reset to when armed to not use initial_simple_bearing
Copter: remove unused print_wp function