Volumetric 3D Mapping in Real-Time on a CPU