/[PAMELA software]/DarthVader/OrbitalInfo/src/OrbitalInfoCore.cpp
ViewVC logotype

Diff of /DarthVader/OrbitalInfo/src/OrbitalInfoCore.cpp

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 1.61 by mocchiut, Thu Feb 21 10:37:52 2013 UTC revision 1.84 by mocchiut, Thu Mar 26 14:55:38 2015 UTC
# Line 26  Line 26 
26  #include <TSQLServer.h>  #include <TSQLServer.h>
27  #include <TSQLRow.h>  #include <TSQLRow.h>
28  #include <TSQLResult.h>  #include <TSQLResult.h>
29    #include <TObjectTable.h>
30  //  //
31  // RunInfo header  // RunInfo header
32  //  //
# Line 48  Line 49 
49  #include <OrbitalInfoCore.h>  #include <OrbitalInfoCore.h>
50  #include <InclinationInfo.h>  #include <InclinationInfo.h>
51    
52    //
53    // Tracker and ToF classes headers and definitions
54    //
55    #include <ToFLevel2.h>
56    #include <TrkLevel2.h>
57    #include <ExtTrack.h> // new tracking code
58    
59  using namespace std;  using namespace std;
60    
# Line 55  using namespace std; Line 62  using namespace std;
62  // CORE ROUTINE  // CORE ROUTINE
63  //  //
64  //  //
65  int OrbitalInfoCore(UInt_t run, TFile *file, GL_TABLES *glt, Int_t OrbitalInfoargc, char *OrbitalInfoargv[]){  int OrbitalInfoCore(UInt_t run, TFile *file, GL_TABLES *glt, Int_t OrbitalInfoargc, char *OrbitalInfoargv[]){  
66    //    //
67    Int_t i = 0;    Int_t i = 0;
68    TString host = glt->CGetHost();    TString host = glt->CGetHost();
# Line 65  int OrbitalInfoCore(UInt_t run, TFile *f Line 72  int OrbitalInfoCore(UInt_t run, TFile *f
72    //    //
73    stringstream myquery;    stringstream myquery;
74    myquery.str("");    myquery.str("");
75    myquery << "SET time_zone='+0:00'";    myquery << "SET time_zone='+0:00';";
76    delete dbc->Query(myquery.str().c_str());    delete dbc->Query(myquery.str().c_str());
77      delete dbc->Query("SET sql_mode = 'NO_UNSIGNED_SUBTRACTION';");
78    //    //
79    TString processFolder = Form("OrbitalInfoFolder_%u",run);    TString processFolder = Form("OrbitalInfoFolder_%u",run);
80    //    //
# Line 84  int OrbitalInfoCore(UInt_t run, TFile *f Line 92  int OrbitalInfoCore(UInt_t run, TFile *f
92        if ( !strcmp(OrbitalInfoargv[i],"-processFolder") ) {        if ( !strcmp(OrbitalInfoargv[i],"-processFolder") ) {
93          if ( OrbitalInfoargc < i+1 ){          if ( OrbitalInfoargc < i+1 ){
94            throw -3;            throw -3;
95          };          }
96          processFolder = (TString)OrbitalInfoargv[i+1];          processFolder = (TString)OrbitalInfoargv[i+1];
97          i++;          i++;
98        };        }
99        if ( (!strcmp(OrbitalInfoargv[i],"--debug")) || (!strcmp(OrbitalInfoargv[i],"-g")) ) {        if ( (!strcmp(OrbitalInfoargv[i],"--debug")) || (!strcmp(OrbitalInfoargv[i],"-g")) ) {
100          verbose = true;          verbose = true;
101          debug = true;          debug = true;
102        };        }
103        if ( (!strcmp(OrbitalInfoargv[i],"--verbose")) || (!strcmp(OrbitalInfoargv[i],"-v")) ) {        if ( (!strcmp(OrbitalInfoargv[i],"--verbose")) || (!strcmp(OrbitalInfoargv[i],"-v")) ) {
104          verbose = true;          verbose = true;
105        };        }
106        if ( (!strcmp(OrbitalInfoargv[i],"--standalone")) ) {        if ( (!strcmp(OrbitalInfoargv[i],"--standalone")) ) {
107          standalone = true;          standalone = true;
108        };        }
109        if ( (!strcmp(OrbitalInfoargv[i],"--calculate-pitch")) ) {        if ( (!strcmp(OrbitalInfoargv[i],"--calculate-pitch")) ) {
110          standalone = false;          standalone = false;
111        };        }
112        i++;        i++;
113      };      }
114    };    }
115      if ( debug ){
116        printf("START\n");
117        gObjectTable->Print();
118      }
119    //    //
120    const char* outDir = gSystem->DirName(gSystem->DirName(file->GetPath()));    const char* outDir = gSystem->DirName(gSystem->DirName(file->GetPath()));
121    //    //
# Line 122  int OrbitalInfoCore(UInt_t run, TFile *f Line 134  int OrbitalInfoCore(UInt_t run, TFile *f
134    TTree *OrbitalInfotrclone = 0;    TTree *OrbitalInfotrclone = 0;
135    Bool_t reproc = false;    Bool_t reproc = false;
136    Bool_t reprocall = false;    Bool_t reprocall = false;
137      Bool_t igrfloaded = false;
138    UInt_t nobefrun = 0;    UInt_t nobefrun = 0;
139    UInt_t noaftrun = 0;    UInt_t noaftrun = 0;
140    UInt_t numbofrun = 0;    UInt_t numbofrun = 0;
# Line 182  int OrbitalInfoCore(UInt_t run, TFile *f Line 195  int OrbitalInfoCore(UInt_t run, TFile *f
195    //    //
196    // IGRF stuff    // IGRF stuff
197    //    //
198    Float_t dimo = 0.0; // dipole moment (computed from dat files)    Float_t dimo = 0.0; // dipole moment (computed from dat files) // EM GCC 4.7
199    Float_t bnorth, beast, bdown, babs;    Float_t bnorth, beast, bdown, babs;
200    Float_t xl; // L value    Float_t xl; // L value
201    Float_t icode; // code value for L accuracy (see fortran code)    Float_t icode; // code value for L accuracy (see fortran code)
# Line 235  int OrbitalInfoCore(UInt_t run, TFile *f Line 248  int OrbitalInfoCore(UInt_t run, TFile *f
248    // Initialize fortran routines!!!    // Initialize fortran routines!!!
249    Int_t ltp1 = 0;    Int_t ltp1 = 0;
250    Int_t ltp2 = 0;    Int_t ltp2 = 0;
251    Int_t ltp3 = 0;    GL_PARAM *glparam0 = new GL_PARAM();
   //  Int_t uno = 1;  
   //  const char *niente = " ";  
252    GL_PARAM *glparam = new GL_PARAM();    GL_PARAM *glparam = new GL_PARAM();
253    GL_PARAM *glparam2 = new GL_PARAM();    GL_PARAM *glparam2 = new GL_PARAM();
   GL_PARAM *glparam3 = new GL_PARAM();  
