Added findPath functions

they work, and find the end, but I'm suspicious about the findPath_rec()
function...it almost seems to be doing a bfs, but it really depends on
the graph structure opposed to the maze structure.