Separate threads for Heading and Depth Controllers.
Separate threads for Heading and Depth Controllers.