254    
255    //    //
256    // Orientation variables. Vitaly    // Orientation variables. Vitaly
257    //    //
258    
259    UInt_t evfrom = 0;    UInt_t evfrom = 0;
260    UInt_t jumped = 0;    UInt_t jumped = 0;
261    Int_t itr = -1;        Int_t itr = -1;    
262    Double_t A1;    //  Double_t A1;
263    Double_t A2;    //  Double_t A2;
264    Double_t A3;    //  Double_t A3;
265    Double_t Px = 0;    Double_t Px = 0;
266    Double_t Py = 0;          Double_t Py = 0;      
267    Double_t Pz = 0;      Double_t Pz = 0;  
268    TTree *ttof = 0;    TTree *ttof = 0;
269    ToFLevel2 *tof = new ToFLevel2();    ToFLevel2 *tof = new ToFLevel2();
270      TTree *ttrke = 0;
271      TrkLevel2 *trke = new TrkLevel2();
272    OrientationInfo *PO = new OrientationInfo();    OrientationInfo *PO = new OrientationInfo();
273    Int_t nz = 6;    Int_t nz = 6;
274    Float_t zin[6];    Float_t zin[6];
275    Int_t nevtofl2 = 0;    Int_t nevtofl2 = 0;
276      Int_t nevtrkl2 = 0;
277    if ( verbose ) cout<<"Reading quaternions external file"<<endl;    if ( verbose ) cout<<"Reading quaternions external file"<<endl;
278    cout.setf(ios::fixed,ios::floatfield);      cout.setf(ios::fixed,ios::floatfield);  
279    /******Reading recovered quaternions...*********/    /******Reading recovered quaternions...*********/
# Line 269  int OrbitalInfoCore(UInt_t run, TFile *f Line 283  int OrbitalInfoCore(UInt_t run, TFile *f
283    vector<Float_t> recq2;    vector<Float_t> recq2;
284    vector<Float_t> recq3;    vector<Float_t> recq3;
285    Float_t Norm = 1;    Float_t Norm = 1;
286    Int_t parerror=glparam->Query_GL_PARAM(1,303,dbc); // parameters stored in DB in GL_PRAM table      recqtime.reserve(1500000);
287    ifstream in((glparam->PATH+glparam->NAME).Data(),ios::in);    recq0.reserve(1500000);
288      recq1.reserve(1500000);
289      recq2.reserve(1500000);
290      recq3.reserve(1500000);
291    
292      vector<UInt_t> RTtime1;
293      vector<UInt_t> RTtime2;
294      vector<Double_t> RTbank1;
295      vector<Double_t> RTbank2;
296      vector<Double_t> RTbpluto1;
297      vector<Double_t> RTbpluto2;
298      vector<Int_t> RTazim;
299      vector<UInt_t> RTstart;
300      vector<UInt_t> RTpluto2;
301      vector<UInt_t> RTpluto1;
302      vector<Int_t> RTerrq;
303      vector<Int_t> RTqual;
304      RTtime1.reserve(200000);
305      RTtime2.reserve(200000);
306      RTbank1.reserve(200000);
307      RTbank2.reserve(200000);
308      RTbpluto1.reserve(200000);
309      RTbpluto2.reserve(200000);
310      RTazim.reserve(200000);
311      RTstart.reserve(200000);
312      RTpluto1.reserve(200000);
313      RTpluto2.reserve(200000);
314      RTerrq.reserve(200000);
315      RTqual.reserve(200000);
316    
317      TClonesArray *tcNucleiTrk = NULL;
318      TClonesArray *tcExtNucleiTrk = NULL;
319      TClonesArray *tcExtTrk = NULL;
320      TClonesArray *tcNucleiTof = NULL;
321      TClonesArray *tcExtNucleiTof = NULL;
322      TClonesArray *tcExtTof = NULL;
323      TClonesArray *torbNucleiTrk = NULL;
324      TClonesArray *torbExtNucleiTrk = NULL;
325      TClonesArray *torbExtTrk = NULL;
326      Bool_t hasNucleiTrk = false;
327      Bool_t hasExtNucleiTrk = false;
328      Bool_t hasExtTrk = false;
329      Bool_t hasNucleiTof = false;
330      Bool_t hasExtNucleiTof = false;
331      Bool_t hasExtTof = false;
332    
333      ifstream in;
334      ifstream an;
335      //  ofstream mc;
336      //  TString gr;
337      Int_t parerror2=0;
338    
339      Int_t parerror=glparam0->Query_GL_PARAM(1,303,dbc); // parameters stored in DB in GL_PRAM table
340      if ( verbose ) cout<<parerror<<"\t"<<(char*)(glparam0->PATH+glparam0->NAME).Data()<<endl;
341    if ( parerror<0 ) {    if ( parerror<0 ) {
342      code = parerror;      code = parerror;
343      goto closeandexit;      goto closeandexit;
344    }    }
345      in.open((char*)(glparam0->PATH+glparam0->NAME).Data(),ios::in);
346    while(!in.eof()){    while(!in.eof()){
347      recqtime.resize(recqtime.size()+1);      recqtime.resize(recqtime.size()+1);
348      Int_t sizee = recqtime.size();      Int_t sizee = recqtime.size();
# Line 288  int OrbitalInfoCore(UInt_t run, TFile *f Line 356  int OrbitalInfoCore(UInt_t run, TFile *f
356      in>>recq2[sizee-1];      in>>recq2[sizee-1];
357      in>>recq3[sizee-1];      in>>recq3[sizee-1];
358      in>>Norm;      in>>Norm;
359    /* CHECK RECOVERED QUATERNIONS PROBLEM
360        if(recqtime[sizee-1]>=1160987921.75 && recqtime[sizee-1]<=1160987932.00){
361          cout<<"We found it at start"<<"\t"<<recqtime[sizee-1]<<endl;
362        } */
363    }    }
364      in.close();
365    if ( verbose ) cout<<"We have read recovered data"<<endl;    if ( verbose ) cout<<"We have read recovered data"<<endl;
366      if (debug) cout << "size of recovered quaterions data set is " << recqtime.size() << endl;
367      if ( debug )  printf(" RQ size %i RQ capacity %i \n",(int)recqtime.size(),(int)recqtime.capacity());
368      
369      if ( verbose ) cout<<"read Rotation Table"<<endl;
370      
371      parerror2=glparam0->Query_GL_PARAM(1,305,dbc);
372    
373      if ( verbose ) cout<<parerror2<<"\t"<<(char*)(glparam0->PATH+glparam0->NAME).Data()<<endl;
374      if ( parerror2<0 ) {
375        code = parerror;
376        goto closeandexit;
377      }
378      an.open((char*)(glparam0->PATH+glparam0->NAME).Data(),ios::in);
379      while(!an.eof()){
380        RTtime1.resize(RTtime1.size()+1);
381        Int_t sizee = RTtime1.size();
382        RTbank1.resize(sizee+1);
383        RTazim.resize(sizee+1);
384        RTerrq.resize(sizee+1);
385        RTstart.resize(sizee+1);
386        RTpluto1.resize(sizee+1);
387        RTbpluto1.resize(sizee+1);
388        RTqual.resize(sizee+1);
389        an>>RTtime1[sizee-1];
390        an>>RTbank1[sizee-1];
391        an>>RTstart[sizee-1];
392        an>>RTpluto1[sizee-1];
393        an>>RTbpluto1[sizee-1];
394        an>>RTazim[sizee-1];
395        an>>RTerrq[sizee-1];
396        an>>RTqual[sizee-1];
397        if(sizee>1) {
398          RTtime2.resize(sizee+1);
399          RTbank2.resize(sizee+1);
400          RTpluto2.resize(sizee+1);
401          RTbpluto2.resize(sizee+1);
402          RTtime2[sizee-2]=RTtime1[sizee-1];
403          RTpluto2[sizee-2]=RTpluto1[sizee-1];
404          RTbank2[sizee-2]=RTbank1[sizee-1];
405          RTbpluto2[sizee-2]=RTbpluto1[sizee-1];
406        }
407      }
408      an.close();
409      //cout<<"put some number here"<<endl;
410      //Int_t yupi;
411      //cin>>yupi;
412      
413      if ( verbose ) cout<<"We have read Rotation Table"<<endl;
414        //Geomagnetic coordinates calculations staff
415      
416      if ( debug ) printf(" RT size %i RT capacity %i \n",(int)RTtime2.size(),(int)RTtime2.capacity());
417    
418      GMtype_CoordGeodetic location;
419      //  GMtype_CoordDipole GMlocation;
420      GMtype_Ellipsoid Ellip;
421      GMtype_Data G0, G1, H1;
422            
423      //  { // this braces is necessary to avoid jump to label 'closeandexit'  error   // but it is wrong since the variable "igpath" will not exist outside. To overcome the "jump to label 'closeandexit'  error" it is necessary to set the "igpath" before line 276
424      //    TString igpath="/data03/Malakhov/pam9Malakhov/installed10/calib/orb-param/";
425      //  }
426    
427      //cout << G0.element[0] << "\t" << G1.element[0] << "\t" << H1.element[0] << endl;
428      //cout << G0.element[5] << "\t" << G1.element[5] << "\t" << H1.element[5] << endl;
429    
430      GM_SetEllipsoid(&Ellip);
431    
432    // IGRF stuff moved inside run loop!      // IGRF stuff moved inside run loop!  
433    
# Line 299  int OrbitalInfoCore(UInt_t run, TFile *f Line 437  int OrbitalInfoCore(UInt_t run, TFile *f
437    //    //
438    if ( !standalone ){    if ( !standalone ){
439      //      //
440      // Does it contain the Tracker tree?      // Does it contain the Tracker and ToF trees?
441      //      //
442      ttof = (TTree*)file->Get("ToF");      ttof = (TTree*)file->Get("ToF");
443      if ( !ttof ) {      if ( !ttof ) {
444        if ( verbose ) printf(" OrbitalInfo - ERROR: no tof tree\n");        if ( verbose ) printf(" OrbitalInfo - ERROR: no tof tree\n");
445        code = -900;        code = -900;
446        goto closeandexit;        goto closeandexit;
447      };      }
448      ttof->SetBranchAddress("ToFLevel2",&tof);        ttof->SetBranchAddress("ToFLevel2",&tof);  
449      nevtofl2 = ttof->GetEntries();      nevtofl2 = ttof->GetEntries();
450    };  
451        //
452        // Look for extended tracking algorithm
453        //
454        if ( verbose ) printf("Look for extended and nuclei tracking algorithms in ToF\n");
455        // Nuclei tracking algorithm
456        Int_t checkAlgo = 0;
457        tcNucleiTof =  new TClonesArray("ToFTrkVar");
458        checkAlgo = ttof->SetBranchAddress("TrackNuclei",&tcNucleiTof);    
459        if ( !checkAlgo ){
460          if ( verbose ) printf(" Nuclei tracking algorithm ToF branch found! :D \n");
461          hasNucleiTof = true;
462        } else {
463          if ( verbose ) printf(" Nuclei tracking algorithm ToF branch not found :( !\n");
464          printf(" ok, this is not a problem (it depends on tracker settings) \n");
465          delete tcNucleiTof;
466          tcNucleiTof=NULL; // 10RED reprocessing bug  
467        }
468        // Nuclei tracking algorithm using calorimeter points
469        tcExtNucleiTof =  new TClonesArray("ToFTrkVar");
470        checkAlgo = ttof->SetBranchAddress("RecoveredTrackNuclei",&tcExtNucleiTof);    
471        if ( !checkAlgo ){
472          if ( verbose ) printf(" Recovered nuclei tracking algorithm ToF branch found! :D \n");
473          hasExtNucleiTof = true;
474        } else {
475          if ( verbose ) printf(" Recovered nuclei tracking algorithm ToF branch not found :( !\n");
476          printf(" ok, this is not a problem (it depends on tracker settings) \n");
477          delete tcExtNucleiTof;
478          tcExtNucleiTof=NULL; // 10RED reprocessing bug  
479        }
480        // Tracking algorithm using calorimeter points
481        tcExtTof =  new TClonesArray("ToFTrkVar");
482        checkAlgo = ttof->SetBranchAddress("RecoveredTrack",&tcExtTof);
483        if ( !checkAlgo ){
484          if ( verbose ) printf(" Recovered track algorithm ToF branch found! :D \n");
485          hasExtTof = true;
486        } else {
487          if ( verbose ) printf(" Recovered track algorithm ToF branch not found :( !\n");
488          printf(" ok, this is not a problem (it depends on tracker settings) \n");
489          delete tcExtTof;
490          tcExtTof=NULL; // 10RED reprocessing bug  
491        }
492    
493        ttrke = (TTree*)file->Get("Tracker");
494        if ( !ttrke ) {
495          if ( verbose ) printf(" OrbitalInfo - ERROR: no trk tree\n");
496          code = -903;
497          goto closeandexit;
498        }
499        ttrke->SetBranchAddress("TrkLevel2",&trke);  
500        nevtrkl2 = ttrke->GetEntries();
501    
502        //
503        // Look for extended tracking algorithm
504        //
505        if ( verbose ) printf("Look for extended and nuclei tracking algorithms\n");
506        // Nuclei tracking algorithm
507        checkAlgo = 0;
508        tcNucleiTrk =  new TClonesArray("TrkTrack");
509        checkAlgo = ttrke->SetBranchAddress("TrackNuclei",&tcNucleiTrk);    
510        if ( !checkAlgo ){
511          if ( verbose ) printf(" Nuclei tracking algorithm branch found! :D \n");
512          hasNucleiTrk = true;
513        } else {
514          if ( verbose ) printf(" Nuclei tracking algorithm branch not found :( !\n");
515          printf(" ok, this is not a problem (it depends on tracker settings) \n");
516          delete tcNucleiTrk;
517          tcNucleiTrk=NULL; // 10RED reprocessing bug  
518        }
519        // Nuclei tracking algorithm using calorimeter points
520        tcExtNucleiTrk =  new TClonesArray("ExtTrack");
521        checkAlgo = ttrke->SetBranchAddress("RecoveredTrackNuclei",&tcExtNucleiTrk);    
522        if ( !checkAlgo ){
523          if ( verbose ) printf(" Recovered nuclei tracking algorithm branch found! :D \n");
524          hasExtNucleiTrk = true;
525        } else {
526          if ( verbose ) printf(" Recovered nuclei tracking algorithm branch not found :( !\n");
527          printf(" ok, this is not a problem (it depends on tracker settings) \n");
528          delete tcExtNucleiTrk;
529          tcExtNucleiTrk=NULL; // 10RED reprocessing bug  
530        }
531        // Tracking algorithm using calorimeter points
532        tcExtTrk =  new TClonesArray("ExtTrack");
533        checkAlgo = ttrke->SetBranchAddress("RecoveredTrack",&tcExtTrk);
534        if ( !checkAlgo ){
535          if ( verbose ) printf(" Recovered track algorithm branch found! :D \n");
536          hasExtTrk = true;
537        } else {
538          if ( verbose ) printf(" Recovered track algorithm branch not found :( !\n");
539          printf(" ok, this is not a problem (it depends on tracker settings) \n");
540          delete tcExtTrk;
541          tcExtTrk=NULL; // 10RED reprocessing bug  
542        }
543    
544        if ( (hasNucleiTrk && !hasNucleiTof) || (!hasNucleiTrk && hasNucleiTof) ||
545             (hasExtNucleiTrk && !hasExtNucleiTof) || (!hasExtNucleiTrk && hasExtNucleiTof) ||
546             (hasExtTrk && !hasExtTof) || (!hasExtTrk && hasExtTof)
547             ){
548          if ( verbose ) printf(" ERROR: Mismatch between tracker and tof tree branches concerning extended tracking algorithm(s)\n");
549          if ( debug ) printf("hasNucleiTrk %i hasExtNucleiTrk %i hasExtTrk %i \n",hasNucleiTrk,hasExtNucleiTrk,hasExtTrk);
550          if ( debug ) printf("hasNucleiTof %i hasExtNucleiTof %i hasExtTof %i \n",hasNucleiTof,hasExtNucleiTof,hasExtTof);
551          throw -901;
552        }
553    
554      }
555    //    //
556    // Let's start!    // Let's start!
557    //    //
# Line 437  int OrbitalInfoCore(UInt_t run, TFile *f Line 679  int OrbitalInfoCore(UInt_t run, TFile *f
679    orbitalinfo->Set();//ELENA **TEMPORANEO?**    orbitalinfo->Set();//ELENA **TEMPORANEO?**
680    OrbitalInfotr->Branch("OrbitalInfo","OrbitalInfo",&orbitalinfo);    OrbitalInfotr->Branch("OrbitalInfo","OrbitalInfo",&orbitalinfo);
681    //    //
682      // create new branches for new tracking algorithms
683      //
684      if ( hasNucleiTrk ){
685        torbNucleiTrk = new TClonesArray("OrbitalInfoTrkVar",1);
686        OrbitalInfotr->Branch("TrackNuclei",&torbNucleiTrk);
687      }
688      if ( hasExtNucleiTrk ){
689        torbExtNucleiTrk = new TClonesArray("OrbitalInfoTrkVar",1);
690        OrbitalInfotr->Branch("RecoveredTrackNuclei",&torbExtNucleiTrk);
691      }
692      if ( hasExtTrk ){
693        torbExtTrk = new TClonesArray("OrbitalInfoTrkVar",1);
694        OrbitalInfotr->Branch("RecoveredTrack",&torbExtTrk);
695      }
696    
697      //
698    if ( reproc && !reprocall ){    if ( reproc && !reprocall ){
699      //      //
700      //  open new file and retrieve also tree informations      //  open new file and retrieve also tree informations
# Line 458  int OrbitalInfoCore(UInt_t run, TFile *f Line 716  int OrbitalInfoCore(UInt_t run, TFile *f
716          //          //
717          // copy orbitalinfoclone to mydec          // copy orbitalinfoclone to mydec
718          //          //
719          orbitalinfo->Clear();          //      orbitalinfo->Clear();
720          //          //
721          memcpy(&orbitalinfo,&orbitalinfoclone,sizeof(orbitalinfoclone));          memcpy(&orbitalinfo,&orbitalinfoclone,sizeof(orbitalinfoclone));
722          //          //
# Line 475  int OrbitalInfoCore(UInt_t run, TFile *f Line 733  int OrbitalInfoCore(UInt_t run, TFile *f
733    // Get the list of run to be processed, if only one run has to be processed the list will contain one entry only.    // Get the list of run to be processed, if only one run has to be processed the list will contain one entry only.
734    //    //
735    runlist = runinfo->GetRunList();    runlist = runinfo->GetRunList();
736      if ( debug ){
737        printf("BEFORE LOOP ON RUN\n");
738        gObjectTable->Print();
739      }
740    //    //
741    // Loop over the run to be processed    // Loop over the run to be processed
742    //    //
743    for (UInt_t irun=0; irun < numbofrun; irun++){    for (UInt_t irun=0; irun < numbofrun; irun++){ //===>
744    
745      L_QQ_Q_l_lower = new Quaternions();      L_QQ_Q_l_lower = new Quaternions();
746      RYPang_lower = new InclinationInfo();      RYPang_lower = new InclinationInfo();
# Line 587  int OrbitalInfoCore(UInt_t run, TFile *f Line 849  int OrbitalInfoCore(UInt_t run, TFile *f
849        goto closeandexit;        goto closeandexit;
850      };      };
851    
     //  
     // open IGRF files and do it only once if we are processing a full level2 file  
     //  
     if ( irun == 0 ){  
       if ( l0head->GetEntry(runinfo->EV_FROM) <= 0 ) throw -36;  
       //  
       // absolute time of first event of the run (it should not matter a lot)  
       //  
       ph = eh->GetPscuHeader();  
       atime = dbtime->DBabsTime(ph->GetOrbitalTime());  
         
       parerror=glparam->Query_GL_PARAM(atime-anni5,301,dbc); // parameters stored in DB in GL_PRAM table    
       if ( parerror<0 ) {  
         code = parerror;  
         goto closeandexit;  
     };  
       ltp1 = (Int_t)(glparam->PATH+glparam->NAME).Length();  
       if ( verbose ) printf(" Reading Earth's Magnetic Field parameter file: %s \n",(glparam->PATH+glparam->NAME).Data());  
       //  
       parerror=glparam2->Query_GL_PARAM(atime,301,dbc); // parameters stored in DB in GL_PRAM table    
       if ( parerror<0 ) {  
         code = parerror;  
         goto closeandexit;  
       };  
       ltp2 = (Int_t)(glparam2->PATH+glparam2->NAME).Length();  
       if ( verbose ) printf(" Reading Earth's Magnetic Field parameter file: %s \n",(glparam2->PATH+glparam2->NAME).Data());  
       //  
       parerror=glparam3->Query_GL_PARAM(atime,302,dbc); // parameters stored in DB in GL_PRAM table  
       if ( parerror<0 ) {  
         code = parerror;  
         goto closeandexit;  
       };  
       ltp3 = (Int_t)(glparam3->PATH+glparam3->NAME).Length();  
       if ( verbose ) printf(" Reading Earth's Magnetic Field parameter file: %s \n",(glparam3->PATH+glparam3->NAME).Data());  
       //  
       initize_((char *)(glparam->PATH+glparam->NAME).Data(),&ltp1,(char *)(glparam2->PATH+glparam2->NAME).Data(),&ltp2,(char *)(glparam3->PATH+glparam3->NAME).Data(),&ltp3);  
       //  
     }  
     //  
     // End IGRF stuff//  
     //  
   
     //  
     //     TTree *tp = (TTree*)l0File->Get("RunHeader");  
     //     tp->SetBranchAddress("Header", &eH);  
     //     tp->SetBranchAddress("RunHeader", &reh);  
     //     tp->GetEntry(0);  
     //     ph = eH->GetPscuHeader();  
     //     ULong_t TimeSync = reh->LAST_TIME_SYNC_INFO;  
     //     ULong_t ObtSync = reh->OBT_TIME_SYNC;      
     //     if ( debug ) printf(" 1 TimeSync %lu ObtSync %lu DeltaOBT %lu\n",TimeSync,ObtSync,TimeSync-ObtSync);  
     //  
852      ULong_t TimeSync = (ULong_t)dbtime->GetTimesync();      ULong_t TimeSync = (ULong_t)dbtime->GetTimesync();
853      ULong_t ObtSync = (ULong_t)(dbtime->GetObt0()/1000);      ULong_t ObtSync = (ULong_t)(dbtime->GetObt0()/1000);
854      ULong_t DeltaOBT = TimeSync - ObtSync;      ULong_t DeltaOBT = TimeSync - ObtSync;
# Line 674  int OrbitalInfoCore(UInt_t run, TFile *f Line 884  int OrbitalInfoCore(UInt_t run, TFile *f
884          //          //
885          l0fid[i] = (UInt_t)atoll(Row->GetField(0));          l0fid[i] = (UInt_t)atoll(Row->GetField(0));
886          i--;          i--;
887            if (Row){  // memleak!
888              delete Row;
889              Row = 0;
890            }
891          Row = pResult->Next();            Row = pResult->Next();  
892          //          //
893        };        }
894          if (Row) delete Row;
895        pResult->Delete();        pResult->Delete();
896      };      }
897      //      //
898      myquery.str("");      myquery.str("");
899      myquery << "select ID_ROOT_L0 from GL_RUN where RUNHEADER_TIME>" << runinfo->RUNHEADER_TIME << " group by ID_ROOT_L0 order by RUNHEADER_TIME asc limit 5;";      myquery << "select ID_ROOT_L0 from GL_RUN where RUNHEADER_TIME>" << runinfo->RUNHEADER_TIME << " group by ID_ROOT_L0 order by RUNHEADER_TIME asc limit 5;";
# Line 696  int OrbitalInfoCore(UInt_t run, TFile *f Line 911  int OrbitalInfoCore(UInt_t run, TFile *f
911          //          //
912          l0fid[i] = (UInt_t)atoll(Row->GetField(0));          l0fid[i] = (UInt_t)atoll(Row->GetField(0));
913          i++;          i++;
914            if (Row){  // memleak!
915              delete Row;
916              Row = 0;
917            }
918          Row = pResult->Next();            Row = pResult->Next();  
919          //          //
920        };        }
921          if (Row) delete Row;
922        pResult->Delete();        pResult->Delete();
923      };      }
924      //      //
925      i = 0;      i = 0;
926      UInt_t previd = 0;      UInt_t previd = 0;
# Line 719  int OrbitalInfoCore(UInt_t run, TFile *f Line 939  int OrbitalInfoCore(UInt_t run, TFile *f
939            if ( debug ) printf(" Using inclination informations from file: %s \n",(((TString)gSystem->ExpandPathName(Row->GetField(0)))+"/"+(TString)Row->GetField(1)).Data());            if ( debug ) printf(" Using inclination informations from file: %s \n",(((TString)gSystem->ExpandPathName(Row->GetField(0)))+"/"+(TString)Row->GetField(1)).Data());
940            ch->Add(((TString)gSystem->ExpandPathName(Row->GetField(0)))+"/"+(TString)Row->GetField(1));            ch->Add(((TString)gSystem->ExpandPathName(Row->GetField(0)))+"/"+(TString)Row->GetField(1));
941            //            //
942              if (Row) delete Row;
943            pResult->Delete();            pResult->Delete();
944          };          }
945        };        }
946        i++;        i++;
947      };      }
948      //      //
     //    l0trm = (TTree*)l0File->Get("Mcmd");  
     //    ch->ls();  
949      ch->SetBranchAddress("Mcmd",&mcmdev);      ch->SetBranchAddress("Mcmd",&mcmdev);
     //    printf(" entries %llu \n", ch->GetEntries());  
     //    l0trm = ch->GetTree();  
     //    neventsm = l0trm->GetEntries();  
950      neventsm = ch->GetEntries();      neventsm = ch->GetEntries();
951      if ( debug ) printf(" entries %u \n", neventsm);      if ( debug ) printf(" entries %u \n", neventsm);
     //    neventsm = 0;  
952      //      //
953      if (neventsm == 0){      if (neventsm == 0){
954        if ( debug ) printf("InclinationInfo - WARNING: No quaternions in this File");        if ( debug ) printf("InclinationInfo - WARNING: No quaternions in this File");
       //      l0File->Close();  
955        code = 900;        code = 900;
       //      goto closeandexit;  
956      }      }
957      //      //
958            Double_t lowerqtime = 0;    
     //    l0trm->SetBranchAddress("Mcmd", &mcmdev);  
     //    l0trm->SetBranchAddress("Header", &eh);  
     //  
     //  
     //  
   
 //    UInt_t mctren = 0;      
 //    UInt_t mcreen = 0;          
     UInt_t numrec = 0;  
     //  
     Double_t upperqtime = 0;  
     Double_t lowerqtime = 0;  
       
 //    Double_t incli = 0;  
 //    oi = 0;  
 //    UInt_t ooi = 0;  
959      //      //
960      // init quaternions information from mcmd-packets      // init quaternions information from mcmd-packets
961      //      //
962      Bool_t isf = true;      Bool_t isf = true;
 //    Int_t fgh = 0;  
963    
964      vector<Float_t> q0;      vector<Float_t> q0;
965      vector<Float_t> q1;      vector<Float_t> q1;
# Line 775  int OrbitalInfoCore(UInt_t run, TFile *f Line 971  int OrbitalInfoCore(UInt_t run, TFile *f
971      vector<Float_t> qYaw;      vector<Float_t> qYaw;
972      vector<Int_t> qmode;      vector<Int_t> qmode;
973    
974        q0.reserve(4096);
975        q1.reserve(4096);
976        q2.reserve(4096);
977        q3.reserve(4096);
978        qtime.reserve(4096);
979        qPitch.reserve(4096);
980        qRoll.reserve(4096);
981        qYaw.reserve(4096);
982        qmode.reserve(4096);
983        if ( debug ) printf(" q0 capa %i \n",(int)q0.capacity());
984      Int_t nt = 0;      Int_t nt = 0;
       
     //init sine-function interpolation  
       
     //cout<<"Sine coeficient initialisation..."<<endl;  
     vector<Sine> q0sine;  
     vector<Sine> q1sine;  
     vector<Sine> q2sine;  
     vector<Sine> q3sine;  
     vector<Sine> Yawsine;  
   
     /*TH2F* q0testing = new TH2F();  
       TH2F* q1testing = new TH2F();  
       TH2F* q2testing = new TH2F();  
       TH2F* q3testing = new TH2F();  
       TH2F* Pitchtesting = new TH2F();  
     */  
