Heading Yaw Controller

Input: Target Heading

Output: Target Yaw angle

Default usage is as a yaw damper which always outputs a yaw angle of zero. To accomplish co-ordinated turns, add a small Ki to smoothly alter yaw and keep the upper and lower clamp tight (I typically use +/- 2)