Improved Pathfinding Time Immensely

- tweaked the pathfinding script to run much faster
- reduced most if not all of the lag