| 109 | |
| 110 | template <typename T> |
| 111 | void CheckAngleAxis(const Eigen::AngleAxis<T>& value) |
| 112 | { |
| 113 | const T norm_error = fabs(value.axis().norm() - 1); |
| 114 | DART_UNUSED(norm_error); |
| 115 | DART_ASSERT(norm_error < kCheckTolerance && "Axis is not normalized"); |
| 116 | } |
| 117 | |
| 118 | } // namespace |
| 119 |