@brief Get the submap ID include trajectory index and submap index

Compare two strings

Push new gap, move s count bytes further (skipping the gap). Collapse previous gap.

Collapse all gaps, return past-the-end pointer

@brief GetCenter: return center point of the box.