Force add and extrinsic scale

[aharmat]

Should be able to force add an MKF during extrinsic calibration. Should have an indication during extrinsic calibration of how sensitive the solution is to scale (median radial covariance, or at the very least fraction of points that are small distance from camera compared to baseline)