MonoSLAM to self calibrate endoscope cameras