Implemented A-Star Search