Implemented a-star with parents on every node. Working path