| 104 | } |
| 105 | |
| 106 | double CEvalMath::YawDiff(const CEuler &euler1, const CEuler &euler2) { |
| 107 | Eigen::Vector3d axis_x = {1.0, 0.0, 0.0}; |
| 108 | Eigen::Vector3d rotated_axis_x = euler1.GetRotMatrix().inverse() * euler2.GetRotMatrix() * axis_x; |
| 109 | return std::atan2(rotated_axis_x[1], rotated_axis_x[0]); |
| 110 | } |
| 111 | |
| 112 | // calculate yaw of each location |
| 113 | void CEvalMath::CalYaws(EvalPoints &locs) {} |
nothing calls this directly
no test coverage detected