Normalize model-rotation quaternion

This commit is contained in:
Thomas Krijnen
2025-03-19 11:40:54 +01:00
parent d912012f76
commit 26b55216ca
+1 -1
View File
@@ -874,7 +874,7 @@ 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]).matrix();
auto m3 = Eigen::Quaterniond(vs[0], vs[1], vs[2], vs[3]).normalized().matrix();
Eigen::Matrix4d m4 = Eigen::Matrix4d::Identity();
m4 << m3;
offset_and_rotation_ *= m4;