A COMPACT HANDHELD SENSOR PACKAGE WITH SENSOR FUSION FOR COMPREHENSIVE AND ROBUST 3D MAPPING