Add a new stereo matching validator for multiple camera calibration

[HViktorTsoi]

This PR add a new stereo matching validator to validate and visualize the result of multiple camera calibration. It uses the calibration result (the yaml file) from the last kalibr_calibrate_cameras step, undistorts and recitifies the images, and then run a stereo matcher to calculate the disparity map. No Calibration Target is Required in This Validator.

The stereo disparity map offers an intuitive, direct and comprehensive way to quickly visualize the calibration result. For example, a successful calibration may yield the following disparity results:

(with opencv sgbm stereo matcher)

(with opencv bm stereo matcher)

The depth of the ground plane and object surface is uniform and smooth.

While a bad calibration result leads to failed stereo matching (because of poor rectification) , resulting in a disparity map looks like this

Note there are lots of speckles and the ground plane is missing.

Usage:

python kalibr_camera_validator_stereo_match --cam ${path-to-camchain.yaml} --matcher bm --scale 2

or

python kalibr_camera_validator_stereo_match --cam ${path-to-camchain.yaml} --matcher sgbm --scale 2

the --matcher option selects the stereo matching algorithm (bm or sgbm). The --scale option determines how many times we downsample the image to speed up stereo matching .

[nbaldy-hb]

                except CvBridgeError as e:

Make it also compatible with python3, which seems to be my default when using rosrun with Dockerfile_ros1_20_04...

Also needs updated to added to CMakeLists.

There are a few other things I think are needed for python3 compatibility, I didn't look too deeply into why mine is running in python3 but I did check on the kalibr_...validator one and that's also running in python3 so I think compatibility should be maintained?