robocuprescue 2014 - robot league team hector darmstadt ( germany ) .
A flexible and scalable SLAM system with full 3D motion estimation