Added print function. Tried to get original extrinsics to compare to optimized extrinsics. Original extrinsics do not seem correct, more changes to come.
Added print function. Tried to get original extrinsics to compare to optimized extrinsics.
Original extrinsics do not seem correct, more changes to come.

drchrislewis/industrial_calibration,ros-industrial/industrial_calibration,ros-industrial/industrial_calibration,akgoins/industrial_calibration,ros-industrial/industrial_calibration,ros-industrial/industrial_calibration,drchrislewis/industrial_calibration,akgoins/industrial_calibration,akgoins/industrial_calibration,drchrislewis/industrial_calibration,drchrislewis/industrial_calibration