Mavlink rates

This PR is WIP. Adds a decent method of printing the radio status.
This comment should be at line 388, isn't it?