turn on -Werror and fix resulting errors

Here is a picture of the arrangement: https://pixhawk.org/_detail/platforms/vtol/pixhawk_position_caipirinha.jpg?id=platforms%3Avtol%3Atbs_caipirinha_vtol