Mavlink terrain protocol support