RGBD almost done