985      UInt_t must = 0;      UInt_t must = 0;
986    
987        Int_t currentYear = 0;
988        Int_t previousYear = 0;
989    
990      //      //
991      // run over all the events of the run      // run over all the events of the run
992      //      //
993      if (verbose) printf("\n Ready to start! \n\n Processed events: \n\n");      if (verbose) printf("\n Ready to start! \n\n Processed events: \n\n");
994        if ( debug ){
995          printf("BEFORE LOOP ON EVENTS\n");
996          gObjectTable->Print();
997        }
998      //      //
999      //      //
1000      for ( re = runinfo->EV_FROM; re < (runinfo->EV_FROM+runinfo->NEVENTS); re++){      for ( re = runinfo->EV_FROM; re < (runinfo->EV_FROM+runinfo->NEVENTS); re++){
1001          //for ( re = runinfo->EV_FROM; re < (runinfo->EV_FROM+10); re++){
1002    
1003        //        //
1004        if ( procev%1000 == 0 && procev > 0 && verbose ) printf(" %iK \n",procev/1000);          if ( procev%1000 == 0 && procev > 0 && verbose ) printf(" %iK \n",procev/1000);  
1005        if ( debug ) printf(" %i \n",procev);              if ( debug ) printf(" %i \n",procev);      
# Line 822  int OrbitalInfoCore(UInt_t run, TFile *f Line 1021  int OrbitalInfoCore(UInt_t run, TFile *f
1021          continue;          continue;
1022        }        }
1023    
1024          // just for testing:
1025          //      if (re >= 5+runinfo->EV_FROM) atime += anni5;
1026          //      if (re >= 7+runinfo->EV_FROM) atime += anni5;
1027          //      if (re >= 9+runinfo->EV_FROM) atime += anni5;
1028    
1029          //
1030          // open IGRF files and do it only once if we are processing a full level2 file
1031          //
1032          Float_t kkyear;
1033          UInt_t kyear, kmonth, kday, khour, kmin, ksec;
1034          //
1035          TTimeStamp kt = TTimeStamp(atime, kTRUE);
1036          kt.GetDate(kTRUE, 0, &kyear, &kmonth, &kday);
1037          kt.GetTime(kTRUE, 0, &khour, &kmin, &ksec);
1038          kkyear = (float) kyear
1039            + (kmonth*31.+ (float) kday)/365.
1040            + (khour*3600.+kmin*60.+(float)ksec)/(24.*3600.*365.);
1041          currentYear = int(kkyear/5.) * 5;
1042          if ( debug ) printf(" prevy %i curry %i igrfloaded %i \n",previousYear,currentYear,igrfloaded);
1043          if ( currentYear != previousYear ) igrfloaded = false;
1044          previousYear = currentYear;
1045          if ( debug ) printf(" prevy %i curry %i igrfloaded %i \n",previousYear,currentYear,igrfloaded);
1046          //
1047          if ( !igrfloaded ){
1048            
1049            igrfloaded = true;
1050            
1051            parerror=glparam->Query_GL_PARAM(atime,302,dbc); // parameters stored in DB in GL_PRAM table  
1052            if ( parerror<0 ) {
1053              code = parerror;
1054              goto closeandexit;
1055            }
1056            ltp1 = (Int_t)(glparam->PATH+glparam->NAME).Length();
1057            if ( verbose ) printf(" Reading Earth's Magnetic Field parameter file: %s \n",(glparam->PATH+glparam->NAME).Data());
1058            //
1059            if ( glparam->NAME.EndsWith("s.txt") || glparam->NAME.EndsWith("s.dat") ){
1060              if ( verbose ) printf("ERROR: Current date is beyond the latest secular variation file time span. Please update IGRF files to process data\n");
1061              throw -906;
1062            }
1063            //
1064            int isSecular = false;
1065            //
1066            parerror=glparam2->Query_GL_PARAM(atime+anni5,302,dbc); // parameters stored in DB in GL_PRAM table  
1067            if ( parerror<0 ) {
1068              code = parerror;
1069              goto closeandexit;
1070            }
1071            ltp2 = (Int_t)(glparam2->PATH+glparam2->NAME).Length();
1072            if ( verbose ) printf(" Reading Earth's Magnetic Field parameter file: %s \n",(glparam2->PATH+glparam2->NAME).Data());
1073            if ( glparam2->NAME.EndsWith("s.txt") || glparam2->NAME.EndsWith("s.dat") ){
1074              isSecular = true;
1075              if ( verbose ) printf(" Using secular variation file and hence fortran subroutine 'extrapolation'\n");
1076            } else {
1077              if ( verbose ) printf(" Using two field measurement files and hence fortran subroutine 'interpolation'\n");
1078            }
1079            //
1080            initize_(&isSecular,(char *)(glparam->PATH+glparam->NAME).Data(),&ltp1,(char *)(glparam2->PATH+glparam2->NAME).Data(),&ltp2);
1081            //
1082            if (debug) cout<<"initize: "<<(char *)(glparam->PATH+glparam->NAME).Data()<<"\t"<<(char *)(glparam2->PATH+glparam2->NAME).Data()<<"\t isSecular? "<<isSecular<<endl;  
1083    
1084            //        GM_ScanIGRF(dbc, &G0, &G1, &H1);
1085            TString igrfFile1 = glparam->PATH+glparam->NAME;
1086            TString igrfFile2 = glparam2->PATH+glparam2->NAME;
1087            GM_SetIGRF(isSecular,igrfFile1,igrfFile2, &G0, &G1, &H1);
1088          }
1089          //
1090          // End IGRF stuff//
1091          //
1092    
1093        //        //
1094        // retrieve tof informations        // retrieve tof informations
1095        //        //
# Line 837  int OrbitalInfoCore(UInt_t run, TFile *f Line 1105  int OrbitalInfoCore(UInt_t run, TFile *f
1105            if ( verbose ) printf(" OrbitalInfo - ERROR: no tof events with entry = %i in Level2 file\n",itr);            if ( verbose ) printf(" OrbitalInfo - ERROR: no tof events with entry = %i in Level2 file\n",itr);
1106            if ( debug ) printf(" nobefrun %u re %u evfrom %u jumped %u reprocall %i \n",nobefrun,re,evfrom,jumped,reprocall);            if ( debug ) printf(" nobefrun %u re %u evfrom %u jumped %u reprocall %i \n",nobefrun,re,evfrom,jumped,reprocall);
1107            l0File->Close();            l0File->Close();
1108            code = -901;            code = -904;
1109            goto closeandexit;            goto closeandexit;
1110          };          };
1111          //          //
1112          tof->Clear();          tof->Clear();
1113          //          //
1114          if ( ttof->GetEntry(itr) <= 0 ) throw -36;          // Clones array must be cleared before going on
1115            //
1116            if ( hasNucleiTof ){
1117              tcNucleiTof->Delete();
1118            }
1119            if ( hasExtNucleiTof ){
1120              tcExtNucleiTof->Delete();
1121            }          
1122            if ( hasExtTof ){
1123              tcExtTof->Delete();
1124            }
1125            //
1126            if ( verbose ) printf(" get tof tree entries... entry = %i in Level2 file\n",itr);
1127            if ( ttof->GetEntry(itr) <= 0 ){
1128              if ( verbose ) printf(" problems with tof tree entries... entry = %i in Level2 file\n",itr);
1129              if ( verbose ) printf(" nobefrun %u re %u evfrom %u jumped %u reprocall %i \n",nobefrun,re,evfrom,jumped,reprocall);
1130              throw -36;
1131            }
1132            if ( verbose ) printf(" gat0\n");
1133          //          //
1134        };        }
1135          //
1136          // retrieve tracker informations
1137          //
1138          if ( !standalone ){
1139            if ( itr > nevtrkl2 ){  
1140              if ( verbose ) printf(" OrbitalInfo - ERROR: no trk events with entry = %i in Level2 file\n",itr);
1141              if ( debug ) printf(" nobefrun %u re %u evfrom %u jumped %u reprocall %i \n",nobefrun,re,evfrom,jumped,reprocall);
1142              l0File->Close();
1143              code = -905;
1144              goto closeandexit;
1145            }
1146            //
1147            if ( verbose ) printf(" gat1\n");
1148            trke->Clear();
1149            //
1150            // Clones array must be cleared before going on
1151            //
1152            if ( hasNucleiTrk ){
1153              if ( verbose ) printf(" gat2\n");
1154              tcNucleiTrk->Delete();
1155              if ( verbose ) printf(" gat3\n");
1156              torbNucleiTrk->Delete();
1157            }
1158            if ( hasExtNucleiTrk ){
1159              if ( verbose ) printf(" gat4\n");
1160              tcExtNucleiTrk->Delete();
1161              if ( verbose ) printf(" gat5\n");
1162              torbExtNucleiTrk->Delete();
1163            }          
1164            if ( hasExtTrk ){
1165              if ( verbose ) printf(" gat6\n");
1166              tcExtTrk->Delete();
1167              if ( verbose ) printf(" gat7\n");
1168              torbExtTrk->Delete();
1169            }
1170            //
1171            if ( verbose ) printf(" get trk tree entries... entry = %i in Level2 file\n",itr);
1172            if ( ttrke->GetEntry(itr) <= 0 ) throw -36;
1173            //
1174          }
1175    
1176        //        //
1177        procev++;        procev++;
1178        //        //
# Line 857  int OrbitalInfoCore(UInt_t run, TFile *f Line 1184  int OrbitalInfoCore(UInt_t run, TFile *f
1184        OrbitalInfoTrkVar *t_orb = new OrbitalInfoTrkVar();        OrbitalInfoTrkVar *t_orb = new OrbitalInfoTrkVar();
1185        if( !(orbitalinfo->OrbitalInfoTrk) ) orbitalinfo->OrbitalInfoTrk = new TClonesArray("OrbitalInfoTrkVar",2);        if( !(orbitalinfo->OrbitalInfoTrk) ) orbitalinfo->OrbitalInfoTrk = new TClonesArray("OrbitalInfoTrkVar",2);
1186        TClonesArray &tor = *orbitalinfo->OrbitalInfoTrk;        TClonesArray &tor = *orbitalinfo->OrbitalInfoTrk;
1187    
1188          // Geomagnetic coordinates calculation variables
1189          GMtype_CoordSpherical CoordSpherical, DipoleSpherical;
1190          GMtype_CoordCartesian CoordCartesian, DipoleCartesian;
1191          GMtype_Model Model;
1192          GMtype_Pole Pole;
1193    
1194        //        //
1195        // Fill OBT, pkt_num and absTime        // Fill OBT, pkt_num and absTime
1196        //              //      
# Line 871  int OrbitalInfoCore(UInt_t run, TFile *f Line 1205  int OrbitalInfoCore(UInt_t run, TFile *f
1205        cCoordGeo coo;        cCoordGeo coo;
1206        Float_t jyear=0.;            Float_t jyear=0.;    
1207        //        //
1208        if(atime >= gltle->GetToTime()) {        if(atime >= gltle->GetToTime() || atime < gltle->GetFromTime() ) {  // AGH! bug when reprocessing??
1209          if ( !gltle->Query(atime, dbc) ){          if ( !gltle->Query(atime, dbc) ){
1210            //                  //      
1211            // Compute the magnetic dipole moment.            // Compute the magnetic dipole moment.
# Line 886  int OrbitalInfoCore(UInt_t run, TFile *f Line 1220  int OrbitalInfoCore(UInt_t run, TFile *f
1220              + (month*31.+ (float) day)/365.              + (month*31.+ (float) day)/365.
1221              + (hour*3600.+min*60.+(float)sec)/(24.*3600.*365.);              + (hour*3600.+min*60.+(float)sec)/(24.*3600.*365.);
1222            //            //
1223            if ( debug ) printf(" %i compute magnetic dipole moment get dipole moment for year\n",procev);                  if ( debug ) printf(" %i compute magnetic dipole moment get dipole moment for year\n",procev);            
1224            if ( debug ) printf(" %i jyear %f dimo %f \n",procev,jyear,dimo);                  if ( debug ) printf(" %i jyear %f dimo %f \n",procev,jyear,dimo);
1225            feldcof_(&jyear, &dimo); // get dipole moment for year            feldcof_(&jyear, &dimo); // get dipole moment for year
1226            if ( debug ) printf(" %i compute magnetic dipole moment end\n",procev);                  if ( debug ) printf(" %i compute magnetic dipole moment end\n",procev);
1227    
1228              //      GM_TimeAdjustCoefs(year, jyear, G0, G1, H1, &Model);
1229              GM_TimeAdjustCoefs(GM_STARTYEAR, (jyear-currentYear+GM_STARTYEAR), G0, G1, H1, &Model);  // EM: input this way due to the new way of storing data into Gn,H1 and to avoid changing GM_Time...
1230              GM_PoleLocation(Model, &Pole);
1231              
1232          } else {          } else {
1233            code = -56;            code = -56;
1234            goto closeandexit;            goto closeandexit;
# Line 899  int OrbitalInfoCore(UInt_t run, TFile *f Line 1238  int OrbitalInfoCore(UInt_t run, TFile *f
1238        //        //
1239        cOrbit orbits(*gltle->GetTle());        cOrbit orbits(*gltle->GetTle());
1240        //        //
       if ( debug ) printf(" I am Here \n");  
       //  
1241        // synchronize with quaternions data        // synchronize with quaternions data
1242        //        //
1243        if ( isf && neventsm>0 ){        if ( isf && neventsm>0 ){
# Line 908  int OrbitalInfoCore(UInt_t run, TFile *f Line 1245  int OrbitalInfoCore(UInt_t run, TFile *f
1245          // First event          // First event
1246          //          //
1247          isf = false;          isf = false;
1248          upperqtime = atime;          //      upperqtime = atime;
1249          lowerqtime = runinfo->RUNHEADER_TIME;          lowerqtime = runinfo->RUNHEADER_TIME;
1250          for ( ik = 0; ik < neventsm; ik++){  //number of macrocommad packets          for ( ik = 0; ik < neventsm; ik++){  //number of macrocommad packets
1251            if ( ch->GetEntry(ik) <= 0 ) throw -36;            if ( ch->GetEntry(ik) <= 0 ) throw -36;
1252            tmpSize = mcmdev->Records->GetEntries();            tmpSize = mcmdev->Records->GetEntries();
1253            numrec = tmpSize;            //      numrec = tmpSize;
1254              if ( debug ) cout << "packet number " << ik <<"\tnumber of subpackets is " << tmpSize << endl;
1255            for (Int_t j3 = 0;j3<tmpSize;j3++){  //number of subpackets            for (Int_t j3 = 0;j3<tmpSize;j3++){  //number of subpackets
             if ( debug ) printf(" ik %i j3 %i eh eh eh \n",ik,j3);  
1256              mcmdrc = (pamela::McmdRecord*)mcmdev->Records->At(j3);              mcmdrc = (pamela::McmdRecord*)mcmdev->Records->At(j3);
1257              if ( mcmdrc ){ // missing inclination bug [8RED 090116]              if ( mcmdrc ){ // missing inclination bug [8RED 090116]
1258                if ( debug ) printf(" pluto \n");                if ( debug ) printf(" pluto \n");
1259                if ((int)mcmdrc->ID1 == 226 && mcmdrc->Mcmd_Block_crc_ok == 1){ //Check that it is Inclination Packet                if ((int)mcmdrc->ID1 == 226 && mcmdrc->Mcmd_Block_crc_ok == 1){ //Check that it is Inclination Packet
1260                  L_QQ_Q_l_upper->fill(mcmdrc->McmdData);                 L_QQ_Q_l_upper->fill(mcmdrc->McmdData);
1261                  for (UInt_t ui = 0; ui < 6; ui++){                  for (UInt_t ui = 0; ui < 6; ui++){
1262                    if (ui>0){                    if (ui>0){
1263                      if (L_QQ_Q_l_upper->time[ui]>L_QQ_Q_l_upper->time[0]){                      if (L_QQ_Q_l_upper->time[ui]>L_QQ_Q_l_upper->time[0]){
1264                          if ( debug ) printf(" here1 %i \n",ui);                        if ( debug ) printf(" here1 %i \n",ui);
1265                        Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[ui]*1000-DeltaOBT*1000));                        Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[ui]*1000-DeltaOBT*1000));
1266                        Int_t recSize = recqtime.size();                        Int_t recSize = recqtime.size();
1267                        if(lowerqtime > recqtime[recSize-1]){                        if(lowerqtime > recqtime[recSize-1]){
1268                             // to avoid interpolation between bad quaternions arrays
1269                             if(sqrt(pow(L_QQ_Q_l_upper->quat[ui][0],2)+pow(L_QQ_Q_l_upper->quat[ui][1],2)+pow(L_QQ_Q_l_upper->quat[ui][2],2)+pow(L_QQ_Q_l_upper->quat[ui][3],2))>0.99999){
1270                            Int_t sizeqmcmd = qtime.size();                            Int_t sizeqmcmd = qtime.size();
1271                            inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);                            inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
1272                            qtime[sizeqmcmd]=u_time;                            qtime[sizeqmcmd]=u_time;
# Line 942  int OrbitalInfoCore(UInt_t run, TFile *f Line 1281  int OrbitalInfoCore(UInt_t run, TFile *f
1281                            qRoll[sizeqmcmd]=RYPang_upper->Kren;                            qRoll[sizeqmcmd]=RYPang_upper->Kren;
1282                            qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;                            qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
1283                            qPitch[sizeqmcmd]=RYPang_upper->Tangazh;                            qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
1284                             }
1285                        }                        }
1286                        for(Int_t mu = nt;mu<recSize;mu++){                        for(Int_t mu = nt;mu<recSize;mu++){
1287                          if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){                          if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){
1288                            nt=mu;                            if(sqrt(pow(recq0[mu],2)+pow(recq1[mu],2)+pow(recq2[mu],2)+pow(recq3[mu],2))>0.99999){
1289                            Int_t sizeqmcmd = qtime.size();                              nt=mu;
1290                            inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);                              Int_t sizeqmcmd = qtime.size();
1291                            qtime[sizeqmcmd]=recqtime[mu];                              inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
1292                            q0[sizeqmcmd]=recq0[mu];                              qtime[sizeqmcmd]=recqtime[mu];
1293                            q1[sizeqmcmd]=recq1[mu];                              q0[sizeqmcmd]=recq0[mu];
1294                            q2[sizeqmcmd]=recq2[mu];                              q1[sizeqmcmd]=recq1[mu];
1295                            q3[sizeqmcmd]=recq3[mu];                              q2[sizeqmcmd]=recq2[mu];
1296                            qmode[sizeqmcmd]=-10;                              q3[sizeqmcmd]=recq3[mu];
1297                            orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);                              qmode[sizeqmcmd]=-10;
1298                            RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,recq0[mu],recq1[mu],recq2[mu],recq3[mu]);                              orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);
1299                            qRoll[sizeqmcmd]=RYPang_upper->Kren;                              RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,recq0[mu],recq1[mu],recq2[mu],recq3[mu]);
1300                            qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;                              qRoll[sizeqmcmd]=RYPang_upper->Kren;
1301                            qPitch[sizeqmcmd]=RYPang_upper->Tangazh;                              qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
1302                                qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
1303                              }
1304                          }                          }
1305                          if(recqtime[mu]>=u_time){                          if(recqtime[mu]>=u_time){
1306                            Int_t sizeqmcmd = qtime.size();                            if(sqrt(pow(L_QQ_Q_l_upper->quat[ui][0],2)+pow(L_QQ_Q_l_upper->quat[ui][1],2)+pow(L_QQ_Q_l_upper->quat[ui][2],2)+pow(L_QQ_Q_l_upper->quat[ui][3],2))>0.99999){
1307                            inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);                              Int_t sizeqmcmd = qtime.size();
1308                            qtime[sizeqmcmd]=u_time;                              inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
1309                            q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][0];                              qtime[sizeqmcmd]=u_time;
1310                            q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][1];                              q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][0];
1311                            q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][2];                              q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][1];
1312                            q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][3];                              q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][2];
1313                            qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui);                              q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][3];
1314                            lowerqtime = u_time;                              qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui);
1315                            orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi);                              lowerqtime = u_time;
1316                            RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,L_QQ_Q_l_upper->quat[ui][0],L_QQ_Q_l_upper->quat[ui][1],L_QQ_Q_l_upper->quat[ui][2],L_QQ_Q_l_upper->quat[ui][3]);                              orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi);
1317                            qRoll[sizeqmcmd]=RYPang_upper->Kren;                              RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,L_QQ_Q_l_upper->quat[ui][0],L_QQ_Q_l_upper->quat[ui][1],L_QQ_Q_l_upper->quat[ui][2],L_QQ_Q_l_upper->quat[ui][3]);
1318                            qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;                              qRoll[sizeqmcmd]=RYPang_upper->Kren;
1319                            qPitch[sizeqmcmd]=RYPang_upper->Tangazh;                              qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
1320                            break;                              qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
1321                                break;
1322                              }
1323                          }                          }
1324                        }                        }
1325                      }                      }
1326                    }else{                    }else{
1327                          if ( debug ) printf(" here2 %i \n",ui);                      if ( debug ) printf(" here2 %i \n",ui);
1328                      Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));                      Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
1329                      if(lowerqtime>u_time)nt=0;                      if(lowerqtime>u_time)nt=0;
1330                      Int_t recSize = recqtime.size();                      Int_t recSize = recqtime.size();
1331                      if(lowerqtime > recqtime[recSize-1]){                      if(lowerqtime > recqtime[recSize-1]){
1332                          if(sqrt(pow(L_QQ_Q_l_upper->quat[ui][0],2)+pow(L_QQ_Q_l_upper->quat[ui][1],2)+pow(L_QQ_Q_l_upper->quat[ui][2],2)+pow(L_QQ_Q_l_upper->quat[ui][3],2))>0.99999){
1333                          Int_t sizeqmcmd = qtime.size();                          Int_t sizeqmcmd = qtime.size();
1334                          inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);                          inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
1335                          qtime[sizeqmcmd]=u_time;                          qtime[sizeqmcmd]=u_time;
# Line 999  int OrbitalInfoCore(UInt_t run, TFile *f Line 1344  int OrbitalInfoCore(UInt_t run, TFile *f
1344                          qRoll[sizeqmcmd]=RYPang_upper->Kren;                          qRoll[sizeqmcmd]=RYPang_upper->Kren;
1345                          qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;                          qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
1346                          qPitch[sizeqmcmd]=RYPang_upper->Tangazh;                          qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
1347                          }
1348                      }                      }
1349                      for(Int_t mu = nt;mu<recSize;mu++){                      for(Int_t mu = nt;mu<recSize;mu++){
1350                        if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){                        if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){
1351                          nt=mu;                           if(sqrt(pow(recq0[mu],2)+pow(recq1[mu],2)+pow(recq2[mu],2)+pow(recq3[mu],2))>0.99999){
1352                          Int_t sizeqmcmd = qtime.size();  //                         nt=mu;
1353                          inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);                             Int_t sizeqmcmd = qtime.size();
1354                          qtime[sizeqmcmd]=recqtime[mu];                             inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
1355                          q0[sizeqmcmd]=recq0[mu];                             qtime[sizeqmcmd]=recqtime[mu];
1356                          q1[sizeqmcmd]=recq1[mu];                             q0[sizeqmcmd]=recq0[mu];
1357                          q2[sizeqmcmd]=recq2[mu];                             q1[sizeqmcmd]=recq1[mu];
1358                          q3[sizeqmcmd]=recq3[mu];                             q2[sizeqmcmd]=recq2[mu];
1359                          qmode[sizeqmcmd]=-10;                             q3[sizeqmcmd]=recq3[mu];
1360                          orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);                             qmode[sizeqmcmd]=-10;
1361                          RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,recq0[mu],recq1[mu],recq2[mu],recq3[mu]);                             orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);
1362                          qRoll[sizeqmcmd]=RYPang_upper->Kren;                             RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,recq0[mu],recq1[mu],recq2[mu],recq3[mu]);
1363                          qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;                             qRoll[sizeqmcmd]=RYPang_upper->Kren;
1364                          qPitch[sizeqmcmd]=RYPang_upper->Tangazh;                             qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
1365                               qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
1366    /* CHECK RECOVERED QUATERNIONS PROBLEM */
1367    if(recqtime[mu]>=1160987921.75 && recqtime[mu]<=1160987932.00){
1368      cout<<"We found it while checking all quaternions"<<"\t"<<recqtime[mu]<<endl;
1369    }
1370                             }
1371                        }                        }
1372                        if(recqtime[mu]>=u_time){                        if(recqtime[mu]>=u_time){
1373                          Int_t sizeqmcmd = qtime.size();                           if(sqrt(pow(L_QQ_Q_l_upper->quat[0][0],2)+pow(L_QQ_Q_l_upper->quat[0][1],2)+pow(L_QQ_Q_l_upper->quat[0][2],2)+pow(L_QQ_Q_l_upper->quat[0][3],2))>0.99999){
1374                          inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);                             Int_t sizeqmcmd = qtime.size();
1375                          qtime[sizeqmcmd]=u_time;                             inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
1376                          q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][0];                             qtime[sizeqmcmd]=u_time;
1377                          q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][1];                             q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][0];
1378                          q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][2];                             q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][1];
1379                          q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][3];                             q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][2];
1380                          qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui);                             q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][3];
1381                          lowerqtime = u_time;                             qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui);
1382                          orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi);                             lowerqtime = u_time;
1383                          RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,L_QQ_Q_l_upper->quat[0][0],L_QQ_Q_l_upper->quat[0][1],L_QQ_Q_l_upper->quat[0][2],L_QQ_Q_l_upper->quat[0][3]);                             orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi);
1384                          qRoll[sizeqmcmd]=RYPang_upper->Kren;                             RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,L_QQ_Q_l_upper->quat[0][0],L_QQ_Q_l_upper->quat[0][1],L_QQ_Q_l_upper->quat[0][2],L_QQ_Q_l_upper->quat[0][3]);
1385                          qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;                             qRoll[sizeqmcmd]=RYPang_upper->Kren;
1386                          qPitch[sizeqmcmd]=RYPang_upper->Tangazh;                             qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
1387                          CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper);                             qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
1388                          break;                             CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper);
1389                               break;
1390                             }
1391                        }                        }
1392                      }                      }
1393                    }                    }
1394                  }                  }
1395                }                }
1396              }              }
1397              if ( debug ) printf(" ciccio \n");              //if ( debug ) cout << "subpacket " << j3 << "\t qtime = " << qtime[qtime.size()-1] << endl;
1398            }            }
1399          }          }
1400                    
1401          if(qtime.size()==0){          if(qtime.size()==0){                            // in case if no orientation information in data
1402              for(UInt_t my=0;my<recqtime.size();my++){            if ( debug ) cout << "qtime.size() = 0" << endl;
1403                  Int_t sizeqmcmd = qtime.size();            for(UInt_t my=0;my<recqtime.size();my++){
1404                  inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);              if(sqrt(pow(recq0[my],2)+pow(recq1[my],2)+pow(recq2[my],2)+pow(recq3[my],2))>0.99999){
1405                  qtime[sizeqmcmd]=recqtime[my];                Int_t sizeqmcmd = qtime.size();
1406                  q0[sizeqmcmd]=recq0[my];                inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
1407                  q1[sizeqmcmd]=recq1[my];                qtime[sizeqmcmd]=recqtime[my];
1408                  q2[sizeqmcmd]=recq2[my];                q0[sizeqmcmd]=recq0[my];
1409                  q3[sizeqmcmd]=recq3[my];                q1[sizeqmcmd]=recq1[my];
1410                  qmode[sizeqmcmd]=-10;                q2[sizeqmcmd]=recq2[my];
1411                  orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);                q3[sizeqmcmd]=recq3[my];
1412                  RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,recq0[my],recq1[my],recq2[my],recq3[my]);                qmode[sizeqmcmd]=-10;
1413                  qRoll[sizeqmcmd]=RYPang_upper->Kren;                orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);
1414                  qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;                RYPang_upper->TransAngle(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,recq0[my],recq1[my],recq2[my],recq3[my]);
1415                  qPitch[sizeqmcmd]=RYPang_upper->Tangazh;                qRoll[sizeqmcmd]=RYPang_upper->Kren;
1416              }                qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
1417                  qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
1418                }
1419              }
1420          }          }
1421                    
         if ( debug ) printf(" fuffi \n");  
