3D machine control