Wait for Pub/Sub server to stop before stopping MavSDK thread to avoid a segfault.
This will create a new commit in order to revert the existing changes.
