Heading control with PID

Great stuff,

Thanks for your help there.

D.