Sets camera_link to optical frame

The `camera_link` must actually be the `base_rgbd_camera_optical_frame`, not the `base_rgbd_camera_link`