Mavlink parameter code works as expected