Changeset 688 for BAORadio/libindi/libindi/communs/alignement.cpp

Timestamp:

Jun 8, 2012, 4:05:59 PM (12 years ago)

Author:

frichard

Message:

 

File:

• BAORadio/libindi/libindi/communs/alignement.cpp (modified) (20 diffs)

BAORadio/libindi/libindi/communs/alignement.cpp

@@ -125 +125 @@
     MATRICE[2][3] = 0.0;
     MATRICE[3][3] = 1.0;
+}
+
+void Alignement::AfficherMatrice()
+{
+    stringstream os;
+
+    os.str("");
+
+    // Affiche de la matrice pour vérif
+
+    os << "\nCalcul de la matrice de correction:\n";
+    os.width(15);
+    os << MATRICE[1][1];
+    os.width(15);
+    os << MATRICE[2][1];
+    os.width(15);
+    os << MATRICE[3][1]; 
+    os << "\n";
+    os.width(15);
+    os << MATRICE[1][2];
+    os.width(15);
+    os << MATRICE[2][2];
+    os.width(15);
+    os << MATRICE[3][2];
+    os << "\n";
+    os.width(15);
+    os << MATRICE[1][3];
+    os.width(15);
+    os << MATRICE[2][3];
+    os.width(15);
+    os << MATRICE[3][3];
+    os << "\n\nDeterminant :" << Determinant() << "\n";
+
+    AfficherLog(os.str(), true);
 }
 
@@ -388 +422 @@
     // Calcul du vecteur offset sur le ciel
 
-    VECT_OFFSET.x =0.0;//m1.x - ((a1.x * MATRICE[1][1]) + (a1.y * MATRICE[2][1]));
-    VECT_OFFSET.y =0.0;//m1.y - ((a1.x * MATRICE[1][2]) + (a1.y * MATRICE[2][2]));
+    VECT_OFFSET.x =m1.x - ((a1.x * MATRICE[1][1]) + (a1.y * MATRICE[2][1]));
+    VECT_OFFSET.y =m1.y - ((a1.x * MATRICE[1][2]) + (a1.y * MATRICE[2][2]));
 
     if (x + y == 0 )
@@ -417 +451 @@
 inline int Alignement::ElementsMatriceSimple(Coord aa1, Coord aa2, Coord aa3, Coord mm1, Coord mm2, Coord mm3)
 {
-// On se retouvre à devoir résoudre les equations:
-
     // mm1 = aa1 * MATRICE_Correction
     // mm2 = aa2 * MATRICE_Correction
     // mm3 = aa3 * MATRICE_Correction
 
-    // et donc à trouver les éléments de la matrice MATRICE_Correction en fonction des paramÚtres x, y, z des vecteurs
+    // On doit donc trouver les éléments de la matrice MATRICE_Correction en fonction des paramÚtres x, y, z des vecteurs
     // aa1, aa2, aa3, mm1, mm2, mm3
 
-    // Les éléments de la matrice se trouvent aisément
+    // Les éléments de la matrice se trouvent aisément :
 
     double div= aa1.z*aa2.y*aa3.x - aa1.y*aa2.z*aa3.x - aa1.z*aa2.x*aa3.y +
@@ -582 +614 @@
 
 
+/**************************************************************************************
+** Projection simple d'un point situé aux coordonnées (az, ha) dans un cercle de
+** rayon Pi / 2
+**
+***************************************************************************************/
 
 void Alignement::AzHa2XY(double az, double ha, double *x, double *y)
@@ -591 +628 @@
     *y = r * sin(az);
 }
+
 
 /**************************************************************************************
@@ -645 +683 @@
 }
 
+
+/**************************************************************************************
+** Initialise les cotes de l'instrument
+**
+***************************************************************************************/
 
 void Alignement::InitParametresInstrument()
@@ -655 +698 @@
     AE          = AE0;
     I0          = I00;
-    Thau        = Thau0;
+    Theta       = Theta0;
     CoeffMoteur = CoeffMoteur0;
 }
 
 
+
+/**************************************************************************************
+** Convertit un nombre de pas en hauteur en un angle exprimé en degrés
+**
+***************************************************************************************/
+
 double Alignement::Motor2Alt(double pas)
 {
-    return asin(( - pow( ( pas * CoeffMoteur0 ) + I00, 2.0 ) + 128279.4) / 129723.4 ) * N180divPi + Thau0;
-}
+    return asin(( - pow( ( pas * CoeffMoteur0 ) + I00, 2.0 ) + 128279.4) / 129723.4 ) * N180divPi + Theta0;
+}
+
+
+/**************************************************************************************
+** Convertit une hauteur (exprimée en degrés) en nombre de pas codeur
+**
+***************************************************************************************/
 
 double Alignement::Alt2Motor(double targetAlt)
@@ -679 +734 @@
     double CD2pBC2 = CD * CD + BC * BC;
 
