Revert "Revert "Fixing heading hold disable""
Revert "Revert "Fixing heading hold disable""

This reverts commit d3358a824c15861696362ee7c5d37401d602f430.

spiderkeys/openrov-software-arduino,OpenROV/openrov-software-arduino,johan--/openrov-software-arduino,LeeCheongAh/openrov-software-arduino,dieface/openrov-software-arduino,johan--/openrov-software-arduino,dieface/openrov-software-arduino,OpenROV/openrov-software-arduino,binary42/openrov-software-arduino,spiderkeys/openrov-software-arduino,binary42/openrov-software-arduino,OpenROV/openrov-software-arduino,BrianAdams/openrov-software-arduino,BrianAdams/openrov-software-arduino,LeeCheongAh/openrov-software-arduino