Eigen::Matrix3d matrix3d(3, 3);
matrix3d(0, 0) = -0.2822;
matrix3d(0, 1) = 0.9594;
matrix3d(0, 2) = 0;
matrix3d(1, 0) = 0.9594;
matrix3d(1, 1) = 0.2822;
matrix3d(1, 2) = 0;
matrix3d(2, 0) = 0;
matrix3d(2, 1) = 0;
matrix3d(2, 2) = 0;
matrix3d<<-0.2822, 0.9594 , 0.
,0.9594 , 0.2822, 0.
,-0. , 0. , -0. ;
网友评论