Actually Eigen::Quaterniond arg order is *w* xyz

This commit is contained in:
Thomas Krijnen
2025-03-28 12:10:03 +01:00
parent f08f9ad310
commit e9460a2c9a
+2 -1
View File
@@ -874,7 +874,8 @@ void mapping::initialize_units_() {
if (settings_.get<ModelRotation>().has()) {
auto vs = settings_.get<ModelRotation>().get();
if (vs.size() == 4) {
auto m3 = Eigen::Quaterniond(vs[0], vs[1], vs[2], vs[3]).normalized().matrix();
// @nb W, X, Y, Z
auto m3 = Eigen::Quaterniond(vs[3], vs[0], vs[1], vs[2]).normalized().matrix();
Eigen::Matrix4d m4 = Eigen::Matrix4d::Identity();
m4 << m3;
offset_and_rotation_ *= m4;