Added config param to disable path simplification (post-processing), new default is disabled simplification for navigating in complex surroundings