Full path planning with some tweaks that should be diffed to the last update