1 #ifndef EIQUADPROG_UTILS_HPP_
2 #define EIQUADPROG_UTILS_HPP_
11 template <
typename Scalar>
18 return a1 * std::sqrt(1.0 + t * t);
21 return b1 * std::sqrt(1.0 + t * t);
23 return a1 * std::sqrt(2.0);
26 template <
class Derived>
27 void print_vector(
const char *name, Eigen::MatrixBase<Derived> &x) {
28 std::cerr << name << x.transpose() << std::endl;
30 template <
class Derived>
31 void print_matrix(
const char *name, Eigen::MatrixBase<Derived> &x) {
32 std::cerr << name << std::endl << x << std::endl;
35 template <
class Derived>
36 void print_vector(
const char *name, Eigen::MatrixBase<Derived> &x,
int ) {
39 template <
class Derived>
40 void print_matrix(
const char *name, Eigen::MatrixBase<Derived> &x,
int ) {