Apply distortion correction when integrating depth images

[schornakj]

Currently only the camera intrinsic parameters (fx, fy, cx, cy) are used, which implicitly requires that incoming depth images already be rectified. It would be a useful enhancement to also apply distortion correction using the plumb bob model.