Pathfinding on floor level. Refactor worker. Need smooth movements.