| 1 | #include <iostream.h> | 
|---|
| 2 | #include <stdlib.h> | 
|---|
| 3 | #include <stdio.h> | 
|---|
| 4 | #include <string.h> | 
|---|
| 5 | #include <math.h> | 
|---|
| 6 |  | 
|---|
| 7 | #ifndef M_PI | 
|---|
| 8 | #define M_PI 3.1415926535 | 
|---|
| 9 | #endif | 
|---|
| 10 |  | 
|---|
| 11 | #ifndef M_2PI | 
|---|
| 12 | #define M_2PI (2*M_PI) | 
|---|
| 13 | #endif | 
|---|
| 14 |  | 
|---|
| 15 | #include "plgalcross.h" | 
|---|
| 16 |  | 
|---|
| 17 | ////////////////////////////////////////////////////////////////////////// | 
|---|
| 18 | //                                cmv 24/9/1999 | 
|---|
| 19 | // Pour calculer les azimuth (E of N) d'intersection d'une direction avec | 
|---|
| 20 | // le plan galactique: | 
|---|
| 21 | // ---- INPUT: | 
|---|
| 22 | // TSid : temps sideral (heures decimales [0,24[) | 
|---|
| 23 | // Lat : latitude du lieu (degres decimaux [-90,90]) | 
|---|
| 24 | // zRot : angle de rotation de l'axe du detecteur avec le zenith | 
|---|
| 25 | //        (0 = zenith, degres decimaux [0,180]). | 
|---|
| 26 | // alpG,decG : alpha,delta du vecteur perpendiculaire au plan considere | 
|---|
| 27 | //             (heures et degres decimaux alpG=[0,24[, decG=[-90,90]) | 
|---|
| 28 | //     ex: Galactic plane, original IAU definition of galactic | 
|---|
| 29 | //         North pole is : (12h 49mn    ,+27d 24'    , 1950) | 
|---|
| 30 | //                   soit  (12h 51mn 30s,+27d 07' 42", 2000) | 
|---|
| 31 | // ---- OUTPUT: | 
|---|
| 32 | // azCr1,2 : azimuths (E of N) d'intersection du plan definit au dessus | 
|---|
| 33 | //           avec le cercle balaye par l'axe du detecteur | 
|---|
| 34 | //           (degres decimaux [0,360[). | 
|---|
| 35 | //           Angle + sens retrograde (N>E>S>W), origine au Nord. | 
|---|
| 36 |  | 
|---|
| 37 | // ---- RETURN VALUE: | 
|---|
| 38 | //  -1 : mauvaise valeur en entree, relisez la doc! | 
|---|
| 39 | //   0 : OK, une ou deux intersections | 
|---|
| 40 | //   1 : pas d'intersection | 
|---|
| 41 | //   2 : 1 solution avec azimuth indetermine (sur l'axe +oZ ou -oZ) | 
|---|
| 42 | //   4 : une infinite d'intersections pour tous les azimuths | 
|---|
| 43 | //       (dans plan horizontal) | 
|---|
| 44 | ////////////////////////////////////////////////////////////////////////// | 
|---|
| 45 |  | 
|---|
| 46 | int PlGalCross(double TSid,double Lat,double zRot,double alpG,double decG | 
|---|
| 47 | ,double& azCr1,double& azCr2) | 
|---|
| 48 | { | 
|---|
| 49 | azCr1=0.,azCr2=0.; | 
|---|
| 50 |  | 
|---|
| 51 | if(TSid<0.   || TSid>=24.) return -1; | 
|---|
| 52 | if(Lat<-90.  || Lat>90.  ) return -1; | 
|---|
| 53 | if(zRot<0.   || zRot>180.) return -1; | 
|---|
| 54 | if(alpG<0.   || alpG>=24.) return -1; | 
|---|
| 55 | if(decG<-90. || decG>90. ) return -1; | 
|---|
| 56 |  | 
|---|
| 57 | // (ag,hg)=(azimuth,elevation) du vecteur G perpendiculaire au plan | 
|---|
| 58 | double aG, hG; | 
|---|
| 59 | EquatToHoriz(alpG,decG,TSid,Lat,aG,hG); | 
|---|
| 60 | //printf("PlGalCross: tsid=%g lat=%g perp plan: alpha=%g dec=%g\n" | 
|---|
| 61 | //      ,TSid,Lat,alpG,decG); | 
|---|
| 62 | //printf("            -> elev=%g azi=%g (+180=%g)\n" | 
|---|
| 63 | //      ,hG,aG,((aG>180.)?aG-180.:aG+180.)); | 
|---|
| 64 |  | 
|---|
| 65 | // on convertit l'angle "zRot" en elevation des coord horizontales | 
|---|
| 66 | double hRot = 90.-zRot; | 
|---|
| 67 | //printf("PlGalCross: axe rot: elev = %g  dist.zen = %g\n",hRot,zRot); | 
|---|
| 68 |  | 
|---|
| 69 | // on convertit en radian | 
|---|
| 70 | hRot /= DEG_IN_RADIAN; aG /= DEG_IN_RADIAN; hG /= DEG_IN_RADIAN; | 
|---|
| 71 |  | 
|---|
| 72 | // Resolution de l'intersection: | 
|---|
| 73 | // Dans le repere horizontal, on cherche le lieu des points M | 
|---|
| 74 | // du plan considere (OM.G=0) ayant l'elevation hRot. | 
|---|
| 75 | // Soient (a,h)=(azimuth,elevation) du point M (vecteur OM) | 
|---|
| 76 | // ATTENTION: l'azimuth aM,aG tourne + dans sens retrograde (N>E>S>W)! | 
|---|
| 77 | // En coordonnees cartesiennes: | 
|---|
| 78 | //     |  cos(h).cos(a) |      |  cos(hG).cos(aG) | | 
|---|
| 79 | // OM= | -cos(h).sin(a) |   G= | -cos(hG).sin(aG) | | 
|---|
| 80 | //     |  sin(h)        |      |  sin(hG)         | | 
|---|
| 81 | // OM.G=0 avec h=hRot et ||OM||=1 | 
|---|
| 82 | // - Equation du plan : a*x + b*y + c*z = 0 | 
|---|
| 83 | // - Equation du cercle que decrit l'axe du detecteur sur la sphere celeste: | 
|---|
| 84 | //            x^2 + y^2 = R^2  et z=sin(hRot) avec R=cos(hRot) | 
|---|
| 85 | // - Equation de la droite d'intersection du plan avec le plan du cercle: | 
|---|
| 86 | //            a*x + b*y + c*z = 0 avec z=sin(hRot)=cos(zRot) | 
|---|
| 87 | double ch=cos(hRot); | 
|---|
| 88 | double z=sin(hRot), chG=cos(hG), shG=sin(hG); | 
|---|
| 89 | if(ch*ch<SMALL_ANGLE_2) { | 
|---|
| 90 | // ch=0 : le detecteur ne tourne pas (zRot==0 ou 180), | 
|---|
| 91 | // il est selon l'axe OZ ou -OZ. Une seule solution possible | 
|---|
| 92 | // si le plan passe par le pole cad si hG==0 et l'azimuth | 
|---|
| 93 | // est indetermine. | 
|---|
| 94 | if(shG*shG<SMALL_ANGLE_2) return 2; else return 1; | 
|---|
| 95 | } else if(chG*chG<SMALL_ANGLE_2) { | 
|---|
| 96 | // chG==0 : le plan est dans le plan horizontal. Seules intersections | 
|---|
| 97 | // possibles si le detecteur tourne dans le plan horizontal cad si hRot=0. | 
|---|
| 98 | // Dans ce cas une infinite d'intersections pour tous les azimuths. | 
|---|
| 99 | if(z*z<SMALL_ANGLE_2) return 3; else return 1; | 
|---|
| 100 | } else { | 
|---|
| 101 | double a=chG*cos(aG), b=-chG*sin(aG), cz=shG*z, R2=ch*ch; | 
|---|
| 102 | //printf("PlGalCross: plan a=%g b=%g c=%g R=%g\n",a,b,shG,ch); | 
|---|
| 103 | //Stabilite numerique: |b|>|a| on resoud pour "x" sinon pour "y" | 
|---|
| 104 | // **** cas 1-/ |b|>|a|  :  droite y = -(a/b)*x-cz/b | 
|---|
| 105 | //      cas 2-/ |b|<=|a| :  droite x = -(b/a)*y-cz/a | 
|---|
| 106 | // **** En remplacant dans l'equation du cercle | 
|---|
| 107 | //      cas 1-/ Ax^2+2Bx+C=0 | 
|---|
| 108 | //              A=1+(a/b)^2; B=acz/b^2; C=(cz/b)^2-R^2 | 
|---|
| 109 | //      cas 2-/ Ay^2+2By+C=0 | 
|---|
| 110 | //              A=1+(b/a)^2; B=bcz/a^2; C=(cz/a)^2-R^2 | 
|---|
| 111 | // **** Solutions: det=B^2-AC et sol=(-B +/- sqrt(det))/A | 
|---|
| 112 | //      cas 1-/ x1,x2 ==> y = -(a/b)*x-cz/b ==> y1,y2 | 
|---|
| 113 | //      cas 2-/ y1,y2 ==> x = -(b/a)*x-cz/a ==> x1,x2 | 
|---|
| 114 | // **** Azimuth: az=atan2(-y/cos(hRot),x/cos(hRot)) | 
|---|
| 115 | //               (car sens retrograde cf eq OM=|...|) | 
|---|
| 116 | bool calcx = (fabs(b)>fabs(a))? true: false; | 
|---|
| 117 | double A,B,C; | 
|---|
| 118 | if(calcx) {A=1+a*a/(b*b); B=a*cz/(b*b); C=cz*cz/(b*b)-R2;} | 
|---|
| 119 | else    {A=1+b*b/(a*a); B=b*cz/(a*a); C=cz*cz/(a*a)-R2;} | 
|---|
| 120 | // Resolution | 
|---|
| 121 | double det = B*B-A*C; | 
|---|
| 122 | if(det<0.) return 1; | 
|---|
| 123 | double sol1 = (-B+sqrt(det))/A, sol2 = (-B-sqrt(det))/A; | 
|---|
| 124 | double x1,x2,y1,y2; | 
|---|
| 125 | if(calcx) {x1=sol1; x2=sol2; y1=-a/b*x1-cz/b; y2=-a/b*x2-cz/b;} | 
|---|
| 126 | else   {y1=sol1; y2=sol2; x1=-b/a*y1-cz/a; x2=-b/a*y2-cz/a;} | 
|---|
| 127 | //printf("PlGalCross: int1=(%g,%g,%g) int2=(%g,%g,%g)\n",x1,y1,z,x2,y2,z); | 
|---|
| 128 | // Calcul des azimuths | 
|---|
| 129 | azCr1 = atan2(-y1/ch,x1/ch); azCr2 = atan2(-y2/ch,x2/ch); | 
|---|
| 130 | // on convertit en degres decimaux | 
|---|
| 131 | azCr1 *= DEG_IN_RADIAN; azCr2 *= DEG_IN_RADIAN; | 
|---|
| 132 | if(azCr1<0.) azCr1+=360.; if(azCr1>=360.) azCr1-=360.; if(azCr1<0.) azCr1=0.; | 
|---|
| 133 | if(azCr2<0.) azCr2+=360.; if(azCr2>=360.) azCr2-=360.; if(azCr2<0.) azCr2=0.; | 
|---|
| 134 | //printf("PlGalCross: azCr1 = %g,    azCr2 = %g  (azCr1+azCr2)/2 = %g\n" | 
|---|
| 135 | //,azCr1,azCr2,((azCr1+azCr2>=720.)?(azCr1+azCr2)/2-360.:(azCr1+azCr2)/2)); | 
|---|
| 136 | return 0; | 
|---|
| 137 | } | 
|---|
| 138 |  | 
|---|
| 139 | } | 
|---|
| 140 |  | 
|---|
| 141 | //////////////////////////////////////////////////////////////////////////////// | 
|---|
| 142 | int EquatToHoriz(double alpha,double delta,double tsid,double latitude | 
|---|
| 143 | ,double& azimuth,double& elevation) | 
|---|
| 144 | // Pour convertir les coordonnees equatoriales en coordonnees horizontales | 
|---|
| 145 | // pour une latitude terrestre et un temps sideral donnes. | 
|---|
| 146 | // INPUT: | 
|---|
| 147 | //   alpha,delta : coord equat en heures [0,24[ et degres [-90,90] decimaux | 
|---|
| 148 | //   tsid : temps sideral en heures [0,24[ decimales | 
|---|
| 149 | //          (ou angle horaire du point vernal ou ascension droite du zenith) | 
|---|
| 150 | //          Pour une direction quelconque on a: tsid = ha+a | 
|---|
| 151 | //          ou "ha" est l'angle horaire et "a" l'ascension droite | 
|---|
| 152 | //   latitude : latitude du lieu en degre [-90,90] decimaux | 
|---|
| 153 | // OUTPUT: les coordonnees horizontales: | 
|---|
| 154 | //   azimuth : azimuth (E of N) degre [0,360[ decimaux | 
|---|
| 155 | //             tourne +  sens retrograde (N>E>S>W), origine au Nord, | 
|---|
| 156 | //             azimuth "des marins" (serveur BDL, USNO, xephem , skycalc...) | 
|---|
| 157 | //   elevation : elevation degre [-90,90] decimaux | 
|---|
| 158 | //               (distance zenithale z = 90-elevation) | 
|---|
| 159 | // RETURN: 0 si Ok, 1 si probleme | 
|---|
| 160 | // TRANSFO: (dans cette formule l'origine des azimuths est au Sud, | 
|---|
| 161 | //           azimut "des astronomes" ou  (E of S)) | 
|---|
| 162 | // sin(azi) cos(elev) = sin(ha) cos(dec) | 
|---|
| 163 | // cos(azi) cos(elev) = cos(ha) cos(dec) sin(lat) - sin(dec) cos(lat) | 
|---|
| 164 | //          sin(elev) = cos(ha) cos(dec) cos(lat) + sin(dec) sin(lat) | 
|---|
| 165 | // avec azi=azimuth (E of S), elev=elevation, lat=latitude, | 
|---|
| 166 | //      dec=declinaison, ha=angle horaire=tsid-alpha | 
|---|
| 167 | // Puis azi(E of S) = azi(E of N) + Pi | 
|---|
| 168 | { | 
|---|
| 169 | azimuth = elevation = 0.; | 
|---|
| 170 | if(alpha<0.      || alpha>=24   )   return 1; | 
|---|
| 171 | if(delta<-90.    || delta>90.   ) return 1; | 
|---|
| 172 | if(tsid<0.       || tsid>=24.   ) return 1; | 
|---|
| 173 | if(latitude<-90. || latitude>90.) return 1; | 
|---|
| 174 | // conversion en radians | 
|---|
| 175 | alpha /= HRS_IN_RADIAN; delta    /= DEG_IN_RADIAN; | 
|---|
| 176 | tsid  /= HRS_IN_RADIAN; latitude /= DEG_IN_RADIAN; | 
|---|
| 177 |  | 
|---|
| 178 | double cl = cos(latitude),   sl = sin(latitude); | 
|---|
| 179 | double ch = cos(tsid-alpha), sh = sin(tsid-alpha); | 
|---|
| 180 | double cd = cos(delta),      sd = sin(delta); | 
|---|
| 181 |  | 
|---|
| 182 | // calcul de l'elevation [-90,90] | 
|---|
| 183 | elevation = ch*cd*cl+sl*sd; | 
|---|
| 184 | if(elevation<-1.) elevation=-1.; if(elevation>1.) elevation=1.; | 
|---|
| 185 | elevation = asin(elevation); //entre [-Pi/2,Pi/2] | 
|---|
| 186 |  | 
|---|
| 187 | // calcul de l'azimuth | 
|---|
| 188 | double ce = cos(elevation); | 
|---|
| 189 | if(fabs(ce)<SMALL_ANGLE) { //elevation=-Pi/2 ou Pi/2 | 
|---|
| 190 | azimuth = 0.; //azimuth indifferent | 
|---|
| 191 | } else { | 
|---|
| 192 | azimuth = atan2(sh*cd/ce,(ch*cd*sl-sd*cl)/ce); //entre -Pi et +Pi | 
|---|
| 193 | azimuth += M_PI; //azimuth (E of S) -> (E of N) | 
|---|
| 194 | } | 
|---|
| 195 |  | 
|---|
| 196 | azimuth *= DEG_IN_RADIAN; elevation *= DEG_IN_RADIAN; | 
|---|
| 197 | // Ca ne doit pas arriver sauf pb de precision machine | 
|---|
| 198 | if(azimuth<0. || azimuth>=360.) azimuth = 0.; | 
|---|
| 199 | if(elevation<-90.) elevation = -90.; if(elevation>90.) elevation = 90.; | 
|---|
| 200 | return 0; | 
|---|
| 201 | } | 
|---|
| 202 |  | 
|---|
| 203 | //////////////////////////////////////////////////////////////////////////////// | 
|---|
| 204 | int FindPerpEquat(double a1,double d1,double a2,double d2,double& ap,double& dp) | 
|---|
| 205 | // Pour trouver les coordonnees equatoriales du vecteur perpendiculaire | 
|---|
| 206 | // a deux autres vecteurs. | 
|---|
| 207 | // INPUT: | 
|---|
| 208 | //  a1,d1 : alpha,delta de la premiere direction en | 
|---|
| 209 | //          (heures decimales et degres decimaux) | 
|---|
| 210 | //  a2,d2 : alpha,delta de la deuxieme direction en | 
|---|
| 211 | //          (heures decimales et degres decimaux) | 
|---|
| 212 | // OUTPUT: | 
|---|
| 213 | //  ap,dp : alpha,delta de la direction perpendiculaire | 
|---|
| 214 | //          telle que 1,2,p fasse un triedre direct | 
|---|
| 215 | //          (heures decimales et degres decimaux) | 
|---|
| 216 | // RETURN: | 
|---|
| 217 | //  0 = OK, 1 = probleme | 
|---|
| 218 | { | 
|---|
| 219 | ap = dp = 0.; | 
|---|
| 220 | a1 /= HRS_IN_RADIAN; d1 /= DEG_IN_RADIAN; | 
|---|
| 221 | a2 /= HRS_IN_RADIAN; d2 /= DEG_IN_RADIAN; | 
|---|
| 222 | // coordonnees cartesiennes | 
|---|
| 223 | double v1[3],v2[3],vp[3]; | 
|---|
| 224 | v1[0]=cos(d1)*cos(a1); v1[1]=cos(d1)*sin(a1); v1[2]=sin(d1); | 
|---|
| 225 | v2[0]=cos(d2)*cos(a2); v2[1]=cos(d2)*sin(a2); v2[2]=sin(d2); | 
|---|
| 226 | vp[0]=v1[1]*v2[2]-v1[2]*v2[1]; vp[1]=v1[2]*v2[0]-v1[0]*v2[2]; | 
|---|
| 227 | vp[2]=v1[0]*v2[1]-v1[1]*v2[0]; | 
|---|
| 228 | double nvp = vp[0]*vp[0]+vp[1]*vp[1]+vp[2]*vp[2]; | 
|---|
| 229 | if(nvp<=0.) return 1; | 
|---|
| 230 | nvp = sqrt(nvp); | 
|---|
| 231 | vp[0] /= nvp; vp[1] /= nvp; vp[2] /= nvp; | 
|---|
| 232 | // | vp[0] |   | cos(dp)*cos(ap) | | 
|---|
| 233 | // | vp[1] | = | cos(dp)*sin(ap) | | 
|---|
| 234 | // | vp[2] |   | sin(dp)         | | 
|---|
| 235 | dp = asin(vp[2]); // asin retourne entre -Pi/2 et Pi/2 ... Ok | 
|---|
| 236 | double cdp = cos(dp); | 
|---|
| 237 | if(fabs(cdp)<SMALL_ANGLE) { // cas ou dp=+Pi/2 ou -Pi/2, ap est indifferent | 
|---|
| 238 | ap = 0.; | 
|---|
| 239 | } else { | 
|---|
| 240 | ap = atan2(vp[1]/cdp,vp[0]/cdp); // renvoie entre -Pi et +Pi | 
|---|
| 241 | if(ap<0.) ap += M_2PI; | 
|---|
| 242 | } | 
|---|
| 243 |  | 
|---|
| 244 | ap *= HRS_IN_RADIAN; dp *= DEG_IN_RADIAN; | 
|---|
| 245 | // Ca ne doit pas arriver sauf pb de precision machine | 
|---|
| 246 | if(ap<0. || ap>=24.) ap = 0.; | 
|---|
| 247 | if(dp<-90.) dp = -90.; if(dp>90.) dp = 90.; | 
|---|
| 248 | return 0; | 
|---|
| 249 | } | 
|---|