3D sensing by optics and algorithm co-design