Gaussian process occupancy mapping and reconstruction in C++