Fixed typo
This commit is contained in:
parent
7cf67db332
commit
2ccdfe6853
1 changed files with 1 additions and 1 deletions
|
@ -1194,7 +1194,7 @@ Vec3d extract_euler_angles(const Eigen::Matrix<double, 3, 3, Eigen::DontAlign>&
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
angles(1) = 0.0;
|
angles(0) = 0.0;
|
||||||
angles(1) = ::atan2(-rotation_matrix(2, 0), sy);
|
angles(1) = ::atan2(-rotation_matrix(2, 0), sy);
|
||||||
angles(2) = (angles(1) >-0.0) ? ::atan2(rotation_matrix(1, 2), rotation_matrix(1, 1)) : ::atan2(-rotation_matrix(1, 2), rotation_matrix(1, 1));
|
angles(2) = (angles(1) >-0.0) ? ::atan2(rotation_matrix(1, 2), rotation_matrix(1, 1)) : ::atan2(-rotation_matrix(1, 2), rotation_matrix(1, 1));
|
||||||
}
|
}
|
||||||
|
|
Loading…
Add table
Reference in a new issue