p5.js - A* Pathfinding (with drawing tool)