- Added code to output 3D-stereo-points and RGB values for right image