diff --git a/src/Drawing/Visualizer_GLUT.cpp b/src/Drawing/Visualizer_GLUT.cpp index ec671f32..cd4f4649 100644 --- a/src/Drawing/Visualizer_GLUT.cpp +++ b/src/Drawing/Visualizer_GLUT.cpp @@ -486,9 +486,9 @@ void Visualizer_GLUT::VisualizeQuadCopter(shared_ptr quad) if (showPropCommands) { V3D pos = quad->Position(); - V3D fl = quad->GetArmLength() / sqrtf(2) * quad->Attitude().Rotate_BtoI(V3F(1, 1, 0)); - V3D fr = quad->GetArmLength() / sqrtf(2) * quad->Attitude().Rotate_BtoI(V3F(1, -1, 0)); - V3D down = fl.cross(fr).norm(); + V3D fr = quad->GetArmLength() / sqrtf(2) * quad->Attitude().Rotate_BtoI(V3F(1, 1, 0)); + V3D fl = quad->GetArmLength() / sqrtf(2) * quad->Attitude().Rotate_BtoI(V3F(1, -1, 0)); + V3D down = fr.cross(fl).norm(); const float maxThrust = 4.5f; VehicleCommand cmd = quad->GetCommands();