Modified fast logging to send MAVlink packets

The idea is to send MAVLink packets at roughly 50 Hz with the necessary
information for SYSID. These messages can be read over serial by a
computer and then rebroadcast to get ground telemetry.