3D grade control