Moved closest point code from compositemodel to gotools-core (utils)