Fix #6 - set_mavlink_callback already works, fix the docs and add example