Update parameters to const reference in eigen utils