I recently had some fun with A* algorithm. If you would like to review/comment/complain, then feel free to PR https://github.com/pantadeusz/a_star