Add proper thread protection

## Description
Rework the message template so all calls are automatically thread-safe. This will be partially done internally to the base mav_message and then also using the decorator throughout.
