private void StopSimulation()
{
VREPWrapper.simxStopSimulation(_clientId, simx_opmode.oneshot_wait);
SimulationIsRunning = false;
_mapBuilderThread?.Abort();
Localization.PoseChanged -= PoseChanged;
MapBuilder.RequestLaserScannerDataRefresh -= RequestLaserScannerDataRefresh;
MapBuilder.CalculatePose -= CalculatePose;
}