Rosbag dimmap

Based on the intel realsense API logic for 2d to 3d projection using stereo camera. Currently requires intrinsics + extrinsics params specified in the config file. In theory, applies to any rgbd camera with no distortion. We can add distortion parameters in a future update