Scalable magnetic field SLAM in 3D using Gaussian process maps