VTOL architecture working with caipirinha

I missed that this in the FW controller. Yes, the FW attitude should be used instead here.