What does this function do? Do we really need an eigen_utils pkg? What else will we have there? If used only in this .cpp, please put this function in an anonymous namespace.