bug fixed that let the mavlink loop run as fast as possible