Added the code to perform the search and expand nodes, added code to calculate fscores, added code to check if goal has been reached, changed printMap to display open and closed nodes. Everything seems to work but further testing is required. Still needs a way to retrace the best path. Also, I am unsure what gscore everything should be initialized to.