changed yaw reset to when armed to not use initial_simple_bearing