Some crazy shit in UAS.cc was using an array of 256 bytes to handle received messages and mapping them to components. Well, any message ID over 255 would cause a buffer overrun.

* Some code moved to Vehicle

_finalize methods need information which is not available if all you
have is a mavlink_message_t

This reverts commit ae976049ca7b4818616e6b8be07a028fc7dfc26f.

This way we don't need macro-magic to deal with
different operating systems and compilers.

Signed-off-by: Tomaz Canabrava <tomaz.canabrava@intel.com>

Removed incorrect Vehicle.altitudeWGS84