Closing controller doesn't consider yaw

[Rather1337]

The closing controller commands yaw=0, but the drone might pass the gate with different yaw. When returning to the starting position, the yaw should again be 0.