void cMathUtil::Clamp(const Eigen::VectorXd& min, const Eigen::VectorXd& max, Eigen::VectorXd& out_vec) { out_vec = out_vec.cwiseMin(max).cwiseMax(min); }