1422    
1423          if ( debug ) printf(" puffi \n");          if ( debug ) printf(" puffi \n");
1424          Double_t tmin = 9999999999.;          Double_t tmin = 9999999999.;
# Line 1071  int OrbitalInfoCore(UInt_t run, TFile *f Line 1427  int OrbitalInfoCore(UInt_t run, TFile *f
1427            if(qtime[tre]>tmax)tmax = qtime[tre];            if(qtime[tre]>tmax)tmax = qtime[tre];
1428            if(qtime[tre]<tmin)tmin = qtime[tre];            if(qtime[tre]<tmin)tmin = qtime[tre];
1429          }          }
1430          if ( debug ) printf(" gnfuffi \n");          // sorting quaternions by time
1431           Bool_t t = true;
1432            while(t){
1433             t=false;
1434              for(UInt_t i=0;i<qtime.size()-1;i++){
1435                if(qtime[i]>qtime[i+1]){
1436                  Double_t tmpr = qtime[i];
1437                  qtime[i]=qtime[i+1];
1438                  qtime[i+1] = tmpr;
1439                  tmpr = q0[i];
1440                  q0[i]=q0[i+1];
1441                  q0[i+1] = tmpr;
1442                  tmpr = q1[i];
1443                  q1[i]=q1[i+1];
1444                  q1[i+1] = tmpr;
1445                  tmpr = q2[i];
1446                  q2[i]=q2[i+1];
1447                  q2[i+1] = tmpr;
1448                  tmpr = q3[i];
1449                  q3[i]=q3[i+1];
1450                  q3[i+1] = tmpr;
1451                  tmpr = qRoll[i];
1452                  qRoll[i]=qRoll[i+1];
1453                  qRoll[i+1] = tmpr;
1454                  tmpr = qYaw[i];
1455                  qYaw[i]=qYaw[i+1];
1456                  qYaw[i+1] = tmpr;
1457                  tmpr = qPitch[i];
1458                  qPitch[i]=qPitch[i+1];
1459                  qPitch[i+1] = tmpr;
1460                    t=true;
1461                }
1462              }
1463            }
1464    
1465            if ( debug ){
1466              cout << "we have loaded quaternions: size of quaternions set is "<< qtime.size() << endl;
1467             for(UInt_t i=0;i<qtime.size();i++) cout << qtime[i] << "\t";
1468              cout << endl << endl;
1469              Int_t lopu;
1470              cin >> lopu;
1471           }
1472    
1473        } // if we processed first event        } // if we processed first event
1474    
# Line 1079  int OrbitalInfoCore(UInt_t run, TFile *f Line 1476  int OrbitalInfoCore(UInt_t run, TFile *f
1476        //Filling Inclination information        //Filling Inclination information
1477        Double_t incli = 0;        Double_t incli = 0;
1478        if ( qtime.size() > 1 ){        if ( qtime.size() > 1 ){
1479        for(UInt_t mu = must;mu<qtime.size()-1;mu++){          if ( debug ) cout << "ok quaternions is exist and mu = " << must << endl;
1480          if ( debug ) printf(" ??grfuffi %i sixe %i must %i \n",mu,qtime.size()-1,must);          if ( debug ) cout << "qtimes[ " << qtime[0] << " , " << qtime[qtime.size()-1] << " ]\tatime = "<<atime<<endl;
1481          if(qtime[mu+1]>qtime[mu]){          for(UInt_t mu = must;mu<qtime.size()-1;mu++){
1482            if ( debug ) printf(" grfuffi2 %i \n",mu);            if ( debug ) printf(" ??grfuffi %i sixe %i must %i \n",mu,qtime.size()-1,must);
1483            if(atime<=qtime[mu+1] && atime>=qtime[mu]){            if(qtime[mu+1]>qtime[mu]){
1484              must = mu;              if ( debug ) cout << "qtime[" << mu << "] = " << qtime[mu] << "\tqtime[" << mu+1 << "] = " << qtime[mu+1] << "\tatime = " << atime << endl;
1485              incli = (qPitch[mu+1]-qPitch[mu])/(qtime[mu+1]-qtime[mu]);              if(atime<=qtime[mu+1] && atime>=qtime[mu]){
1486              orbitalinfo->theta =  incli*atime+qPitch[mu+1]-incli*qtime[mu+1];                if ( debug ) cout << "here we have found proper quaternions for interpolation: mu = "<<mu<<endl;
1487              incli = (qRoll[mu+1]-qRoll[mu])/(qtime[mu+1]-qtime[mu]);                must = mu;
1488              orbitalinfo->etha =  incli*atime+qRoll[mu+1]-incli*qtime[mu+1];                incli = (qPitch[mu+1]-qPitch[mu])/(qtime[mu+1]-qtime[mu]);
1489              incli = (qYaw[mu+1]-qYaw[mu])/(qtime[mu+1]-qtime[mu]);                orbitalinfo->theta =  incli*atime+qPitch[mu+1]-incli*qtime[mu+1];
1490              orbitalinfo->phi =  incli*atime+qYaw[mu+1]-incli*qtime[mu+1];                incli = (qRoll[mu+1]-qRoll[mu])/(qtime[mu+1]-qtime[mu]);
1491                              orbitalinfo->etha =  incli*atime+qRoll[mu+1]-incli*qtime[mu+1];
1492              incli = (q0[mu+1]-q0[mu])/(qtime[mu+1]-qtime[mu]);                incli = (qYaw[mu+1]-qYaw[mu])/(qtime[mu+1]-qtime[mu]);
1493              orbitalinfo->q0 =  incli*atime+q0[mu+1]-incli*qtime[mu+1];                orbitalinfo->phi =  incli*atime+qYaw[mu+1]-incli*qtime[mu+1];
1494              incli = (q1[mu+1]-q1[mu])/(qtime[mu+1]-qtime[mu]);                
1495              orbitalinfo->q1 =  incli*atime+q1[mu+1]-incli*qtime[mu+1];                incli = (q0[mu+1]-q0[mu])/(qtime[mu+1]-qtime[mu]);
1496              incli = (q2[mu+1]-q2[mu])/(qtime[mu+1]-qtime[mu]);                orbitalinfo->q0 =  incli*atime+q0[mu+1]-incli*qtime[mu+1];
1497              orbitalinfo->q2 =  incli*atime+q2[mu+1]-incli*qtime[mu+1];                incli = (q1[mu+1]-q1[mu])/(qtime[mu+1]-qtime[mu]);
1498              incli = (q3[mu+1]-q3[mu])/(qtime[mu+1]-qtime[mu]);                orbitalinfo->q1 =  incli*atime+q1[mu+1]-incli*qtime[mu+1];
1499              orbitalinfo->q3 =  incli*atime+q3[mu+1]-incli*qtime[mu+1];                incli = (q2[mu+1]-q2[mu])/(qtime[mu+1]-qtime[mu]);
1500                              orbitalinfo->q2 =  incli*atime+q2[mu+1]-incli*qtime[mu+1];
1501              orbitalinfo->TimeGap = qtime[mu+1]-qtime[mu];                incli = (q3[mu+1]-q3[mu])/(qtime[mu+1]-qtime[mu]);
1502              orbitalinfo->mode = qmode[mu+1];                orbitalinfo->q3 =  incli*atime+q3[mu+1]-incli*qtime[mu+1];
1503              //if(qmode[mu+1]==-10) orbitalinfo->R10r = true;else orbitalinfo->R10r = false;                Float_t tg = (qtime[mu+1]-qtime[mu])/1000.0;
1504              //reserved for next versions Vitaly.                if(tg>=1) tg=0.00;
1505              /*if(qmode[mu+1]==-10 || qmode[mu+1]==0 || qmode[mu+1]==1 || qmode[mu+1]==3 || qmode[mu+1]==4 || qmode[mu+1]==6){                orbitalinfo->TimeGap = TMath::Min(TMath::Abs(qtime[mu+1])-atime,TMath::Abs(atime-qtime[mu]))+tg;//qtime[mu+1]-qtime[mu];
1506                //linear interpolation                orbitalinfo->mode = qmode[mu+1];
1507                incli = (q0[mu+1]-q0[mu])/(qtime[mu+1]-qtime[mu]);                //if(atime==qtime[mu] || atime==qtime[mu+1]) orbitalinfo->qkind = 0; else orbitalinfo->qkind=1;
1508                orbitalinfo->q0 =  incli*atime+q0[mu+1]-incli*qtime[mu+1];                //if(qmode[mu+1]==-10) orbitalinfo->R10r = true;else orbitalinfo->R10r = false;
1509                incli = (q1[mu+1]-q1[mu])/(qtime[mu+1]-qtime[mu]);                if ( debug ) printf(" grfuffi4 %i \n",mu);
1510                orbitalinfo->q1 =  incli*atime+q1[mu+1]-incli*qtime[mu+1];                break;
1511                incli = (q2[mu+1]-q2[mu])/(qtime[mu+1]-qtime[mu]);              }
1512                orbitalinfo->q2 =  incli*atime+q2[mu+1]-incli*qtime[mu+1];            }
1513                incli = (q3[mu+1]-q3[mu])/(qtime[mu+1]-qtime[mu]);          }
               orbitalinfo->q3 =  incli*atime+q3[mu+1]-incli*qtime[mu+1];  
             }else{  
               //sine interpolation  
               for(UInt_t mt=0;mt<q0sine.size();mt++){  
                 if(atime<=q0sine[mt].finishPoint && atime>=q0sine[mt].startPoint){  
                   if(!q0sine[mt].NeedFit)orbitalinfo->q0=q0sine[mt].A*sin(q0sine[mt].b*atime+q0sine[mt].c);else{  
                     incli = (q0[mu+1]-q0[mu])/(qtime[mu+1]-qtime[mu]);  
                     orbitalinfo->q0 =  incli*atime+q0[mu+1]-incli*qtime[mu+1];  
                   }  
                 }  
                 if(atime<=q1sine[mt].finishPoint && atime>=q1sine[mt].startPoint){  
                   if(!q1sine[mt].NeedFit)orbitalinfo->q1=q1sine[mt].A*sin(q1sine[mt].b*atime+q1sine[mt].c);else{  
                     incli = (q1[mu+1]-q1[mu])/(qtime[mu+1]-qtime[mu]);  
                     orbitalinfo->q1 =  incli*atime+q1[mu+1]-incli*qtime[mu+1];  
                   }  
                 }  
                 if(atime<=q2sine[mt].finishPoint && atime>=q2sine[mt].startPoint){  
                   if(!q2sine[mt].NeedFit)orbitalinfo->q2=q0sine[mt].A*sin(q2sine[mt].b*atime+q2sine[mt].c);else{  
                     incli = (q2[mu+1]-q2[mu])/(qtime[mu+1]-qtime[mu]);  
                     orbitalinfo->q2 =  incli*atime+q2[mu+1]-incli*qtime[mu+1];  
                   }  
                 }  
                 if(atime<=q3sine[mt].finishPoint && atime>=q3sine[mt].startPoint){  
                   if(!q3sine[mt].NeedFit)orbitalinfo->q3=q0sine[mt].A*sin(q3sine[mt].b*atime+q3sine[mt].c);else{  
                     incli = (q3[mu+1]-q3[mu])/(qtime[mu+1]-qtime[mu]);  
                     orbitalinfo->q3 =  incli*atime+q3[mu+1]-incli*qtime[mu+1];  
                   }  
                 }  
                 if(atime<=Yawsine[mt].finishPoint && atime>=Yawsine[mt].startPoint){  
                   if(!Yawsine[mt].NeedFit)orbitalinfo->phi=Yawsine[mt].A*sin(Yawsine[mt].b*atime+Yawsine[mt].c);else{  
                     incli = (qYaw[mu+1]-qYaw[mu])/(qtime[mu+1]-qtime[mu]);  
                     orbitalinfo->phi =  incli*atime+qYaw[mu+1]-incli*qtime[mu+1];  
                   }  
                 }  
               }  
             }*/  
             //q0testing->Fill(atime,orbitalinfo->q0,100);  
             //q1testing->Fill(atime,orbitalinfo->q1,100);  
             //Pitchtesting->Fill(atime,orbitalinfo->etha);  
             //q2testing->Fill(atime,orbitalinfo->q2);  
             //q3testing->Fill(atime,orbitalinfo->q3);  
             break;  
           }  
         }  
       }  
1514        }        }
1515          if ( debug ) printf(" grfuffi5  \n");
1516        //        //
1517        // ops no inclination information        // ops no inclination information
1518        //        //
1519          
1520        if ( orbitalinfo->q0< -999 || orbitalinfo->q1 < -999 || orbitalinfo->q2 < -999 || orbitalinfo->q3 < -999 || orbitalinfo->q0 != orbitalinfo->q0 || orbitalinfo->q1 != orbitalinfo->q1 || orbitalinfo->q2 != orbitalinfo->q2 || orbitalinfo->q3 != orbitalinfo->q3 ){        if ( orbitalinfo->q0< -999 || orbitalinfo->q1 < -999 || orbitalinfo->q2 < -999 || orbitalinfo->q3 < -999 || orbitalinfo->q0 != orbitalinfo->q0 || orbitalinfo->q1 != orbitalinfo->q1 || orbitalinfo->q2 != orbitalinfo->q2 || orbitalinfo->q3 != orbitalinfo->q3 ){
1521            if ( debug ) cout << "ops no iclination information" << endl;
1522          orbitalinfo->mode = 10;          orbitalinfo->mode = 10;
1523          orbitalinfo->q0 = -1000.;          orbitalinfo->q0 = -1000.;
1524          orbitalinfo->q1 = -1000.;          orbitalinfo->q1 = -1000.;
# Line 1173  int OrbitalInfoCore(UInt_t run, TFile *f Line 1527  int OrbitalInfoCore(UInt_t run, TFile *f
1527          orbitalinfo->etha = -1000.;          orbitalinfo->etha = -1000.;
1528          orbitalinfo->phi = -1000.;          orbitalinfo->phi = -1000.;
1529          orbitalinfo->theta = -1000.;          orbitalinfo->theta = -1000.;
1530        };          orbitalinfo->TimeGap = -1000.;
1531            //orbitalinfo->qkind = -1000;
1532            
1533            //      if ( debug ){
1534            //        Int_t lopu;
1535            //         cin >> lopu;
1536            //      }
1537            if ( debug ) printf(" grfuffi6 \n");
1538          }
1539        //        //
1540          if ( debug ) printf(" filling \n");
1541        // #########################################################################################################################          // #########################################################################################################################  
1542        //        //
1543        // fill orbital positions        // fill orbital positions
# Line 1185  int OrbitalInfoCore(UInt_t run, TFile *f Line 1548  int OrbitalInfoCore(UInt_t run, TFile *f
1548        lon = (coo.m_Lon > M_PI) ? rad2deg(coo.m_Lon - 2*M_PI) : rad2deg(coo.m_Lon);        lon = (coo.m_Lon > M_PI) ? rad2deg(coo.m_Lon - 2*M_PI) : rad2deg(coo.m_Lon);
1549        lat = rad2deg(coo.m_Lat);        lat = rad2deg(coo.m_Lat);
1550        alt = coo.m_Alt;        alt = coo.m_Alt;
1551        //  
1552          cOrbit orbits2(*gltle->GetTle());
1553          orbits2.getPosition((double) (atime - gltle->GetFromTime())/60., &eCi);
1554          //      Float_t x=eCi.getPos().m_x;
1555          //      Float_t y=eCi.getPos().m_y;
1556          //      Float_t z=eCi.getPos().m_z;
1557          
1558          TVector3 V(eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z);
1559          TVector3 Pos(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z);
1560          
1561          Float_t dlon=Pos.Phi()*TMath::RadToDeg()-lon;
1562          
1563          Pos.RotateZ(-dlon*TMath::DegToRad());
1564          V.RotateZ(-dlon*TMath::DegToRad());
1565          Float_t diro;
1566          if(V.Z()>0) diro=1; else diro=-1;
1567          
1568          // 10REDNEW
1569          Int_t errq=0;
1570          Int_t azim=0;
1571          Int_t qual=0;
1572          Int_t MU=0;
1573          for(UInt_t mu = 0;mu<RTtime2.size()-1;mu++){
1574            if(atime<RTstart[mu+1] && atime>=RTstart[mu]){
1575              errq=RTerrq[mu];
1576              azim=RTazim[mu];
1577              qual=RTqual[mu];
1578              MU=mu;
1579              break;
1580            }
1581          }
1582          orbitalinfo->errq = errq;
1583          orbitalinfo->azim = azim;
1584          orbitalinfo->rtqual=qual;
1585          orbitalinfo->qkind = 0;
1586          
1587          if ( debug ) printf(" coord done \n");
1588        if( lon<180 && lon>-180 && lat<90 && lat>-90 && alt>0 ){          if( lon<180 && lon>-180 && lat<90 && lat>-90 && alt>0 ){  
1589          //                //      
1590          orbitalinfo->lon = lon;          orbitalinfo->lon = lon;
1591          orbitalinfo->lat = lat;          orbitalinfo->lat = lat;
1592          orbitalinfo->alt = alt ;          orbitalinfo->alt = alt;
1593            orbitalinfo->V = V;
1594    
1595            //      GMtype_CoordGeodetic  location;
1596            location.lambda = lon;
1597            location.phi = lat;
1598            location.HeightAboveEllipsoid = alt;
1599    
1600            GM_GeodeticToSpherical(Ellip, location, &CoordSpherical);
1601            GM_SphericalToCartesian(CoordSpherical,  &CoordCartesian);
1602            GM_EarthCartToDipoleCartCD(Pole, CoordCartesian, &DipoleCartesian);
1603            GM_CartesianToSpherical(DipoleCartesian, &DipoleSpherical);
1604            orbitalinfo->londip = DipoleSpherical.lambda;
1605            orbitalinfo->latdip = DipoleSpherical.phig;
1606    
1607            if(debug)cout<<"geodetic:\t"<<lon<<"\t"<<lat<<"\tgeomagnetic:\t"<<orbitalinfo->londip<<"\t"<<orbitalinfo->latdip<<endl;
1608    
1609          //          //
1610          // compute mag field components and L shell.          // compute mag field components and L shell.
1611          //          //
1612            if ( debug ) printf(" call igrf feldg \n");
1613          feldg_(&lat, &lon, &alt, &bnorth, &beast, &bdown, &babs);          feldg_(&lat, &lon, &alt, &bnorth, &beast, &bdown, &babs);
1614            if ( debug ) printf(" call igrf shellg \n");
1615          shellg_(&lat, &lon, &alt, &dimo, &xl, &icode, &bab1);          shellg_(&lat, &lon, &alt, &dimo, &xl, &icode, &bab1);
1616            if ( debug ) printf(" call igrf findb \n");
1617          findb0_(&stps, &bdel, &value, &bequ, &rr0);          findb0_(&stps, &bdel, &value, &bequ, &rr0);
1618          //          //
1619            if ( debug ) printf(" done igrf \n");
1620          orbitalinfo->Bnorth = bnorth;          orbitalinfo->Bnorth = bnorth;
1621          orbitalinfo->Beast = beast;          orbitalinfo->Beast = beast;
1622          orbitalinfo->Bdown = bdown;          orbitalinfo->Bdown = bdown;
# Line 1207  int OrbitalInfoCore(UInt_t run, TFile *f Line 1626  int OrbitalInfoCore(UInt_t run, TFile *f
1626          orbitalinfo->L = xl;                orbitalinfo->L = xl;      
1627          // Set Stormer vertical cutoff using L shell.          // Set Stormer vertical cutoff using L shell.
1628          orbitalinfo->cutoffsvl = 14.295 / (xl*xl); //          orbitalinfo->cutoffsvl = 14.295 / (xl*xl); //
1629          /*          if(debug)cout << "L = " << xl << "\tM = " << dimo << "\tvertical cutoff:  "<< orbitalinfo->cutoffsvl << endl;
1630  ---------- Forwarded message ----------  
1631  Date: Wed, 09 May 2012 12:16:47 +0200          
1632  From: Alessandro Bruno <alessandro.bruno@ba.infn.it>  //           ---------- Forwarded message ----------
1633  To: Mirko Boezio <mirko.boezio@ts.infn.it>  //           Date: Wed, 09 May 2012 12:16:47 +0200
1634  Cc: Francesco S. Cafagna <Francesco.Cafagna@ba.infn.it>  //           From: Alessandro Bruno <alessandro.bruno@ba.infn.it>
1635  Subject: Störmer vertical cutoff  //           To: Mirko Boezio <mirko.boezio@ts.infn.it>
1636    //           Cc: Francesco S. Cafagna <Francesco.Cafagna@ba.infn.it>
1637  Ciao Mirko,  //           Subject: Störmer vertical cutoff
1638  volevo segnalarti che il valore dello Störmer vertical cutoff nel Level2 è  
1639  sovrastimato di circa il 4%.  //           Ciao Mirko,
1640  Dopo un'approfondita analisi con l'IGRF-05 abbiamo ricavano un valore pari  //           volevo segnalarti che il valore dello Störmer vertical cutoff nel Level2 è
1641  a: 14.295 / L^2 anzichè 14.9 / L^2, valore obsoleto in quanto riferito agli  //           sovrastimato di circa il 4%.
1642  anni '50.  //           Dopo un'approfondita analisi con l'IGRF-05 abbiamo ricavano un valore pari
1643  */  //           a: 14.295 / L^2 anzichè 14.9 / L^2, valore obsoleto in quanto riferito agli
1644    //           anni '50.
1645    //        
1646          //14.9/(xl*xl);          //14.9/(xl*xl);
1647          orbitalinfo->igrf_icode = icode;          orbitalinfo->igrf_icode = icode;
1648          //          //
1649        };              }      
1650        //        //
1651        if ( debug ) printf(" pitch angle \n");        if ( debug ) printf(" pitch angle \n");
1652        //        //
1653        // pitch angles        // pitch angles
1654        //        //
1655        //if ( orbitalinfo->mode != 10 && orbitalinfo->mode != 5 && orbitalinfo->mode !=7 && orbitalinfo->mode != 9 ){        if( orbitalinfo->TimeGap>0){
       if( orbitalinfo->TimeGap>0 && orbitalinfo->TimeGap<2000000){  
1656          //          //
1657            if ( debug ) printf(" timegap %f \n",orbitalinfo->TimeGap);
1658          Float_t Bx = -orbitalinfo->Bdown;          Float_t Bx = -orbitalinfo->Bdown;
1659          Float_t By = orbitalinfo->Beast;          Float_t By = orbitalinfo->Beast;
1660          Float_t Bz = orbitalinfo->Bnorth;          Float_t Bz = orbitalinfo->Bnorth;
1661          //  
1662          TMatrixD Fij = PO->ECItoGreenwich(PO->QuatoECI(orbitalinfo->q0,orbitalinfo->q1,orbitalinfo->q2,orbitalinfo->q3),orbitalinfo->absTime);  //      TMatrixD Qiji(3,3);
1663            TMatrixD Qij = PO->QuatoECI(orbitalinfo->q0,orbitalinfo->q1,orbitalinfo->q2,orbitalinfo->q3);
1664            TMatrixD Dij = PO->ECItoGEO(Qij,orbitalinfo->absTime,orbitalinfo->lat,orbitalinfo->lon);
1665    
1666    //10REDNEW
1667            // If initial orientation data have reason to be inaccurate
1668           Float_t tg = 0.00;
1669           Float_t tmptg;
1670           if(MU!=0){
1671    //      if(orbitalinfo->TimeGap>0 && errq==0 && azim==0){               // 10RED CHECK  (comparison between three metod of recovering orientation)
1672           if((atime>=RTstart[MU] && atime<RTstart[MU+1] && RTbank1[MU]==0 && RTbank2[MU]==0 && TMath::Abs(orbitalinfo->etha)>0.1) || ((RTbank1[MU]!=0 || RTbank2[MU]!=0) && atime>=RTstart[MU] && atime<RTstart[MU+1] && azim==0 && (errq!=0 || orbitalinfo->TimeGap>10.0 || ((modf(orbitalinfo->TimeGap,&tmptg)*1000>10 || modf(orbitalinfo->TimeGap,&tmptg)*1000==0.0) && orbitalinfo->TimeGap>2.0)))){
1673            //found in Rotation Table this data for this time interval
1674            if(atime<RTtime1[0])
1675              orbitalinfo->azim = 5;        //means that RotationTable no started yet
1676           else{
1677                    // search for angle betwean velosity and direction to north in tangential to Earth surfase plane in satellite position
1678                  Double_t bank=RTstart[MU];
1679                  Double_t tlat=orbitalinfo->lat;
1680    
1681                  tg=modf(orbitalinfo->TimeGap,&tg)*1000;
1682    
1683                  if(atime>=RTpluto1[MU] && atime<=RTpluto2[MU]){
1684                    Double_t kar=(RTbank2[MU]-RTbank1[MU])/(RTtime2[MU]-RTtime1[MU]);
1685                    Double_t bak=RTbank1[MU]-kar*RTtime1[MU];
1686                    bank=kar*atime+bak;
1687                  }
1688                  if(atime>=RTstart[MU] && atime<RTpluto1[MU]){
1689                     Double_t s_dBdt2=(RTbpluto1[MU]-RTbank1[MU])/(Int_t)(RTpluto1[MU]-RTstart[MU]);
1690                     Double_t s_t2=((Double_t)RTpluto1[MU]+(Double_t)RTstart[MU])/2. - RTstart[MU];
1691                     Double_t s_t1=RTstart[MU]-RTstart[MU];
1692                     Double_t s_k=s_dBdt2/(s_t2-s_t1);
1693                     Double_t s_b=-s_k*s_t1;
1694                     Double_t s_t3=RTpluto1[MU]-RTstart[MU];
1695                     Double_t s_b3=RTbpluto1[MU];
1696                     Double_t s_c=s_b3-0.5*s_k*s_t3*s_t3 -s_b*s_t3;
1697                     bank=0.5*s_k*(atime-RTstart[MU])*(atime-RTstart[MU]) + s_b*(atime-RTstart[MU]) + s_c;
1698                 }
1699                  if(atime>RTpluto2[MU] && atime<=RTstart[MU+1]){
1700                     Double_t s_dBdt2=(RTbpluto2[MU] - RTbank2[MU])/(Int_t)(RTpluto2[MU]-RTstart[MU+1]);
1701                     Double_t s_t2=((Double_t)RTpluto2[MU]+(Double_t)RTstart[MU+1])/2. - RTstart[MU];
1702                     Double_t s_t1=RTstart[MU+1]-RTstart[MU];
1703                     Double_t s_k=s_dBdt2/(s_t2-s_t1);
1704                     Double_t s_b=-s_k*s_t1;
1705                     Double_t s_t3=RTpluto2[MU]-RTstart[MU];
1706                     Double_t s_b3=RTbpluto2[MU];
1707                     Double_t s_c=s_b3-0.5*s_k*s_t3*s_t3 -s_b*s_t3;
1708                   bank=0.5*s_k*(atime-RTstart[MU])*(atime-RTstart[MU]) + s_b*(atime-RTstart[MU]) + s_c;
1709                 }
1710                  if(TMath::Abs(orbitalinfo->etha-bank)>0.1){
1711                    orbitalinfo->etha=bank;
1712                    Double_t spitch = 0.00001;  // temprary not zero to avoid problem with tranzition from Euler angles to orientation matrix
1713    
1714                    //Estimations of pitch angle of satellite
1715                    if(TMath::Abs(bank)>0.7){
1716                       Float_t spitch1=TMath::DegToRad()*0.7*diro;//RTdir1[MU];
1717                       Float_t spitch2=TMath::DegToRad()*0.7*diro;//RTdir2[MU];
1718                       Float_t kva=(spitch2-spitch1)/(RTtime2[MU]-RTtime1[MU]);
1719                       Float_t bva=spitch1-kva*RTtime1[MU];
1720                       spitch=kva*atime+bva;
1721                    }
1722    
1723                    //Calculate Yaw angle accordingly with fit, see picture FitYaw.jpg
1724                    Double_t yaw=0.00001;  // temprary not zero to avoid problem with tranzition from Euler angles to orientation matrix
1725                    if(TMath::Abs(tlat)<70)
1726                      yaw = -3.7e-8*tlat*tlat*tlat*tlat + 1.4e-7*tlat*tlat*tlat - 0.0005*tlat*tlat - 0.00025*tlat + 3.6;
1727                    yaw = diro*yaw; //because should be different sign for ascending and descending orbits!
1728                    orbitalinfo->phi=yaw;
1729    
1730                    if(TMath::Abs(bank)>0.5 && TMath::Abs(yaw-orbitalinfo->phi)<3.0) yaw=orbitalinfo->phi;
1731    
1732    //              Qiji = PO->EulertoEci(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,bank,yaw,spitch);           // 10RED CHECK
1733                    Qij = PO->EulertoEci(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z,eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z,bank,yaw,spitch);            // STANDARD
1734                    orbitalinfo->qkind = 1;
1735                 }
1736    
1737              //Qij = PO->GEOtoECI(Dij,orbitalinfo->absTime,orbitalinfo->lat,orbitalinfo->lon); // to convert from Dij to Qij
1738    
1739            } // end of if(atime<RTtime1[0]
1740            } // end of (((orbitalinfo->TimeGap>60.0 && TMath...
1741           } // end of MU~=0
1742    
1743            TMatrixD qij = PO->ColPermutation(Qij);
1744            TMatrixD Fij = PO->ECItoGreenwich(Qij,orbitalinfo->absTime);
1745          TMatrixD Gij = PO->ColPermutation(Fij);          TMatrixD Gij = PO->ColPermutation(Fij);
1746          TMatrixD Dij = PO->GreenwichtoGEO(orbitalinfo->lat,orbitalinfo->lon,Fij);          Dij = PO->ECItoGEO(Qij,orbitalinfo->absTime,orbitalinfo->lat,orbitalinfo->lon);
1747          TMatrixD Iij = PO->ColPermutation(Dij);          TMatrixD Iij = PO->ColPermutation(Dij);
1748          //          TVector3 SP = PO->GetSunPosition(orbitalinfo->absTime);
1749            // go to Pamela reference frame from Resurs reference frame
1750            Float_t tmpy = SP.Y();
1751            SP.SetY(SP.Z());
1752            SP.SetZ(-tmpy);
1753            TVector3 SunZenith;
1754            SunZenith.SetMagThetaPhi(1,23.439281*TMath::DegToRad(),TMath::Pi()/2.);
1755            TVector3 SunMag = -SP;
1756            SunMag.Rotate(-45*TMath::DegToRad(),SunZenith);
1757            tmpy=SunMag.Y();
1758            SunMag.SetY(SunMag.Z());
1759            SunMag.SetZ(-tmpy);
1760    
1761          orbitalinfo->Iij.ResizeTo(Iij);          orbitalinfo->Iij.ResizeTo(Iij);
1762          orbitalinfo->Iij = Iij;          orbitalinfo->Iij = Iij;
1763          //          //
1764          A1 = Iij(0,2);          //      A1 = Iij(0,2);
1765          A2 = Iij(1,2);          //      A2 = Iij(1,2);
1766          A3 = Iij(2,2);          //      A3 = Iij(2,2);
1767          //          //
1768          //      orbitalinfo->pamzenitangle = (Float_t)PO->GetPitchAngle(1,0,0,A1,A2,A3);                        // Angle between zenit and Pamela's main axiz          //      orbitalinfo->pamzenitangle = (Float_t)PO->GetPitchAngle(1,0,0,A1,A2,A3);                        // Angle between zenit and Pamela's main axiz
1769          //      orbitalinfo->pamBangle = (Float_t)PO->GetPitchAngle(A1,A2,A3,Bx,By,Bz);                 // Angle between Pamela's main axiz and B          //      orbitalinfo->pamBangle = (Float_t)PO->GetPitchAngle(A1,A2,A3,Bx,By,Bz);                 // Angle between Pamela's main axiz and B
1770          //          //
1771          if ( !standalone && tof->ntrk() > 0 ){          if ( debug ) printf(" matrixes done  \n");
1772            if ( !standalone ){
1773              if ( debug ) printf(" !standalone \n");
1774            //            //
1775              // Standard tracking algorithm
1776              //
1777            Int_t nn = 0;            Int_t nn = 0;
1778              if ( verbose ) printf(" standard tracking \n");
1779            for(Int_t nt=0; nt < tof->ntrk(); nt++){              for(Int_t nt=0; nt < tof->ntrk(); nt++){  
1780              //              //
1781              ToFTrkVar *ptt = tof->GetToFTrkVar(nt);              ToFTrkVar *ptt = tof->GetToFTrkVar(nt);
1782                if (debug) cout<<"tof->ntrk() = "<<tof->ntrk()<<"\tptt->trkseqno = "<<ptt->trkseqno<<"\ttrke->ntrk() = "<<trke->ntrk()<<endl;
1783              Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];              Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];
1784              Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];              Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];
1785              Double_t E11z = zin[0];              Double_t E11z = zin[0];
# Line 1266  anni '50. Line 1787  anni '50.
1787              Double_t E22y = ptt->ytr_tof[3];//tr->y[3];              Double_t E22y = ptt->ytr_tof[3];//tr->y[3];
1788              Double_t E22z = zin[3];              Double_t E22z = zin[3];
1789              if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){              if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){
1790                  TrkTrack *mytrack = trke->GetStoredTrack(ptt->trkseqno);
1791                  Float_t rig=1/mytrack->GetDeflection();
1792                Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));                Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));
1793                //              Double_t MyAzim = TMath::RadToDeg()*atan(TMath::Abs(E22y-E11y)/TMath::Abs(E22x-E11x));                //
               //              if(E22x-E11x>=0 && E22y-E11y <0) MyAzim =  360. - MyAzim;  
               //              if(E22x-E11x>=0 && E22y-E11y >=0) MyAzim = MyAzim;  
               //              if(E22x-E11x<0 && E22y-E11y >0) MyAzim = 180. - MyAzim;  
               //              if(E22x-E11x<0 && E22y-E11y <0) MyAzim = 180. + MyAzim;  
