Add a script to test mavlink connection (read heartbeat)