A* implementaatio done ja debugattu