Simple GUI, now displays the grid
Can now display obstacles and goal