Camera calibration and intensity based image registration for mapping and other applications