Fixed some calibration bugs

Detects calibration pattern, but still not 100% ready for single cam
calibration though.