Fix for some cases of machine stuck close to a parking or logistic