still need to calculate heuristic cost, check for out of bounds index