28 {
29 google::InitGoogleLogging(argv[0]);
30 FLAGS_alsologtostderr = true;
31 FLAGS_v = 3;
32
33 google::ParseCommandLineFlags(&argc, &argv, true);
34
36 FLAGS_qy, FLAGS_qz);
37 AINFO <<
"roll: " << euler.roll() <<
" pitch:" << euler.pitch()
38 << " yaw:" << euler.yaw();
41 FLAGS_qy, FLAGS_qz)
42 << " heading degree: "
43 << 180.0 / M_PI *
45 FLAGS_qy, FLAGS_qz);
46}
Any orientation of a rigid body on a 3-D space can be achieved by composing three rotations about the...
double QuaternionToHeading(const double qw, const double qx, const double qy, const double qz)