Handling of octomaps in oroGen