Project complete, algorithm was correct. Touchups and traversal done