Added in extrinsic calibration. Need to test