[WingAlgorithm] Fixed bug in interpretation of velocity heading and changed saturation and max servo aperture
