Reorganized pathfinding agent. applying road weights.
Fixed A*.