| 5 | typedef Eigen::Matrix<adouble, 3, 1> Vector3ad; |
| 6 | |
| 7 | TEST(Utils, crossProduct) { |
| 8 | Vector3ad a, b, c; |
| 9 | a << 1, 2, 3; |
| 10 | b << 1, 5, 7; |
| 11 | |
| 12 | cross(a.data(), b.data(), c.data()); |
| 13 | |
| 14 | ASSERT_EQ(c[0], -1); |
| 15 | ASSERT_EQ(c[1], -4); |
| 16 | ASSERT_EQ(c[2], 3); |
| 17 | } |