Changeset 7976412 in OpenModelica

Timestamp:

2016-04-01T11:58:07+02:00 (8 years ago)

Author:

Robert Braun <robert.braun@…>

Branches:

Added-citation-metadata, maintenance/v1.14, maintenance/v1.15, maintenance/v1.16, maintenance/v1.17, maintenance/v1.18, maintenance/v1.19, maintenance/v1.20, maintenance/v1.21, maintenance/v1.22, maintenance/v1.23, master, omlib-staging

Children:

7368537b

Parents:

ae0b1748

Message:

Re-wrote getRotationMatrix function in MetaModelEditor.

File:

• OMEdit/OMEditGUI/Editors/MetaModelEditor.cpp (modified) (2 diffs)

OMEdit/OMEditGUI/Editors/MetaModelEditor.cpp

@@ -507 +507 @@
 QGenericMatrix<3,3, double> MetaModelEditor::getRotationMatrix(QGenericMatrix<3,1,double> rotation)
 {
-  double alpha = rotation(0,0);
-  double beta = rotation(0,1);
-  double gamma = rotation(0,2);
-
-  //Compute rotational matrix around x-axis
-  double Rx_data[9];
-  Rx_data[0] = 1;             Rx_data[1] = 0;             Rx_data[2] = 0;
-  Rx_data[3] = 0;             Rx_data[4] = cos(alpha);    Rx_data[5] = -sin(alpha);
-  Rx_data[6] = 0;             Rx_data[7] = sin(alpha);    Rx_data[8] = cos(alpha);
-  QGenericMatrix<3,3,double> Rx(Rx_data);
-
-  //Compute rotational matrix around y-axis
-  double Ry_data[9];
-  Ry_data[0] = cos(beta);     Ry_data[1] = 0;             Ry_data[2] = sin(beta);
-  Ry_data[3] = 0;             Ry_data[4] = 1;             Ry_data[5] = 0;
-  Ry_data[6] = -sin(beta);    Ry_data[7] = 0;             Ry_data[8] = cos(beta);
-
-  QGenericMatrix<3,3,double> Ry(Ry_data);
-
-  //Compute rotational matrix around z-axis
-  double Rz_data[9];
-  Rz_data[0] = cos(gamma);    Rz_data[1] = -sin(gamma);   Rz_data[2] = 0;
-  Rz_data[3] = sin(gamma);    Rz_data[4] = cos(gamma);    Rz_data[5] = 0;
-  Rz_data[6] = 0;             Rz_data[7] = 0;             Rz_data[8] = 1;
-  QGenericMatrix<3,3,double> Rz(Rz_data);
-
-
-  //Compute complete rotational matrix
-  QGenericMatrix<3,3,double> R = Rz*Ry*Rx;
+  double c1 = cos(rotation(0,0));
+  double s1 = sin(rotation(0,0));
+  double c2 = cos(rotation(0,1));
+  double s2 = sin(rotation(0,1));
+  double c3 = cos(rotation(0,2));
+  double s3 = sin(rotation(0,2));
+
+  double R_data[9];
+  R_data[0] = c2*c3;             R_data[1] = c2*s3;              R_data[2] = -s2;
+  R_data[3] = -c1*s3+s1*s2*c3;   R_data[4] = c1*c3+s1*s2*s3;     R_data[5] = s1*c2;
+  R_data[6] = s1*s3+c1*s2*c3;    R_data[7] = -s1*c3+c1*s2*s3;    R_data[8] = c1*c2;
+
+  QGenericMatrix<3,3,double> R(R_data);
 
   return R;
@@ -737 +721 @@
   }
 
-#if 0
+#if 1
   qDebug() << R_CG_C1;
   qDebug() << R_CG_C2;