astar implemented (doesn't work yet)