Reference implementation of the FROctoMap