Beispiel #1
0
 inline static void rotateVector(Eigen::Matrix<Scalar,3,1>& A_r, const Rotation& rotation, const Eigen::Matrix<Scalar,3,1>& B_r) {
   A_r = rotation.rotate(B_r);
 }