Update stereocalibrate.cpp

Hey, just found this small error in your code and thanks a ton for the source code!