Mavlink up and working