Math Improvements (Speed and Flexibility), First Attempt at an Open A* Pathfinder

Minor Utility Improvements