applied patch to link registration and mapping against rgbd_util lib