fixed the calibration and urdf writing