In pathfinder, try to walk as close as possible to target
Simplify movement-code, in preparation for rewrite