Is it now correct in VTOL flight? You might have to change the forward flight code here:
You might find it works just by setting the tilt type to continuous rather than bicopter.