int main(int argc, char **argv) {
double angle = 60 * M_PI / 180;
double axis[3] = {0, 0, 1 / angle};
double r[9];
ceres::AngleAxisToRotationMatrix(axis, r);
double pt[3] = {1,1,1};
double pt_rotate[3];
ceres::AngleAxisRotatePoint(axis, pt, pt_rotate);
double pt_rotate_matrix[3];
for (int i = 0; i < 3; ++i) {
pt_rotate_matrix[i] = pt[0] * r[i * 3] + pt[1] * r[i * 3 + 1] + pt[2] * r[i * 3 + 2];
LOG(INFO) << "diff i: " << pt_rotate_matrix[i] - pt_rotate[i];
}
}
I0514 17:21:13.835876 6115 localizer.cpp:230] diff i: 1.63255
I0514 17:21:13.836115 6115 localizer.cpp:230] diff i: -1.63255
I0514 17:21:13.836140 6115 localizer.cpp:230] diff i: 0