Methodologies for holistic and objective SLAM benchmarking and mapping accuracy enhancement