Updated const-correctness, wrote gaussian_grid and passes tests