Copter: bug fix for RTL yaw control

Nose was only pointing home if your initial altitude was above the
RTL_ALT