Adding A Star algorithm