A Star Algorithm implemented