Updated code to use Q matrix generation from stereoRectify as we now have R and T matrices from calibration