def reconstruct(self, xyZ, undistort=True): """ Reproject to 3D with calib params """ Z = colvec(xyZ[:,2]) return self.ray(xyZ[:,:2], undistort=undistort) * Z