Pathfinding Implementation

A pathfinding algorithm that works given the width, height, and the node
positions that can be walked on.