Added new interface function for Group and SimpleGroup implementation

This will be used primarily by the KDTree, but we want to have a clean
interface that is modular and readable, so we need to put this finish function
to group and quasi implement it in SimpleGroup.