Reconstruct the code of mavlink parameter configuration
Fix some small bug