This is an add-on to the OCamCalib toolbox by Scaramuzza et al. - View it on GitHub