VTOL architecture working with caipirinha

@LorenzMeier This should probably be 4, although the servo work fine like this