1794                Px = (E22x-E11x)/norm;                Px = (E22x-E11x)/norm;
1795                Py = (E22y-E11y)/norm;                Py = (E22y-E11y)/norm;
1796                Pz = (E22z-E11z)/norm;                Pz = (E22z-E11z)/norm;
# Line 1288  anni '50. Line 1807  anni '50.
1807                //                            //            
1808                t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);                t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);
1809                //                //
1810                  // SunPosition in instrumental reference frame
1811                  TMatrixD Kij = PO->PamelatoGEO(qij,Px,Py,Pz);
1812                  TMatrixD Lij = PO->PamelatoGEO(qij,0,0,1);
1813                  t_orb->sunangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),-SP.X(),-SP.Y(),-SP.Z());
1814                  t_orb->sunmagangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),SunMag.X(),SunMag.Y(),SunMag.Z());
1815                //                //
               Double_t omega = PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),cos(orbitalinfo->lon+TMath::Pi()/2)-sin(orbitalinfo->lon+TMath::Pi()/2),cos(orbitalinfo->lon+TMath::Pi()/2)+sin(orbitalinfo->lon+TMath::Pi()/2),1);  
1816                //                //
1817                t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow((1+sqrt(1-pow(orbitalinfo->L,-3/2)*cos(omega))),2));                Double_t omega = PO->GetPitchAngle(-Eij(0,0),-Eij(1,0),-Eij(2,0),1,0,0) * TMath::DegToRad();
1818                  TVector3 Bxy(0,By,Bz);
1819                  TVector3 Exy(0,-Eij(1,0),-Eij(2,0));
1820                  Double_t dzeta=Bxy.Angle(Exy);
1821                  if (-Eij(1,0) < 0) dzeta=2.0*TMath::Pi() - dzeta;
1822                  
1823                  if(debug) cout << "omega = "<<omega*TMath::RadToDeg()<<"\tdzeta = "<<dzeta*TMath::RadToDeg()<<endl;
1824    
1825                  // Formula from D.F. Smart *, M.A. Shea [2005]; A review of geomagnetic cutoff rigidities for earth-orbiting spacecraft
1826                  if(rig>=0) t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow(1+sqrt(1-sin(omega)*sin(dzeta)*pow(cos(orbitalinfo->lat*TMath::DegToRad()),3)),2));
1827                  else       t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow(1+sqrt(1-sin(omega)*sin(TMath::Pi()+dzeta)*pow(cos(orbitalinfo->lat*TMath::DegToRad()),3)),2));
1828                  if (debug) cout << "R = " << rig << "\tcutoff = " << t_orb->cutoff << endl;
1829    
1830                //                //
1831                if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;                if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;
1832                if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;                if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;
1833                  if ( t_orb->sunangle != t_orb->sunangle ) t_orb->sunangle = -1000.;
1834                  if ( t_orb->sunmagangle != t_orb->sunmagangle ) t_orb->sunmagangle = -1000.;
1835                //                //
1836                if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);                if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);
1837                //                //
# Line 1303  anni '50. Line 1840  anni '50.
1840                //                //
1841                t_orb->Clear();                t_orb->Clear();
1842                //                //
1843              };              }
1844              //              //
1845            };            } // end standard tracking algorithm
1846    
1847              //
1848              // Code for extended tracking algorithm:
1849              //
1850              if ( hasNucleiTrk ){
1851                Int_t ttentry = 0;
1852                if ( verbose ) printf(" hasNucleiTrk \n");
1853                for(Int_t nt=0; nt < tcNucleiTof->GetEntries() ; nt++){  
1854                  //
1855                  if ( verbose ) printf(" got1\n");
1856                  ToFTrkVar *ptt = (ToFTrkVar*)(tcNucleiTof->At(nt));
1857                  if (verbose) cout<<" tcNucleiTof->GetEntries() = "<<tcNucleiTof->GetEntries()<<"\tptt->trkseqno = "<<ptt->trkseqno<<endl;
1858                  Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];
1859                  Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];
1860                  Double_t E11z = zin[0];
1861                  Double_t E22x = ptt->xtr_tof[3];//tr->x[3];
1862                  Double_t E22y = ptt->ytr_tof[3];//tr->y[3];
1863                  Double_t E22z = zin[3];
1864                  if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){
1865                    TrkTrack *mytrack = (TrkTrack*)(tcNucleiTrk->At(ptt->trkseqno));
1866                    if ( verbose ) printf(" got tcNucleiTrk \n");
1867                    Float_t rig=1/mytrack->GetDeflection();
1868                    Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));
1869                    //
1870                    Px = (E22x-E11x)/norm;
1871                    Py = (E22y-E11y)/norm;
1872                    Pz = (E22z-E11z)/norm;
1873                    //
1874                    t_orb->trkseqno = ptt->trkseqno;
1875                    //
1876                    TMatrixD Eij = PO->PamelatoGEO(Iij,Px,Py,Pz);
1877                    t_orb->Eij.ResizeTo(Eij);      
1878                    t_orb->Eij = Eij;      
1879                    //
1880                    TMatrixD Sij = PO->PamelatoGEO(Gij,Px,Py,Pz);
1881                    t_orb->Sij.ResizeTo(Sij);
1882                    t_orb->Sij = Sij;
1883                    //          
1884                    t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);
1885                    //
1886                    // SunPosition in instrumental reference frame
1887                    TMatrixD Kij = PO->PamelatoGEO(qij,Px,Py,Pz);
1888                    TMatrixD Lij = PO->PamelatoGEO(qij,0,0,1);
1889                    t_orb->sunangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),-SP.X(),-SP.Y(),-SP.Z());
1890                    t_orb->sunmagangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),SunMag.X(),SunMag.Y(),SunMag.Z());
1891                    //
1892                    //
1893                    Double_t omega = PO->GetPitchAngle(-Eij(0,0),-Eij(1,0),-Eij(2,0),1,0,0) * TMath::DegToRad();
1894                    TVector3 Bxy(0,By,Bz);
1895                    TVector3 Exy(0,-Eij(1,0),-Eij(2,0));
1896                    Double_t dzeta=Bxy.Angle(Exy);
1897                    if (-Eij(1,0) < 0) dzeta=2.0*TMath::Pi() - dzeta;
1898                    
1899                    if(debug) cout << "omega = "<<omega*TMath::RadToDeg()<<"\tdzeta = "<<dzeta*TMath::RadToDeg()<<endl;
1900                    
1901                    // Formula from D.F. Smart *, M.A. Shea [2005]; A review of geomagnetic cutoff rigidities for earth-orbiting spacecraft
1902                    if(rig>=0) t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow(1+sqrt(1-sin(omega)*sin(dzeta)*pow(cos(orbitalinfo->lat*TMath::DegToRad()),3)),2));
1903                    else       t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow(1+sqrt(1-sin(omega)*sin(TMath::Pi()+dzeta)*pow(cos(orbitalinfo->lat*TMath::DegToRad()),3)),2));
1904                    if (debug) cout << "R = " << rig << "\tcutoff = " << t_orb->cutoff << endl;
1905                    
1906                    //
1907                    if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;
1908                    if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;
1909                    if ( t_orb->sunangle != t_orb->sunangle ) t_orb->sunangle = -1000.;
1910                    if ( t_orb->sunmagangle != t_orb->sunmagangle ) t_orb->sunmagangle = -1000.;
1911                    //
1912                    if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);
1913                    //
1914                    TClonesArray &tt1 = *torbNucleiTrk;
1915                    new(tt1[ttentry]) OrbitalInfoTrkVar(*t_orb);
1916                    ttentry++;
1917                    //
1918                    t_orb->Clear();
1919                    //
1920                  }
1921                  //
1922                }
1923              } // end standard tracking algorithm: nuclei
1924              if ( hasExtNucleiTrk ){
1925                Int_t ttentry = 0;
1926                if ( verbose ) printf(" hasExtNucleiTrk \n");
1927                for(Int_t nt=0; nt < tcExtNucleiTof->GetEntries() ; nt++){  
1928                  //
1929                  if ( verbose ) printf(" got2\n");
1930                  ToFTrkVar *ptt = (ToFTrkVar*)(tcExtNucleiTof->At(nt));
1931                  if (verbose) cout<<" tcExtNucleiTof->GetEntries() = "<<tcExtNucleiTof->GetEntries()<<"\tptt->trkseqno = "<<ptt->trkseqno<<endl;
1932                  Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];
1933                  Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];
1934                  Double_t E11z = zin[0];
1935                  Double_t E22x = ptt->xtr_tof[3];//tr->x[3];
1936                  Double_t E22y = ptt->ytr_tof[3];//tr->y[3];
1937                  Double_t E22z = zin[3];
1938                  if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){
1939                    ExtTrack *mytrack = (ExtTrack*)(tcExtNucleiTrk->At(ptt->trkseqno));
1940                    if ( verbose ) printf(" got tcExtNucleiTrk \n");
1941                    Float_t rig=1/mytrack->GetDeflection();
1942                    Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));
1943                    //
1944                    Px = (E22x-E11x)/norm;
1945                    Py = (E22y-E11y)/norm;
1946                    Pz = (E22z-E11z)/norm;
1947                    //
1948                    t_orb->trkseqno = ptt->trkseqno;
1949                    //
1950                    TMatrixD Eij = PO->PamelatoGEO(Iij,Px,Py,Pz);
1951                    t_orb->Eij.ResizeTo(Eij);      
1952                    t_orb->Eij = Eij;      
1953                    //
1954                    TMatrixD Sij = PO->PamelatoGEO(Gij,Px,Py,Pz);
1955                    t_orb->Sij.ResizeTo(Sij);
1956                    t_orb->Sij = Sij;
1957                    //          
1958                    t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);
1959                    //
1960                    // SunPosition in instrumental reference frame
1961                    TMatrixD Kij = PO->PamelatoGEO(qij,Px,Py,Pz);
1962                    TMatrixD Lij = PO->PamelatoGEO(qij,0,0,1);
1963                    t_orb->sunangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),-SP.X(),-SP.Y(),-SP.Z());
1964                    t_orb->sunmagangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),SunMag.X(),SunMag.Y(),SunMag.Z());
1965                    //
1966                    //
1967                    Double_t omega = PO->GetPitchAngle(-Eij(0,0),-Eij(1,0),-Eij(2,0),1,0,0) * TMath::DegToRad();
1968                    TVector3 Bxy(0,By,Bz);
1969                    TVector3 Exy(0,-Eij(1,0),-Eij(2,0));
1970                    Double_t dzeta=Bxy.Angle(Exy);
1971                    if (-Eij(1,0) < 0) dzeta=2.0*TMath::Pi() - dzeta;
1972                    
1973                    if(debug) cout << "omega = "<<omega*TMath::RadToDeg()<<"\tdzeta = "<<dzeta*TMath::RadToDeg()<<endl;
1974                    
1975                    // Formula from D.F. Smart *, M.A. Shea [2005]; A review of geomagnetic cutoff rigidities for earth-orbiting spacecraft
1976                    if(rig>=0) t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow(1+sqrt(1-sin(omega)*sin(dzeta)*pow(cos(orbitalinfo->lat*TMath::DegToRad()),3)),2));
1977                    else       t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow(1+sqrt(1-sin(omega)*sin(TMath::Pi()+dzeta)*pow(cos(orbitalinfo->lat*TMath::DegToRad()),3)),2));
1978                    if (debug) cout << "R = " << rig << "\tcutoff = " << t_orb->cutoff << endl;
1979                    
1980                    //
1981                    if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;
1982                    if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;
1983                    if ( t_orb->sunangle != t_orb->sunangle ) t_orb->sunangle = -1000.;
1984                    if ( t_orb->sunmagangle != t_orb->sunmagangle ) t_orb->sunmagangle = -1000.;
1985                    //
1986                    if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);
1987                    //
1988                    TClonesArray &tt2 = *torbExtNucleiTrk;
1989                    new(tt2[ttentry]) OrbitalInfoTrkVar(*t_orb);
1990                    ttentry++;
1991                    //
1992                    t_orb->Clear();
1993                    //
1994                  }
1995                  //
1996                }
1997              } // end standard tracking algorithm: nuclei extended
1998             if ( hasExtTrk ){
1999                Int_t ttentry = 0;
2000                if ( verbose ) printf(" hasExtTrk \n");
2001                for(Int_t nt=0; nt < tcExtTof->GetEntries() ; nt++){  
2002                  //
2003                  if ( verbose ) printf(" got3\n");
2004                  ToFTrkVar *ptt = (ToFTrkVar*)(tcExtTof->At(nt));
2005                  if (verbose) cout<<" tcExtTof->GetEntries() = "<<tcExtTof->GetEntries()<<"\tptt->trkseqno = "<<ptt->trkseqno<<endl;
2006                  Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];
2007                  Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];
2008                  Double_t E11z = zin[0];
2009                  Double_t E22x = ptt->xtr_tof[3];//tr->x[3];
2010                  Double_t E22y = ptt->ytr_tof[3];//tr->y[3];
2011                  Double_t E22z = zin[3];
2012                  if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){
2013                    ExtTrack *mytrack = (ExtTrack*)(tcExtTrk->At(ptt->trkseqno));
2014                    if ( verbose ) printf(" got tcExtTrk \n");
2015                    Float_t rig=1/mytrack->GetDeflection();
2016                    Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));
2017                    //
2018                    Px = (E22x-E11x)/norm;
2019                    Py = (E22y-E11y)/norm;
2020                    Pz = (E22z-E11z)/norm;
2021                    //
2022                    t_orb->trkseqno = ptt->trkseqno;
2023                    //
2024                    TMatrixD Eij = PO->PamelatoGEO(Iij,Px,Py,Pz);
2025                    t_orb->Eij.ResizeTo(Eij);      
2026                    t_orb->Eij = Eij;      
2027                    //
2028                    TMatrixD Sij = PO->PamelatoGEO(Gij,Px,Py,Pz);
2029                    t_orb->Sij.ResizeTo(Sij);
2030                    t_orb->Sij = Sij;
2031                    //          
2032                    t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);
2033                    //
2034                    // SunPosition in instrumental reference frame
2035                    TMatrixD Kij = PO->PamelatoGEO(qij,Px,Py,Pz);
2036                    TMatrixD Lij = PO->PamelatoGEO(qij,0,0,1);
2037                    t_orb->sunangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),-SP.X(),-SP.Y(),-SP.Z());
2038                    t_orb->sunmagangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),SunMag.X(),SunMag.Y(),SunMag.Z());
2039                    //
2040                    //
2041                    Double_t omega = PO->GetPitchAngle(-Eij(0,0),-Eij(1,0),-Eij(2,0),1,0,0) * TMath::DegToRad();
2042                    TVector3 Bxy(0,By,Bz);
2043                    TVector3 Exy(0,-Eij(1,0),-Eij(2,0));
2044                    Double_t dzeta=Bxy.Angle(Exy);
2045                    if (-Eij(1,0) < 0) dzeta=2.0*TMath::Pi() - dzeta;
2046                    
2047                    if(debug) cout << "omega = "<<omega*TMath::RadToDeg()<<"\tdzeta = "<<dzeta*TMath::RadToDeg()<<endl;
2048                    
2049                    // Formula from D.F. Smart *, M.A. Shea [2005]; A review of geomagnetic cutoff rigidities for earth-orbiting spacecraft
2050                    if(rig>=0) t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow(1+sqrt(1-sin(omega)*sin(dzeta)*pow(cos(orbitalinfo->lat*TMath::DegToRad()),3)),2));
2051                    else       t_orb->cutoff = 59.3/(pow(orbitalinfo->L,2)*pow(1+sqrt(1-sin(omega)*sin(TMath::Pi()+dzeta)*pow(cos(orbitalinfo->lat*TMath::DegToRad()),3)),2));
2052                    if (debug) cout << "R = " << rig << "\tcutoff = " << t_orb->cutoff << endl;
2053                    
2054                    //
2055                    if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;
2056                    if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;
2057                    if ( t_orb->sunangle != t_orb->sunangle ) t_orb->sunangle = -1000.;
2058                    if ( t_orb->sunmagangle != t_orb->sunmagangle ) t_orb->sunmagangle = -1000.;
2059                    //
2060                    if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);
2061                    //
2062                    TClonesArray &tt3 = *torbExtTrk;
2063                    new(tt3[ttentry]) OrbitalInfoTrkVar(*t_orb);
2064                    ttentry++;
2065                    //
2066                    t_orb->Clear();
2067                    //
2068                  }
2069                  //
2070                }
2071              } // end standard tracking algorithm: extended
2072    
2073          } else {          } else {
2074            if ( debug ) printf(" mmm... mode %u standalone %i ntrk %i \n",orbitalinfo->mode,standalone,tof->ntrk());            if ( debug ) printf(" mmm... mode %u standalone  \n",orbitalinfo->mode);
2075          };          }
2076          //          //
2077        } else {        } else { // HERE IT MISS ALL CODE FOR EXTENDED TRACKING!
2078          if ( !standalone && tof->ntrk() > 0 ){          if ( !standalone ){
2079            //            //
2080              if ( verbose ) printf(" no orb info for tracks \n");
2081            Int_t nn = 0;            Int_t nn = 0;
2082            for(Int_t nt=0; nt < tof->ntrk(); nt++){              for(Int_t nt=0; nt < tof->ntrk(); nt++){  
2083              //              //
# Line 1327  anni '50. Line 2092  anni '50.
2092                //                            //            
2093                t_orb->pitch = -1000.;                t_orb->pitch = -1000.;
2094                //                //
2095                  t_orb->sunangle = -1000.;
2096                  //
2097                  t_orb->sunmagangle = -1000;
2098                  //
2099                t_orb->cutoff = -1000.;                t_orb->cutoff = -1000.;
2100                //                //
2101                new(tor[nn]) OrbitalInfoTrkVar(*t_orb);                new(tor[nn]) OrbitalInfoTrkVar(*t_orb);
# Line 1334  anni '50. Line 2103  anni '50.
2103                //                //
2104                t_orb->Clear();                t_orb->Clear();
2105                //                //
2106              };              }
2107              //              //
2108            };                }
2109          };            //
2110        };            // Code for extended tracking algorithm:
2111              //
2112              if ( hasNucleiTrk ){
2113                Int_t ttentry = 0;
2114                if ( verbose ) printf(" hasNucleiTrk \n");
2115                for(Int_t nt=0; nt < tcNucleiTof->GetEntries() ; nt++){  
2116                  //  
2117                  ToFTrkVar *ptt = (ToFTrkVar*)(tcNucleiTof->At(nt));
2118                  if ( ptt->trkseqno != -1  ){
2119                    //
2120                    t_orb->trkseqno = ptt->trkseqno;
2121                    //
2122                    t_orb->Eij = 0;
2123                    //
2124                    t_orb->Sij = 0;
2125                    //          
2126                    t_orb->pitch = -1000.;
2127                    //
2128                    t_orb->sunangle = -1000.;
2129                    //
2130                    t_orb->sunmagangle = -1000;
2131                    //
2132                    t_orb->cutoff = -1000.;
2133                    //
2134                    TClonesArray &tz1 = *torbNucleiTrk;
2135                    new(tz1[ttentry]) OrbitalInfoTrkVar(*t_orb);
2136                    ttentry++;
2137                    //
2138                    t_orb->Clear();
2139                    //
2140                  }
2141                  //
2142                }
2143              }
2144              if ( hasExtNucleiTrk ){
2145                Int_t ttentry = 0;
2146                if ( verbose ) printf(" hasExtNucleiTrk \n");
2147                for(Int_t nt=0; nt < tcExtNucleiTof->GetEntries() ; nt++){  
2148                  //
2149                  if ( verbose ) printf(" got2\n");
2150                  ToFTrkVar *ptt = (ToFTrkVar*)(tcExtNucleiTof->At(nt));
2151                  if ( ptt->trkseqno != -1  ){
2152                    //
2153                    t_orb->trkseqno = ptt->trkseqno;
2154                    //
2155                    t_orb->Eij = 0;
2156                    //
2157                    t_orb->Sij = 0;
2158                    //          
2159                    t_orb->pitch = -1000.;
2160                    //
2161                    t_orb->sunangle = -1000.;
2162                    //
2163                    t_orb->sunmagangle = -1000;
2164                    //
2165                    t_orb->cutoff = -1000.;
2166                    //
2167                    TClonesArray &tz2 = *torbExtNucleiTrk;
2168                    new(tz2[ttentry]) OrbitalInfoTrkVar(*t_orb);
2169                    ttentry++;
2170                    //
2171                    t_orb->Clear();
2172                    //
2173                  }
2174                  //
2175                }
2176              }
2177              if ( hasExtTrk ){
2178                Int_t ttentry = 0;
2179                if ( verbose ) printf(" hasExtTrk \n");
2180                for(Int_t nt=0; nt < tcExtTof->GetEntries() ; nt++){  
2181                  //
2182                  if ( verbose ) printf(" got3\n");
2183                  ToFTrkVar *ptt = (ToFTrkVar*)(tcExtTof->At(nt));
2184                  if ( ptt->trkseqno != -1  ){
2185                    //
2186                    t_orb->trkseqno = ptt->trkseqno;
2187                    //
2188                    t_orb->Eij = 0;
2189                    //
2190                    t_orb->Sij = 0;
2191                    //          
2192                    t_orb->pitch = -1000.;
2193                    //
2194                    t_orb->sunangle = -1000.;
2195                    //
2196                    t_orb->sunmagangle = -1000;
2197                    //
2198                    t_orb->cutoff = -1000.;
2199                    //
2200                    TClonesArray &tz3 = *torbExtNucleiTrk;
2201                    new(tz3[ttentry]) OrbitalInfoTrkVar(*t_orb);
2202                    ttentry++;
2203                    //
2204                    t_orb->Clear();
2205                    //
2206                  }
2207                  //
2208                }
2209              }
2210            }
2211          } // if( orbitalinfo->TimeGap>0){
2212        //        //
2213        // Fill the class        // Fill the class
2214        //        //
2215        OrbitalInfotr->Fill();        OrbitalInfotr->Fill();
2216        //        //
2217          //      tor.Clear("C"); // memory leak?
2218          tor.Delete(); // memory leak?      
2219        delete t_orb;        delete t_orb;
2220        //        //
2221      }; // loop over the events in the run        //      printf(" q0 size %i q0 capacity %i \n",(int)q0.size(),(int)q0.capacity());
2222        } // loop over the events in the run
2223    
2224    
2225      //      //
2226      // Here you may want to clear some variables before processing another run        // Here you may want to clear some variables before processing another run  
2227      //      //
2228    
2229      //gStyle->SetOptStat(000000);      //    OrbitalInfotr->FlushBaskets();
     //gStyle->SetPalette(1);  
       
     /*TCanvas* c1 = new TCanvas("c1","",1200,800);  
     //c1->Divide(1,4);  
     c1->cd(1);  
     //q0testing->Draw("colz");  
     //c1->cd(2);  
     //q1testing->Draw("colz");  
     //c1->cd(3);  
     Pitchtesting->Draw("colz");  
     //c1->cd(4);  
     //q3testing->Draw("colz");  
     c1->SaveAs("9.Rollhyst.png");  
     delete c1;*/  
