Adds tests, implements byte-identical encoding of MAVLink messages