a-star/1_a.cpp
void AddToOpen(int x, int y, int g, int h, std::vector<std::vector<int>>& openNodes, std::vector<std::vector<State>>& grid) {
    
    // Create a vector node in the form (x,y,g,h) and push vector node to open list
    openNodes.push_back(std::vector<int> {x, y, g, h});
    // Set grid value for (x,y) as blocked
    grid[x][y] = State::kClosed;
}
/**
 * @brief Adds open node top open list and marks rid cells as closed
 * 
 * @param x 
 * @param y 
 * @param g g-value of cell
 * @param h heuristic value of cell 
 * @param openNodes Vector of open nodes
 * @param grid Gridworld matrix
 */
@brief Adds open node top open list and marks rid cells as closed


@brief Adds open node top open list and marks rid cells as closed
void AddToOpen(int x, int y, int g, int h, std::vector<std::vector<int>>& openNodes, std::vector<std::vector<State>>& grid) {
    openNodes.push_back(std::vector<int> {x, y, g, h});
    grid[x][y] = State::kClosed;
}
void AddToOpen ( int x , int y , int g , int h , std :: vector < std :: vector < int > > & openNodes , std :: vector < std :: vector < State > > & grid ) { openNodes . push_back ( std :: vector < int > { x , y , g , h } ) ; grid [ x ] [ y ] = State :: kClosed ; }
@brief Adds open node top open list and marks rid cells as closed
@brief Adds open node top open list and marks rid cells as closed
// Create a vector node in the form (x,y,g,h) and push vector node to open list // Set grid value for (x,y) as blocked