2230    
2231      if ( verbose ) printf(" Clear before new run \n");      if ( verbose ) printf(" Clear before new run \n");
2232      delete dbtime;      delete dbtime;
2233    
2234      mcmdrc->Clear();      if ( mcmdrc ) mcmdrc->Clear();
2235      mcmdrc = 0;      mcmdrc = 0;
2236            
2237      if ( verbose ) printf(" Clear before new run1 \n");      if ( verbose ) printf(" Clear before new run1 \n");
# Line 1382  anni '50. Line 2243  anni '50.
2243      if ( verbose ) printf(" Clear before new run4 \n");      if ( verbose ) printf(" Clear before new run4 \n");
2244      if ( RYPang_lower ) delete RYPang_lower;      if ( RYPang_lower ) delete RYPang_lower;
2245    
2246      if ( l0tr ) l0tr->Delete();  
2247            if ( l0tr ){
2248          if ( verbose ) printf(" delete l0tr\n");
2249          l0tr->Delete();
2250          l0tr = 0;
2251        }
2252        //    if ( l0head ){
2253        //      printf(" delete l0head\n");
2254        //  l0head->Reset();
2255        //  delete l0head;
2256        //  printf(" delete l0head done\n");
2257        //  l0head = 0;
2258        // }
2259        if (eh) {
2260          if ( verbose ) printf(" delete eh\n");
2261          delete eh;
2262          eh = 0;
2263        }
2264    
2265        if ( verbose ) printf(" close file \n");
2266        if ( l0File ) l0File->Close("R");
2267      if ( verbose ) printf(" End run \n");      if ( verbose ) printf(" End run \n");
2268    
2269    }; // process all the runs      q0.clear();
2270          q1.clear();
2271        q2.clear();
2272        q3.clear();
2273        qtime.clear();
2274        qPitch.clear();
2275        qRoll.clear();
2276        qYaw.clear();
2277        qmode.clear();
2278    
2279        if (ch){
2280          if ( verbose ) printf(" delete ch\n");
2281          ch->Delete();
2282          ch = 0;
2283        }
2284      } // process all the runs    <===
2285      if ( debug ){
2286        printf("AFTER LOOP ON RUNs\n");
2287        gObjectTable->Print();
2288      }
2289      //  
2290    if (verbose) printf("\n Finished processing data \n");    if (verbose) printf("\n Finished processing data \n");
2291    //    //
2292   closeandexit:   closeandexit:
# Line 1409  anni '50. Line 2308  anni '50.
2308          //          //
2309          // copy orbitalinfoclone to OrbitalInfo          // copy orbitalinfoclone to OrbitalInfo
2310          //          //
2311          orbitalinfo->Clear();          //      orbitalinfo->Clear();
2312          //          //
2313          memcpy(&orbitalinfo,&orbitalinfoclone,sizeof(orbitalinfoclone));          memcpy(&orbitalinfo,&orbitalinfoclone,sizeof(orbitalinfoclone));
2314          //          //
# Line 1425  anni '50. Line 2324  anni '50.
2324    //    //
2325    // Close files, delete old tree(s), write and close level2 file    // Close files, delete old tree(s), write and close level2 file
2326    //    //
2327    
2328    if ( l0File ) l0File->Close();    if ( l0File ) l0File->Close();
2329    if ( myfold ) gSystem->Unlink(tempname.str().c_str());    if ( myfold ) gSystem->Unlink(tempname.str().c_str());
2330    //    //
# Line 1432  anni '50. Line 2332  anni '50.
2332    //    //
2333    if ( file ){    if ( file ){
2334      file->cd();      file->cd();
2335      OrbitalInfotr->Write("OrbitalInfo", TObject::kOverwrite);      if ( OrbitalInfotr ) OrbitalInfotr->Write("OrbitalInfo", TObject::kOverwrite); // 10 RED bug fixed
2336    };    };
2337    //    //
2338    if (verbose) printf("\n Exiting...\n");    if (verbose) printf("\n Exiting...\n");
# Line 1453  anni '50. Line 2353  anni '50.
2353    if ( gltle ) delete gltle;    if ( gltle ) delete gltle;
2354    if ( glparam ) delete glparam;    if ( glparam ) delete glparam;
2355    if ( glparam2 ) delete glparam2;    if ( glparam2 ) delete glparam2;
   if ( glparam3 ) delete glparam3;  
