Increased effeciency over 10 fold.
NOTES!!!!! Need to adjust pathfind() on the diagonal adds to check the 2 directions surrounding the current vector