-    double I2 = -2.0 * ED * sqrt( CD2pBC2 ) * sin(  ( targetAlt - Thau ) * Pidiv180 );
+    double I2 = -2.0 * ED * sqrt( CD2pBC2 ) * sin(  ( targetAlt - Theta ) * Pidiv180 );
 
     I2 += ED * ED + CD2pBC2 - AE *AE;
@@ -702 +757 @@
     // double memI0 = I00;
     double memCoeffMoteur = CoeffMoteur0;
-    double memThau = Thau0;
+    double memTheta = Theta0;
 
     stringstream os;
@@ -715 +770 @@
 
     InitParametresInstrument();
-
 
 
@@ -752 +806 @@
 
 
-    os << "m1=" << delta_de[0] << "   m11=" <<  Motor2Alt(Alt2Motor(delta_de[0])) << "\n";
-
-    AfficherLog(os.str(), true);
-    os.str("");
-
+    /*  os << "m1=" << delta_de[0] << "   m11=" <<  Motor2Alt(Alt2Motor(delta_de[0])) << "\n";
+
+      AfficherLog(os.str(), true);
+      os.str("");
+    */
     for (i=-interv; i< interv; i += pas)
     {
-        CoeffMoteur = CoeffMoteur0 + i/100.0;
+        CoeffMoteur = CoeffMoteur0 + i / 100.0;
 
         for (j=-interv; j<interv; j += pas)
@@ -773 +827 @@
                     BC = BC0 + l;
 
-                    Thau = (atan(CD / BC) - atan(18.5 / ED))* N180divPi;
+                    Theta = (atan(CD / BC) - atan(18.5 / ED))* N180divPi;
 
                     for (m=-interv; m< interv; m += pas)
@@ -810 +864 @@
                             os << "Determinant=" << det << "\n";
 
-                            os << "CD=" << CD << " ED=" << ED << " BC=" << BC << " AE=" << AE << " Thau=" << Thau << " CoeffMoteur=" << CoeffMoteur << "\n\n";
+                            os << "CD=" << CD << " ED=" << ED << " BC=" << BC << " AE=" << AE << " Theta=" << Theta << " CoeffMoteur=" << CoeffMoteur << "\n\n";
 
                             AfficherLog(os.str(), true);
@@ -820 +874 @@
                             memAE = AE;
                             memBC = BC;
-                            memThau = Thau;
+                            memTheta = Theta;
                             memCoeffMoteur = CoeffMoteur;
                         }
@@ -828 +882 @@
         }
 
-        AfficherLog("*\n", true);
+        if ((int)Arrondi((interv - i) / (2.0 * interv) * 100.0) % 10 == 0)
+        {
+            os.str("");
+            os << 100.0 - (interv - i) / (2.0 * interv) * 100.0 << " %\n";
+            AfficherLog(os.str(), true);
+        }
     }
 
@@ -838 +897 @@
     AE = memAE;
     BC = memBC;
-    Thau = memThau;
+    Theta = memTheta;
     CoeffMoteur = memCoeffMoteur;
 
@@ -866 +925 @@
     Matrice_ok = ElementsMatriceSimple(c1, c2, c3 ,mm1, mm2, mm3);
 
-    det = Determinant();
-
-
-
-    os << "Determinant=" << det << "\n";
-
-
-    AfficherLog(os.str(), true);
-
-
-
+    AfficherMatrice();
 }
 
@@ -932 +981 @@
         distances = new double [nbrcorrections+1];
 
-        os << "Coordonnées visees : ad=" << DHMS(ar * 15.0,true) << "  de=" << DHMS(dec,false) << "\n";
+        os << "Coordonnées visees : ad=" << DHMS(ar * 15.0
+
+
+                ,true) << "  de=" << DHMS(dec,false) << "\n";
 
         Azimut(ar * 15.0 * Pidiv180, dec * Pidiv180, &a2, &b2);
@@ -1099 +1151 @@
     }
 
-
-    // Affiche de la matrice pour vérif
-
-    os << "\nCalcul de la matrice de correction:\n";
-    os << MATRICE[1][1] << "   \t" << MATRICE[2][1] << "    \t" << MATRICE[3][1] << "\n";
-    os << MATRICE[1][2] << "   \t" << MATRICE[2][2] << "    \t" << MATRICE[3][2] << "\n";
-    os << MATRICE[1][3] << "   \t" << MATRICE[2][3] << "    \t" << MATRICE[3][3] << "\n";
-    os << "\nDeterminant :" << Determinant() << "\n";
+    //Afficher les messages de cette fonction
+
+    AfficherLog(os.str(), true);
+
+    AfficherMatrice();
 
 
@@ -1114 +1163 @@
     SelectionnePourCalculMatrice[map[best2]] = true;
     SelectionnePourCalculMatrice[map[best3]] = true;
-
-
-    //Afficher les messages de cette fonction
-
-    AfficherLog(os.str(), true);
 }