2356    if (verbose) printf("\n Exiting3...\n");    if (verbose) printf("\n Exiting3...\n");
2357    if ( glroot ) delete glroot;    if ( glroot ) delete glroot;
2358    if (verbose) printf("\n Exiting4...\n");    if (verbose) printf("\n Exiting4...\n");
2359    if ( runinfo ) runinfo->Close();        if ( runinfo ) runinfo->Close();    
2360    if ( runinfo ) delete runinfo;    if ( runinfo ) delete runinfo;
2361    
2362      if ( tcNucleiTrk ){
2363        tcNucleiTrk->Delete();
2364        delete tcNucleiTrk;
2365        tcNucleiTrk = NULL;
2366      }
2367      if ( tcExtNucleiTrk ){
2368        tcExtNucleiTrk->Delete();
2369        delete tcExtNucleiTrk;
2370        tcExtNucleiTrk = NULL;
2371      }
2372      if ( tcExtTrk ){
2373        tcExtTrk->Delete();
2374        delete tcExtTrk;
2375        tcExtTrk = NULL;
2376      }
2377    
2378      if ( tcNucleiTof ){
2379        tcNucleiTof->Delete();
2380        delete tcNucleiTof;
2381        tcNucleiTof = NULL;
2382      }
2383      if ( tcExtNucleiTof ){
2384        tcExtNucleiTof->Delete();
2385        delete tcExtNucleiTof;
2386        tcExtNucleiTof = NULL;
2387      }
2388      if ( tcExtTof ){
2389        tcExtTof->Delete();
2390        delete tcExtTof;
2391        tcExtTrk = NULL;
2392      }
2393    
2394    
2395      if ( tof ) delete tof;
2396      if ( trke ) delete trke;
2397    
2398    if ( debug ){      if ( debug ){  
2399    cout << "1   0x" << OrbitalInfotr << endl;    cout << "1   0x" << OrbitalInfotr << endl;
2400    cout << "2   0x" << OrbitalInfotrclone << endl;    cout << "2   0x" << OrbitalInfotrclone << endl;
# Line 1470  anni '50. Line 2405  anni '50.
2405    //    //
2406    if ( debug )  file->ls();    if ( debug )  file->ls();
2407    //    //
2408      if ( debug ){
2409        printf("BEFORE EXITING\n");
2410        gObjectTable->Print();
2411      }
2412    if(code < 0)  throw code;    if(code < 0)  throw code;
2413    return(code);    return(code);
2414  }  }
# Line 1516  UInt_t holeq(Double_t lower,Double_t upp Line 2455  UInt_t holeq(Double_t lower,Double_t upp
2455    Bool_t R10l = false;     // Sign of R10 mode in lower quaternions array    Bool_t R10l = false;     // Sign of R10 mode in lower quaternions array
2456    Bool_t R10u = false;     // Sign of R10 mode in upper quaternions array    Bool_t R10u = false;     // Sign of R10 mode in upper quaternions array
2457    Bool_t insm = false;     // Sign that we inside quaternions array    Bool_t insm = false;     // Sign that we inside quaternions array
2458    Bool_t mxtml = false;    // Sign of mixt mode in lower quaternions array    //  Bool_t mxtml = false;    // Sign of mixt mode in lower quaternions array
2459    Bool_t mxtmu = false;    // Sign of mixt mode in upper quaternions array    //  Bool_t mxtmu = false;    // Sign of mixt mode in upper quaternions array
2460    Bool_t npasm = false;     // Sign of normall pass between R10 and non R10 or between non R10 and R10    Bool_t npasm = false;     // Sign of normall pass between R10 and non R10 or between non R10 and R10
2461    UInt_t NCQl = 6;       // Number of correct quaternions in lower array    UInt_t NCQl = 6;       // Number of correct quaternions in lower array
2462    UInt_t NCQu = 6;       // Number of correct quaternions in upper array    //  UInt_t NCQu = 6;       // Number of correct quaternions in upper array
2463    if (f>0){    if (f>0){
2464      insm = true;      insm = true;
2465      if(Qupper->time[f]-Qupper->time[f-1]==30) R10u = false;      if(Qupper->time[f]-Qupper->time[f-1]==30) R10u = false;
# Line 1532  UInt_t holeq(Double_t lower,Double_t upp Line 2471  UInt_t holeq(Double_t lower,Double_t upp
2471      if((Qlower->time[5]-Qlower->time[0]==150)&&(Qlower->time[1]-Qlower->time[0]==30)) R10l = false;      if((Qlower->time[5]-Qlower->time[0]==150)&&(Qlower->time[1]-Qlower->time[0]==30)) R10l = false;
2472      if((Qupper->time[5]-Qupper->time[0]==150)&&(Qupper->time[1]-Qupper->time[0]==30)) R10u = false;      if((Qupper->time[5]-Qupper->time[0]==150)&&(Qupper->time[1]-Qupper->time[0]==30)) R10u = false;
2473      if((Qlower->time[5]-Qlower->time[0]<2)&&(Qlower->time[1]-Qlower->time[0]==30)){      if((Qlower->time[5]-Qlower->time[0]<2)&&(Qlower->time[1]-Qlower->time[0]==30)){
2474        mxtml = true;        //      mxtml = true;
2475        for(UInt_t i = 1; i < 6; i++){        for(UInt_t i = 1; i < 6; i++){
2476          if(Qlower->time[i]-Qlower->time[0]==30*i) NCQl=i;          if(Qlower->time[i]-Qlower->time[0]==30*i) NCQl=i;
2477        }        }
2478      }      }
2479      if((Qupper->time[5]-Qupper->time[0]<2)&&(Qupper->time[1]-Qupper->time[0]==30)){      //    if((Qupper->time[5]-Qupper->time[0]<2)&&(Qupper->time[1]-Qupper->time[0]==30)){
2480        mxtmu = true;        //      mxtmu = true;
2481        for(UInt_t i = 1; i < 6; i++){        //      for(UInt_t i = 1; i < 6; i++){
2482          if(Qupper->time[i]-Qupper->time[0]==30*i) NCQu=i;        //        if(Qupper->time[i]-Qupper->time[0]==30*i) NCQu=i;
2483        }        //      }
2484      }      //    }
2485    }    }
2486        
2487    if(((upper-lower==1.5)||(upper-lower==3.)||(upper-lower==30.)||(upper-lower==31.5)||(upper-lower==33.)||(upper-lower==181.5)||(upper-lower==210.)||(upper-lower==211.5))&&!insm) npasm = true;    if(((upper-lower==1.5)||(upper-lower==3.)||(upper-lower==30.)||(upper-lower==31.5)||(upper-lower==33.)||(upper-lower==181.5)||(upper-lower==210.)||(upper-lower==211.5))&&!insm) npasm = true;
# Line 1574  void inclresize(vector<Double_t>& t,vect Line 2513  void inclresize(vector<Double_t>& t,vect
2513    Yaw.resize(sizee);    Yaw.resize(sizee);
2514  }  }
2515    
2516  //Find fitting sine functions for q0,q1,q2,q3 and Yaw-angle;  // geomagnetic calculation staff
2517  void sineparam(vector<Sine>& qsine, vector<Double_t>& qtime, vector<Float_t>& q, vector<Float_t>& Roll, vector<Float_t>& Pitch, Float_t limsin){  
2518    UInt_t mulast = 0;  void GM_ScanIGRF(TSQLServer *dbc, GMtype_Data *G0, GMtype_Data *G1, GMtype_Data *H1)
2519    UInt_t munow = 0;  {
2520    UInt_t munext = 0;    GL_PARAM *glp = new GL_PARAM();
2521    Bool_t increase = false;    Int_t parerror=glp->Query_GL_PARAM(1,304,dbc); // parameters stored in DB in GL_PRAM table  
2522    Bool_t decrease = false;    if ( parerror<0 ) {
2523    Bool_t Max_is_defined = false;      throw -902;
2524    Bool_t Start_point_is_defined = false;    }
2525    Bool_t Period_is_defined = false;          /*This function scans inputs G0, G1, and H1 of the IGRF table into 3 data arrays*/
2526    Bool_t Large_gap = false;    //    TString SATH="/data03/Malakhov/pam9Malakhov/installed10/calib/orb-param/";
2527    Bool_t normal_way = true;          int i;
2528    Bool_t small_gap_on_ridge = false;          double temp;
2529    Double_t t1 = 0;          char buffer[200];
2530    Double_t t1A = 0;          FILE *IGRF;
2531    Int_t sinesize = 0;          IGRF = fopen((glp->PATH+glp->NAME).Data(), "r");
2532    Int_t nfi = 0;          //      IGRF = fopen(PATH+"IGRF.tab", "r");
2533    for(UInt_t mu = 0;mu<qtime.size();mu++){          G0->size = 25;
2534      //cout<<"Roll["<<mu<<"] = "<<Roll[mu]<<endl;          G1->size = 25;
2535      if(TMath::Abs(Roll[mu])<1. && TMath::Abs(Pitch[mu])<1. && TMath::Abs(q[mu])<limsin){          H1->size = 25;
2536      //cout<<"q["<<mu<<endl<<"] = "<<q[mu]<<endl;          for( i = 0; i < 4; i++)
2537      if(mulast!=0 && munow!=0 && munext!=0){mulast=munow;munow=munext;munext=mu;}          {
2538      if(munext==0 && munow!=0)munext=mu;                  fgets(buffer, 200, IGRF);
     if(munow==0 && mulast!=0)munow=mu;  
     if(mulast==0)mulast=mu;  
       
     //cout<<"mulast = "<<mulast<<"\tmunow = "<<munow<<"\tmunext = "<<munext<<endl;  
     //Int_t ref;  
     //cin>>ref;  
     if(TMath::Abs(q[munow])>TMath::Abs(q[mulast]) && TMath::Abs(q[munow])>TMath::Abs(q[munext]) && q[mulast]*q[munext]>0 && qtime[munext]-qtime[mulast]>400)small_gap_on_ridge = true;  
     if(munext>mulast && (qtime[munext]-qtime[mulast]>=2000 || qtime[munext]-qtime[mulast]<0)){if(Large_gap){normal_way = false;Large_gap = false;}else{Large_gap = true;normal_way = false;}}else normal_way = true;  
     //if(normal_way)cout<<"Normal_Way"<<endl;  
     if(Large_gap || small_gap_on_ridge){  
       //cout<<"Large gap..."<<endl;  
       //if(small_gap_on_ridge)cout<<"small gap..."<<endl;  
       //cout<<"q["<<mulast<<"] = "<<q[mulast]<<"\tq["<<munow<<"] = "<<q[munow]<<"\tq["<<munext<<"] = "<<q[munext]<<endl;  
       //cout<<"qtime["<<mulast<<"] = "<<qtime[mulast]<<"\tqtime["<<munow<<"] = "<<qtime[munow]<<"\tqtime["<<munext<<"] = "<<qtime[munext]<<endl;  
       increase = false;  
       decrease = false;  
       if(nfi>0){  
         qsine.resize(qsine.size()-1);  
         sinesize = qsine.size();  
         //cout<<"nfi was larger then zero"<<endl;  
       }else{  
         //cout<<"nfi was not larger then zero :( nfi = "<<nfi<<endl;  
         //cout<<"qsine.size = "<<qsine.size()<<endl;  
         if(!Period_is_defined){  
           //cout<<"Period was defined"<<endl;  
           if(qsine.size()>1){  
             qsine[sinesize-1].b = qsine[sinesize-2].b;  
             qsine[sinesize-1].c = qsine[sinesize-2].c;  
           }else{  
             qsine[sinesize-1].b = TMath::Pi()/1591.54;  
             qsine[sinesize-1].c = qsine[sinesize-1].startPoint;  
           }  
         }  
         if(!Max_is_defined){  
           //cout<<"Max was already defined"<<endl;  
           if(qsine.size()>1)qsine[sinesize-1].A = qsine[sinesize-2].A;else qsine[sinesize-1].A = limsin;  
         }  
         qsine[sinesize-1].NeedFit = true;  
       }  
       qsine[sinesize-1].finishPoint = qtime[munow];  
       //cout<<"finish point before large gap = "<<qtime[munow]<<endl;  
       nfi = 0;  
       Max_is_defined = false;  
       Start_point_is_defined = false;  
       Period_is_defined = false;  
       small_gap_on_ridge = false;  
     }  
     //cout<<"Slope "<<increase<<"\t"<<decrease<<endl;  
     //cout<<"mulast = "<<mulast<<"\tmunow = "<<munow<<"\tmunext = "<<munext<<endl;  
     if((munext>munow) && (munow>mulast) && normal_way){  
       if(!increase && !decrease){  
         //cout<<"Normal way have started"<<endl;  
         qsine.resize(qsine.size()+1);  
         sinesize = qsine.size();  
         qsine[sinesize-1].startPoint=qtime[mulast];  
         if(q[munext]>q[munow] && q[munow]>q[mulast]) increase = true;  
         if(q[munext]<q[munow] && q[munow]<q[mulast]) decrease = true;  
       }  
       //if(TMath::Abs(q[munow])>TMath::Abs(q[mulast]) && TMath::Abs(q[munow])>TMath::Abs(q[munext]) && TMath::Abs(q[munow])>limsin && qtime[munow]-qtime[mulast]>=400 || qtime[munext]-qtime[munow]>=400){small_gap_on_ridge = true;mu--;continue;}  
       if(TMath::Abs(q[munow])>TMath::Abs(q[mulast]) && TMath::Abs(q[munow])>TMath::Abs(q[munext]) && TMath::Abs(q[munow])>0.9*limsin && qtime[munow]-qtime[mulast]<400 && qtime[munext]-qtime[munow]<400){  
         //cout<<"Max point is qtime = "<<qtime[munow]<<"\tq = "<<q[munow]<<endl;  
         if(q[munow]>q[mulast]){  
           increase = false;  
           decrease = true;  
         }  
         if(q[munow]<q[mulast]){  
           increase = true;  
           decrease = false;  
2539          }          }
2540          if(Max_is_defined && !Start_point_is_defined){          fscanf(IGRF, "g 1 0 %lf ", &G0->element[0]);
2541            Double_t qPer = qtime[munow]-t1A;          for(i = 1; i <= 22; i++)
2542            if(qPer>1000){          {
2543              //cout<<"qsine["<<sinesize-1<<"] = "<<qPer<<" = "<<qtime[munow]<<" - "<<t1A<<"\tlim = "<<limsin<<endl;                  fscanf(IGRF ,"%lf ", &G0->element[i]);
             qsine[sinesize-1].b=TMath::Pi()/qPer;  
             if(decrease)qsine[sinesize-1].c=-qsine[sinesize-1].b*t1A;  
             if(increase)qsine[sinesize-1].c=-qsine[sinesize-1].b*(t1A-qPer);  
             Period_is_defined = true;  
           }  
2544          }          }
2545          Max_is_defined = true;          fscanf(IGRF ,"%lf\n", &temp);
2546          qsine[sinesize-1].A = TMath::Abs(q[munow]);          G0->element[23] = temp * 5 + G0->element[22];
2547          if(Start_point_is_defined && Period_is_defined){          G0->element[24] = G0->element[23] + 5 * temp;
2548            qsine[sinesize-1].finishPoint = qtime[munow];          fscanf(IGRF, "g 1 1 %lf ", &G1->element[0]);
2549            nfi++;          for(i = 1; i <= 22; i++)
2550            qsine[sinesize-1].NeedFit = false;          {
2551            Max_is_defined = false;                  fscanf( IGRF, "%lf ", &G1->element[i]);
           Start_point_is_defined = false;  
           Period_is_defined = false;  
           qsine.resize(qsine.size()+1);  
           sinesize = qsine.size();  
           qsine[sinesize-1].startPoint = qtime[munow];  
2552          }          }
2553          if(!Start_point_is_defined) t1A=qtime[munow];          fscanf(IGRF, "%lf\n", &temp);
2554        }          G1->element[23] = temp * 5 + G1->element[22];
2555        //if((q[munow]>=0 && q[mulast]<=0) || (q[munow]<=0 && q[mulast]>=0))cout<<"cross zero point diference = "<<qtime[munext] - qtime[mulast]<<"\tqlast = "<<qtime[mulast]<<"\tqnow = "<<qtime[munow]<<"\tqnext = "<<qtime[munext]<<endl;          G1->element[24] = temp * 5 + G1->element[23];
2556        if(((q[munow]>=0 && q[mulast]<=0) || (q[munow]<=0 && q[mulast]>=0)) && qtime[munow]-qtime[mulast]<2000 && qtime[munext]-qtime[munow]<2000){          fscanf(IGRF, "h 1 1 %lf ", &H1->element[0]);
2557          Double_t tcrosszero = 0;          for(i = 1; i <= 22; i++)
2558          //cout<<"cross zero point...qtime = "<<qtime[munow]<<endl;          {
2559          if(q[munow]==0.) tcrosszero = qtime[munow];else                  fscanf( IGRF, "%lf ", &H1->element[i]);
           if(q[mulast]==0.)tcrosszero = qtime[mulast];else{  
             Double_t k_ = (q[munow]-q[mulast])/(qtime[munow]-qtime[mulast]);  
             Double_t b_ = q[munow]-k_*qtime[munow];  
             tcrosszero = -b_/k_;  
           }  
         if(Start_point_is_defined){  
           //cout<<"Start Point allready defined"<<endl;  
           Double_t qPer = tcrosszero - t1;  
           qsine[sinesize-1].b = TMath::Pi()/qPer;  
           //cout<<"qsine["<<sinesize-1<<"].b = "<<TMath::Pi()/qPer<<endl;  
           Period_is_defined = true;  
           Float_t x0 = 0;  
           if(decrease)x0 = t1;  
           if(increase)x0 = tcrosszero;  
           qsine[sinesize-1].c = -qsine[sinesize-1].b*x0;  
           if(Max_is_defined){  
             //cout<<"Max was previous defined"<<endl;  
             qsine[sinesize-1].finishPoint = qtime[munow];  
             nfi++;  
             qsine[sinesize-1].NeedFit = false;  
             Max_is_defined = false;  
             t1 = tcrosszero;  
             Start_point_is_defined = true;  
             Period_is_defined = false;  
             qsine.resize(qsine.size()+1);  
             sinesize = qsine.size();  
             qsine[sinesize-1].startPoint = qtime[munow];  
           }  
         }else{  
           t1 = tcrosszero;  
           Start_point_is_defined = true;  
2560          }          }
2561        }          fscanf(IGRF, "%lf\n", &temp);
2562      }          H1->element[23] = temp * 5 + H1->element[22];
2563      }          H1->element[24] = temp * 5 + H1->element[23];
2564      if ( glp ) delete glp;
2565      /*
2566      printf("############################## SCAN IGRF ######################################\n");
2567      printf("       G0      G1     H1\n");
2568      printf(" size  %10i %10i %10i \n",G0->size,G1->size,H1->size);
2569      for ( i = 0; i < 30; i++){
2570        printf("%5i  %10.2f %10.2f %10.2f \n",i,G0->element[i],G1->element[i],H1->element[i]);
2571      }  
2572      printf("###############################################################################\n");
2573      */
2574    } /*GM_ScanIGRF*/
2575    
2576    
2577    
2578    
2579    void GM_SetIGRF(Int_t isSecular, TString ifile1, TString ifile2, GMtype_Data *G0, GMtype_Data *G1, GMtype_Data *H1)
2580    {
2581      /*This function scans inputs G0, G1, and H1 of the IGRF table into 3 data arrays*/
2582      int i;
2583      double temp,temp2;
2584      int it1,it2;
2585      char buffer[200];
2586      FILE *IGRF;
2587      G0->size = 2;
2588      G1->size = 2;
2589      H1->size = 2;
2590    
2591      for( i = 0; i < 30; i++){
2592        G0->element[i] = 0.;
2593        G1->element[i] = 0.;
2594        H1->element[i] = 0.;
2595    }    }
2596    
2597    //cout<<"FINISH SINE INTERPOLATION FUNCTION..."<<endl<<endl;    IGRF = fopen(ifile1.Data(), "r");
2598  }    for( i = 0; i < 2; i++){
2599        fgets(buffer, 200, IGRF);
2600      }
2601      fscanf(IGRF, "%3i%3i%12lf%11lf",&it1,&it2, &G0->element[0],&temp);
2602      fscanf(IGRF, "%3i%3i%12lf%11lf",&it1,&it2, &G1->element[0],&H1->element[0]);
2603      fclose(IGRF);
2604    
2605      IGRF = fopen(ifile2.Data(), "r");
2606      for( i = 0; i < 2; i++){
2607        fgets(buffer, 200, IGRF);
2608      }
2609      if ( isSecular ){
2610        fscanf(IGRF, "%3i%3i%12lf%11lf",&it1,&it2,&temp,&temp2);
2611        G0->element[1] = temp * 5. + G0->element[0];
2612        fscanf(IGRF, "%3i%3i%12lf%11lf",&it1,&it2,&temp,&temp2);
2613        G1->element[1] = temp * 5. + G1->element[0];
2614        H1->element[1] = temp2 * 5. + H1->element[0];
2615      } else {
2616        fscanf(IGRF, "%3i%3i%12lf%11lf",&it1,&it2, &G0->element[1],&temp);
2617        fscanf(IGRF, "%3i%3i%12lf%11lf",&it1,&it2, &G1->element[1],&H1->element[1]);
2618      }
2619      fclose(IGRF);
2620      /*
2621      printf("############################## SCAN IGRF ######################################\n");
2622      printf("       G0      G1     H1\n");
2623      printf(" size  %10i %10i %10i \n",G0->size,G1->size,H1->size);
2624      for ( i = 0; i < 30; i++){
2625        printf("%5i  %10.2f %10.2f %10.2f \n",i,G0->element[i],G1->element[i],H1->element[i]);
2626      }  
2627      printf("###############################################################################\n");
2628      */
2629    } /*GM_ScanIGRF*/
2630    
2631    void GM_SetEllipsoid(GMtype_Ellipsoid *Ellip)
2632    {
2633            /*This function sets the WGS84 reference ellipsoid to its default values*/
2634            Ellip->a        =                       6378.137; /*semi-major axis of the ellipsoid in */
2635            Ellip->b        =                       6356.7523142;/*semi-minor axis of the ellipsoid in */
2636            Ellip->fla      =                       1/298.257223563;/* flattening */
2637            Ellip->eps      =                       sqrt(1- ( Ellip->b *    Ellip->b) / (Ellip->a * Ellip->a ));  /*first eccentricity */
2638            Ellip->epssq    =                       (Ellip->eps * Ellip->eps);   /*first eccentricity squared */
2639            Ellip->re       =                       6371.2;/* Earth's radius */
2640    } /*GM_SetEllipsoid*/
2641    
2642    
2643    void GM_EarthCartToDipoleCartCD(GMtype_Pole Pole, GMtype_CoordCartesian EarthCoord, GMtype_CoordCartesian *DipoleCoords)
2644    {
2645            /*This function converts from Earth centered cartesian coordinates to dipole centered cartesian coordinates*/
2646            double X, Y, Z, CosPhi, SinPhi, CosLambda, SinLambda;
2647            CosPhi = cos(TMath::DegToRad()*Pole.phi);
2648            SinPhi = sin(TMath::DegToRad()*Pole.phi);
2649            CosLambda = cos(TMath::DegToRad()*Pole.lambda);
2650            SinLambda = sin(TMath::DegToRad()*Pole.lambda);
2651            X = EarthCoord.x;
2652            Y = EarthCoord.y;
2653            Z = EarthCoord.z;
2654            
2655            /*These equations are taken from a document by Wallace H. Campbell*/
2656            DipoleCoords->x = X * CosPhi * CosLambda + Y * CosPhi * SinLambda - Z * SinPhi;
2657            DipoleCoords->y = -X * SinLambda + Y * CosLambda;
2658            DipoleCoords->z = X * SinPhi * CosLambda + Y * SinPhi * SinLambda + Z * CosPhi;
2659    } /*GM_EarthCartToDipoleCartCD*/
2660    
2661    void GM_GeodeticToSpherical(GMtype_Ellipsoid Ellip, GMtype_CoordGeodetic CoordGeodetic, GMtype_CoordSpherical *CoordSpherical)
2662    {
2663            double CosLat, SinLat, rc, xp, zp; /*all local variables */
2664            /*
2665            ** Convert geodetic coordinates, (defined by the WGS-84
2666            ** reference ellipsoid), to Earth Centered Earth Fixed Cartesian
2667            ** coordinates, and then to spherical coordinates.
2668            */
2669    
2670            CosLat = cos(TMath::DegToRad()*CoordGeodetic.phi);
2671            SinLat = sin(TMath::DegToRad()*CoordGeodetic.phi);
2672    
2673            /* compute the local radius of curvature on the WGS-84 reference ellipsoid */
2674    
2675            rc = Ellip.a / sqrt(1.0 - Ellip.epssq * SinLat * SinLat);
2676    
2677            /* compute ECEF Cartesian coordinates of specified point (for longitude=0) */
2678    
2679            xp = (rc + CoordGeodetic.HeightAboveEllipsoid) * CosLat;
2680            zp = (rc*(1.0 - Ellip.epssq) + CoordGeodetic.HeightAboveEllipsoid) * SinLat;
2681    
2682            /* compute spherical radius and angle lambda and phi of specified point */
2683    
2684            CoordSpherical->r = sqrt(xp * xp + zp * zp);
2685            CoordSpherical->phig = TMath::RadToDeg()*asin(zp / CoordSpherical->r);     /* geocentric latitude */
2686            CoordSpherical->lambda = CoordGeodetic.lambda;                   /* longitude */
2687    } /*GM_GeodeticToSpherical*/
2688    
2689    void GM_PoleLocation(GMtype_Model Model, GMtype_Pole *Pole)
2690    {
2691            /*This function finds the location of the north magnetic pole in spherical coordinates.  The equations are
2692            **from Wallace H. Campbell's Introduction to Geomagnetic Fields*/
2693    
2694            Pole->phi = TMath::RadToDeg()*-atan(sqrt(Model.h1 * Model.h1 + Model.g1 * Model.g1)/Model.g0);
2695            Pole->lambda = TMath::RadToDeg()*atan(Model.h1/Model.g1);
2696    } /*GM_PoleLocation*/
2697    
2698    void GM_SphericalToCartesian(GMtype_CoordSpherical CoordSpherical, GMtype_CoordCartesian *CoordCartesian)
2699    {
2700            /*This function converts spherical coordinates into Cartesian coordinates*/
2701            double CosPhi = cos(TMath::DegToRad()*CoordSpherical.phig);
2702            double SinPhi = sin(TMath::DegToRad()*CoordSpherical.phig);
2703            double CosLambda = cos(TMath::DegToRad()*CoordSpherical.lambda);
2704            double SinLambda = sin(TMath::DegToRad()*CoordSpherical.lambda);
2705            
2706            CoordCartesian->x = CoordSpherical.r * CosPhi * CosLambda;
2707            CoordCartesian->y = CoordSpherical.r * CosPhi * SinLambda;
2708            CoordCartesian->z = CoordSpherical.r * SinPhi;
2709    } /*GM_SphericalToCartesian*/
2710    
2711    void GM_TimeAdjustCoefs(Float_t year, Float_t jyear, GMtype_Data g0d, GMtype_Data g1d, GMtype_Data h1d, GMtype_Model *Model)
2712    {
2713            /*This function calls GM_LinearInterpolation for the coefficients to estimate the value of the
2714            **coefficient for the given date*/
2715            int index;
2716            double x;
2717            index = (year - GM_STARTYEAR) / 5;
2718            x = (jyear - GM_STARTYEAR) / 5.;
2719            Model->g0 = GM_LinearInterpolation(index, index+1, g0d.element[index], g0d.element[index+1], x);
2720            Model->g1 = GM_LinearInterpolation(index, index+1, g1d.element[index], g1d.element[index+1], x);
2721            Model->h1 = GM_LinearInterpolation(index, index+1, h1d.element[index], h1d.element[index+1], x);
2722    } /*GM_TimeAdjustCoefs*/
2723    
2724    double GM_LinearInterpolation(double x1, double x2, double y1, double y2, double x)
2725    {
2726            /*This function takes a linear interpolation between two given points for x*/
2727            double weight, y;
2728            weight  = (x - x1) / (x2 - x1);
2729            y = y1 * (1. - weight) + y2 * weight;
2730            //        printf(" x1 %f x2 %f y1 %f y2 %f x %f ==> y %f \n",x1,x2,y1,y2,x,y);
2731            return y;
2732    }/*GM_LinearInterpolation*/
2733    
2734    void GM_CartesianToSpherical(GMtype_CoordCartesian CoordCartesian, GMtype_CoordSpherical *CoordSpherical)
2735    {
2736            /*This function converts a point from Cartesian coordinates into spherical coordinates*/
2737            double X, Y, Z;
2738            
2739            X = CoordCartesian.x;
2740            Y = CoordCartesian.y;
2741            Z = CoordCartesian.z;
2742    
2743            CoordSpherical->r = sqrt(X * X + Y * Y + Z * Z);
2744            CoordSpherical->phig = TMath::RadToDeg()*asin(Z / (CoordSpherical->r));
2745            CoordSpherical->lambda = TMath::RadToDeg()*atan2(Y, X);
2746    } /*GM_CartesianToSpherical*/

Legend:
Removed from v.1.61  
changed lines
  Added in v.1.84

  ViewVC Help
Powered by ViewVC 1.1.23