A star algorithm implemented