Copter: Cruise flight mode - Fix Des_vel & yaw

Do no use RC variable as it's not updated each program iteration
Remove the 180° heading offset at simple_yaw_angle init