diff options
author | Stanislaw Halik <sthalik@misaki.pl> | 2017-05-16 03:31:41 +0200 |
---|---|---|
committer | Stanislaw Halik <sthalik@misaki.pl> | 2017-05-16 03:31:41 +0200 |
commit | 8bab49e4bccb8f4a43d59d642a0501d80a9235d0 (patch) | |
tree | 64869e862115c7013559e1b4c77052a3cad18d1f /compat/euler.cpp | |
parent | 6faab6ff960e2dd04aa35e8ef1aa62bce2976725 (diff) |
compat/euler: return using an initializer list
Will come back to the same simplification elsewher.e
Diffstat (limited to 'compat/euler.cpp')
-rw-r--r-- | compat/euler.cpp | 68 |
1 files changed, 39 insertions, 29 deletions
diff --git a/compat/euler.cpp b/compat/euler.cpp index ab119d3e..f02365c9 100644 --- a/compat/euler.cpp +++ b/compat/euler.cpp @@ -11,13 +11,17 @@ euler_t OTR_COMPAT_EXPORT rmat_to_euler(const rmat& R) const double cy = sqrt(R(2,2)*R(2, 2) + R(2, 1)*R(2, 1)); const bool large_enough = cy > 1e-10; if (large_enough) - return euler_t(atan2(-R(1, 0), R(0, 0)), - atan2(R(2, 0), cy), - atan2(-R(2, 1), R(2, 2))); + return { + atan2(-R(1, 0), R(0, 0)), + atan2(R(2, 0), cy), + atan2(-R(2, 1), R(2, 2)) + }; else - return euler_t(atan2(R(0, 1), R(1, 1)), - atan2(R(2, 0), cy), - 0); + return { + atan2(R(0, 1), R(1, 1)), + atan2(R(2, 0), cy), + 0 + }; } // tait-bryan angles, not euler @@ -37,20 +41,20 @@ rmat OTR_COMPAT_EXPORT euler_to_rmat(const euler_t& input) const auto c3 = cos(B); const auto s3 = sin(B); - return rmat( - // z - c1 * c2, - c1 * s2 * s3 - c3 * s1, - s1 * s3 + c1 * c3 * s2, - // y - c2 * s1, - c1 * c3 + s1 * s2 * s3, - c3 * s1 * s2 - c1 * s3, - // x - -s2, - c2 * s3, - c2 * c3 - ); + return { + // z + c1*c2, + c1*s2*s3 - c3*s1, + s1*s3 + c1*c3*s2, + // y + c2*s1, + c1*c3 + s1*s2*s3, + c3*s1*s2 - c1*s3, + // x + -s2, + c2*s3, + c2*c3 + }; } // https://en.wikipedia.org/wiki/Davenport_chained_rotations#Tait.E2.80.93Bryan_chained_rotations @@ -67,9 +71,11 @@ void OTR_COMPAT_EXPORT tait_bryan_to_matrices(const euler_t& input, const double sin_phi = sin(phi); const double cos_phi = cos(phi); - r_roll = rmat(1, 0, 0, - 0, cos_phi, -sin_phi, - 0, sin_phi, cos_phi); + r_roll = { + 1, 0, 0, + 0, cos_phi, -sin_phi, + 0, sin_phi, cos_phi + }; } { @@ -77,9 +83,11 @@ void OTR_COMPAT_EXPORT tait_bryan_to_matrices(const euler_t& input, const double sin_theta = sin(theta); const double cos_theta = cos(theta); - r_pitch = rmat(cos_theta, 0, -sin_theta, - 0, 1, 0, - sin_theta, 0, cos_theta); + r_pitch = { + cos_theta, 0, -sin_theta, + 0, 1, 0, + sin_theta, 0, cos_theta + }; } { @@ -87,9 +95,11 @@ void OTR_COMPAT_EXPORT tait_bryan_to_matrices(const euler_t& input, const double sin_psi = sin(psi); const double cos_psi = cos(psi); - r_yaw = rmat(cos_psi, -sin_psi, 0, - sin_psi, cos_psi, 0, - 0, 0, 1); + r_yaw = { + cos_psi, -sin_psi, 0, + sin_psi, cos_psi, 0, + 0, 0, 1 + }; } } |