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

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

Parent Directory | Revision Log | View Patch Patch

-revision 1.30 by mocchiut,
Wed Oct  1 15:25:44 2008 UTC
+revision 1.78 by mocchiut,
Fri Oct 10 13:35:10 2014 UTC
 Line 1
- //
  // C/C++ headers
  //
  #include <fstream>
-Line 9
+Line 8
  //
  // ROOT headers
  //
+ //#include <TCanvas.h>
+ #include <TH2F.h> //for test only. Vitaly.
+ #include <TVector3.h>
+ //#include <TF1.h>
  #include <TTree.h>
  #include <TClassEdit.h>
  #include <TObject.h>
-Line 44
+Line 48
  #include <OrbitalInfoCore.h>
  #include <InclinationInfo.h>
+ //
+ // Tracker and ToF classes headers and definitions
+ //
+ #include <ToFLevel2.h>
+ #include <TrkLevel2.h>
+ #include <ExtTrack.h> // new tracking code
  using namespace std;
  //
-Line 60 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 71 
 int OrbitalInfoCore(UInt_t run, TFile *f
    //
    stringstream myquery;
    myquery.str("");
-   myquery << "SET time_zone='+0:00'";
+   myquery << "SET time_zone='+0:00'; SET sql_mode = 'NO_UNSIGNED_SUBTRACTION';";
-   dbc->Query(myquery.str().c_str());
+   delete dbc->Query(myquery.str().c_str());
    //
    TString processFolder = Form("OrbitalInfoFolder_%u",run);
    //
-Line 71 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 82 
 int OrbitalInfoCore(UInt_t run, TFile *f
    //
    Bool_t verbose = false;
    //
-   Bool_t standalone = true;
+   Bool_t standalone = false;
    //
    if ( OrbitalInfoargc > 0 ){
      i = 0;
-Line 117 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 128 
 int OrbitalInfoCore(UInt_t run, TFile *f
    TTree *OrbitalInfotrclone = 0;
    Bool_t reproc = false;
    Bool_t reprocall = false;
+   Bool_t igrfloaded = false;
    UInt_t nobefrun = 0;
    UInt_t noaftrun = 0;
    UInt_t numbofrun = 0;
-Line 124 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 136 
 int OrbitalInfoCore(UInt_t run, TFile *f
    TString fname;
    UInt_t totfileentries = 0;
    UInt_t idRun = 0;
+   UInt_t anni5 = 60 * 60 * 24 * 365 * 5 ;//1576800
    //
    // My variables. Vitaly.
    //
-   //  UInt_t iev = 0;
+ //  UInt_t oi = 0;
-   //  UInt_t j3 = 0;
-   UInt_t oi = 0;
    Int_t tmpSize = 0;
    //
    // variables needed to handle error signals
-Line 141 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 152 
 int OrbitalInfoCore(UInt_t run, TFile *f
    //
    OrbitalInfo *orbitalinfo = new OrbitalInfo();
    OrbitalInfo *orbitalinfoclone = new OrbitalInfo();
    //
    // define variables for opening and reading level0 file
    //
    TFile *l0File = 0;
    TTree *l0tr = 0;
-   TTree *l0trm = 0;
+   //  TTree *l0trm = 0;
+   TChain *ch = 0;
    // EM: open also header branch
    TBranch *l0head = 0;
    pamela::EventHeader *eh = 0;
-Line 176 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 189 
 int OrbitalInfoCore(UInt_t run, TFile *f
    //
    // IGRF stuff
    //
-   float dimo = 0.0; // dipole moment (computed from dat files)
+   Double_t dimo = 0.0; // dipole moment (computed from dat files) // EM GCC 4.7
-   float bnorth, beast, bdown, babs;
+   Float_t bnorth, beast, bdown, babs;
-   float xl; // L value
+   Float_t xl; // L value
-   float icode; // code value for L accuracy (see fortran code)
+   Float_t icode; // code value for L accuracy (see fortran code)
-   float bab1; // What's  the difference with babs?
+   Float_t bab1; // What's  the difference with babs?
-   float stps = 0.005; // step size for field line tracing
+   Float_t stps = 0.005; // step size for field line tracing
-   float bdel = 0.01; // required accuracy
+   Float_t bdel = 0.01; // required accuracy
-   float bequ;  // equatorial b value (also called b_0)
+   Float_t bequ;  // equatorial b value (also called b_0)
-   bool value = 0; // false if bequ is not the minimum b value
+   Bool_t value = 0; // false if bequ is not the minimum b value
-   float rr0; // equatorial radius normalized to earth radius
+   Float_t rr0; // equatorial radius normalized to earth radius
    //
    // Working filename
-Line 209 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 222 
 int OrbitalInfoCore(UInt_t run, TFile *f
    OrbitalInfofolder << tempname.str().c_str();
    tempname << "/OrbitalInfotree_run";
    tempname << run << ".root";
+   UInt_t totnorun = 0;
    //
    // DB classes
    //
-Line 218 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 232 
 int OrbitalInfoCore(UInt_t run, TFile *f
    //
    //Quaternions classes
    //
-   Quaternions *L_QQ_Q_l_lower = new Quaternions();
+   Quaternions *L_QQ_Q_l_lower = 0;
-   InclinationInfo *RYPang_lower = new InclinationInfo();
+   InclinationInfo *RYPang_lower = 0;
-   Quaternions *L_QQ_Q_l_upper = new Quaternions();
+   Quaternions *L_QQ_Q_l_upper = 0;
-   InclinationInfo *RYPang_upper = new InclinationInfo();
+   InclinationInfo *RYPang_upper = 0;
    cEci eCi;
    // Initialize fortran routines!!!
+   Int_t ltp1 = 0;
    Int_t ltp2 = 0;
    Int_t ltp3 = 0;
-   Int_t uno = 1;
+   //  Int_t uno = 1;
-   char *niente = " ";
+   //  const char *niente = " ";
+   GL_PARAM *glparam0 = new GL_PARAM();
    GL_PARAM *glparam = new GL_PARAM();
    GL_PARAM *glparam2 = new GL_PARAM();
-   Int_t parerror=glparam->Query_GL_PARAM(1,301,dbc); // parameters stored in DB in GL_PRAM table
+   GL_PARAM *glparam3 = new GL_PARAM();
    //
-   // Orientation variables
+   // Orientation variables. Vitaly
    //
    UInt_t evfrom = 0;
    UInt_t jumped = 0;
    Int_t itr = -1;
-   Double_t A1;
+   //  Double_t A1;
-   Double_t A2;
+   //  Double_t A2;
-   Double_t A3;
+   //  Double_t A3;
    Double_t Px = 0;
    Double_t Py = 0;
    Double_t Pz = 0;
    TTree *ttof = 0;
    ToFLevel2 *tof = new ToFLevel2();
+   TTree *ttrke = 0;
+   TrkLevel2 *trke = new TrkLevel2();
    OrientationInfo *PO = new OrientationInfo();
    Int_t nz = 6;
    Float_t zin[6];
    Int_t nevtofl2 = 0;
-   //
+   Int_t nevtrkl2 = 0;
+   if ( verbose ) cout<<"Reading quaternions external file"<<endl;
+   cout.setf(ios::fixed,ios::floatfield);
+   /******Reading recovered quaternions...*********/
+   vector<Double_t> recqtime;
+   vector<Float_t> recq0;
+   vector<Float_t> recq1;
+   vector<Float_t> recq2;
+   vector<Float_t> recq3;
+   Float_t Norm = 1;
+   vector<UInt_t> RTtime1;
+   vector<UInt_t> RTtime2;
+   vector<Double_t> RTbank1;
+   vector<Double_t> RTbank2;
+   vector<Double_t> RTbpluto1;
+   vector<Double_t> RTbpluto2;
+   vector<Int_t> RTazim;
+   vector<UInt_t> RTstart;
+   vector<UInt_t> RTpluto2;
+   vector<UInt_t> RTpluto1;
+   vector<Int_t> RTerrq;
+   TClonesArray *tcNucleiTrk = NULL;
+   TClonesArray *tcExtNucleiTrk = NULL;
+   TClonesArray *tcExtTrk = NULL;
+   TClonesArray *tcNucleiTof = NULL;
+   TClonesArray *tcExtNucleiTof = NULL;
+   TClonesArray *tcExtTof = NULL;
+   TClonesArray *torbNucleiTrk = NULL;
+   TClonesArray *torbExtNucleiTrk = NULL;
+   TClonesArray *torbExtTrk = NULL;
+   Bool_t hasNucleiTrk = false;
+   Bool_t hasExtNucleiTrk = false;
+   Bool_t hasExtTrk = false;
+   Bool_t hasNucleiTof = false;
+   Bool_t hasExtNucleiTof = false;
+   Bool_t hasExtTof = false;
+   ifstream in;
+   ifstream an;
+   //  ofstream mc;
+   //  TString gr;
+   Int_t parerror2=0;
+   Int_t parerror=glparam0->Query_GL_PARAM(1,303,dbc); // parameters stored in DB in GL_PRAM table
+   if ( verbose ) cout<<parerror<<"\t"<<(char*)(glparam0->PATH+glparam0->NAME).Data()<<endl;
    if ( parerror<0 ) {
      code = parerror;
      goto closeandexit;
-   };
+   }
-   ltp2 = (Int_t)(glparam->PATH+glparam->NAME).Length();
+   in.open((char*)(glparam0->PATH+glparam0->NAME).Data(),ios::in);
-   if ( verbose ) printf(" Reading Earth's Magnetic Field parameter file: %s \n",(glparam->PATH+glparam->NAME).Data());
+   while(!in.eof()){
-   //
+     recqtime.resize(recqtime.size()+1);
-   parerror=glparam2->Query_GL_PARAM(1,302,dbc); // parameters stored in DB in GL_PRAM table
+     Int_t sizee = recqtime.size();
-   if ( parerror<0 ) {
+     recq0.resize(sizee);
+     recq1.resize(sizee);
+     recq2.resize(sizee);
+     recq3.resize(sizee);
+     in>>recqtime[sizee-1];
+     in>>recq0[sizee-1];
+     in>>recq1[sizee-1];
+     in>>recq2[sizee-1];
+     in>>recq3[sizee-1];
+     in>>Norm;
+   }
+   in.close();
+   if ( verbose ) cout<<"We have read recovered data"<<endl;
+   if (debug) cout << "size of recovered quaterions data set is " << recqtime.size() << endl;
+   if ( verbose ) cout<<"read Rotation Table"<<endl;
+   parerror2=glparam0->Query_GL_PARAM(1,305,dbc);
+   if ( verbose ) cout<<parerror2<<"\t"<<(char*)(glparam0->PATH+glparam0->NAME).Data()<<endl;
+   if ( parerror2<0 ) {
      code = parerror;
      goto closeandexit;
-   };
+   }
-   ltp3 = (Int_t)(glparam2->PATH+glparam2->NAME).Length();
+   an.open((char*)(glparam0->PATH+glparam0->NAME).Data(),ios::in);
-   if ( verbose ) printf(" Reading Earth's Magnetic Field parameter file: %s \n",(glparam2->PATH+glparam2->NAME).Data());
+   while(!an.eof()){
-   //
+     RTtime1.resize(RTtime1.size()+1);
-   initize_((char *)niente,&uno,(char *)(glparam->PATH+glparam->NAME).Data(),&ltp2,(char *)(glparam2->PATH+glparam2->NAME).Data(),&ltp3);
+     Int_t sizee = RTtime1.size();
-   //
+     RTbank1.resize(sizee+1);
-   // End IGRF stuff//
+     RTazim.resize(sizee+1);
-   //
+     RTerrq.resize(sizee+1);
+     RTstart.resize(sizee+1);
+     RTpluto1.resize(sizee+1);
+     RTbpluto1.resize(sizee+1);
+     an>>RTtime1[sizee-1];
+     an>>RTbank1[sizee-1];
+     an>>RTstart[sizee-1];
+     an>>RTpluto1[sizee-1];
+     an>>RTbpluto1[sizee-1];
+     an>>RTazim[sizee-1];
+     an>>RTerrq[sizee-1];
+     if(sizee>1) {
+       RTtime2.resize(sizee+1);
+       RTbank2.resize(sizee+1);
+       RTpluto2.resize(sizee+1);
+       RTbpluto2.resize(sizee+1);
+       RTtime2[sizee-2]=RTtime1[sizee-1];
+       RTpluto2[sizee-2]=RTpluto1[sizee-1];
+       RTbank2[sizee-2]=RTbank1[sizee-1];
+       RTbpluto2[sizee-2]=RTbpluto1[sizee-1];
+     }
+   }
+   an.close();
+   //cout<<"put some number here"<<endl;
+   //Int_t yupi;
+   //cin>>yupi;
+   if ( verbose ) cout<<"We have read Rotation Table"<<endl;
+     //Geomagnetic coordinates calculations staff
+   GMtype_CoordGeodetic location;
+   //  GMtype_CoordDipole GMlocation;
+   GMtype_Ellipsoid Ellip;
+   GMtype_Data G0, G1, H1;
+   //  { // 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
+   //    TString igpath="/data03/Malakhov/pam9Malakhov/installed10/calib/orb-param/";
+   //  }
+   //  GM_ScanIGRF(glparam->PATH, &G0, &G1, &H1);
+   GM_ScanIGRF(dbc, &G0, &G1, &H1);
+   //cout << G0.element[0] << "\t" << G1.element[0] << "\t" << H1.element[0] << endl;
+   //cout << G0.element[5] << "\t" << G1.element[5] << "\t" << H1.element[5] << endl;
+   GM_SetEllipsoid(&Ellip);
+   // IGRF stuff moved inside run loop!
    for (Int_t ip=0;ip<nz;ip++){
      zin[ip] = tof->GetZTOF(tof->GetToFPlaneID(ip));
    };
    //
    if ( !standalone ){
      //
-     // Does it contain the Tracker tree?
+     // Does it contain the Tracker and ToF trees?
      //
      ttof = (TTree*)file->Get("ToF");
      if ( !ttof ) {
        if ( verbose ) printf(" OrbitalInfo - ERROR: no tof tree\n");
        code = -900;
        goto closeandexit;
-     };
+     }
      ttof->SetBranchAddress("ToFLevel2",&tof);
      nevtofl2 = ttof->GetEntries();
-   };
+     //
+     // Look for extended tracking algorithm
+     //
+     if ( verbose ) printf("Look for extended and nuclei tracking algorithms in ToF\n");
+     // Nuclei tracking algorithm
+     Int_t checkAlgo = 0;
+     tcNucleiTof =  new TClonesArray("ToFTrkVar");
+     checkAlgo = ttof->SetBranchAddress("TrackNuclei",&tcNucleiTof);
+     if ( !checkAlgo ){
+       if ( verbose ) printf(" Nuclei tracking algorithm ToF branch found! :D \n");
+       hasNucleiTof = true;
+     } else {
+       if ( verbose ) printf(" Nuclei tracking algorithm ToF branch not found :( !\n");
+       printf(" ok, this is not a problem (it depends on tracker settings) \n");
+       delete tcNucleiTof;
+       tcNucleiTof=NULL; // 10RED reprocessing bug
+     }
+     // Nuclei tracking algorithm using calorimeter points
+     tcExtNucleiTof =  new TClonesArray("ToFTrkVar");
+     checkAlgo = ttof->SetBranchAddress("RecoveredTrackNuclei",&tcExtNucleiTof);
+     if ( !checkAlgo ){
+       if ( verbose ) printf(" Recovered nuclei tracking algorithm ToF branch found! :D \n");
+       hasExtNucleiTof = true;
+     } else {
+       if ( verbose ) printf(" Recovered nuclei tracking algorithm ToF branch not found :( !\n");
+       printf(" ok, this is not a problem (it depends on tracker settings) \n");
+       delete tcExtNucleiTof;
+       tcExtNucleiTof=NULL; // 10RED reprocessing bug
+     }
+     // Tracking algorithm using calorimeter points
+     tcExtTof =  new TClonesArray("ToFTrkVar");
+     checkAlgo = ttof->SetBranchAddress("RecoveredTrack",&tcExtTof);
+     if ( !checkAlgo ){
+       if ( verbose ) printf(" Recovered track algorithm ToF branch found! :D \n");
+       hasExtTof = true;
+     } else {
+       if ( verbose ) printf(" Recovered track algorithm ToF branch not found :( !\n");
+       printf(" ok, this is not a problem (it depends on tracker settings) \n");
+       delete tcExtTof;
+       tcExtTof=NULL; // 10RED reprocessing bug
+     }
+     ttrke = (TTree*)file->Get("Tracker");
+     if ( !ttrke ) {
+       if ( verbose ) printf(" OrbitalInfo - ERROR: no trk tree\n");
+       code = -903;
+       goto closeandexit;
+     }
+     ttrke->SetBranchAddress("TrkLevel2",&trke);
+     nevtrkl2 = ttrke->GetEntries();
+     //
+     // Look for extended tracking algorithm
+     //
+     if ( verbose ) printf("Look for extended and nuclei tracking algorithms\n");
+     // Nuclei tracking algorithm
+     checkAlgo = 0;
+     tcNucleiTrk =  new TClonesArray("TrkTrack");
+     checkAlgo = ttrke->SetBranchAddress("TrackNuclei",&tcNucleiTrk);
+     if ( !checkAlgo ){
+       if ( verbose ) printf(" Nuclei tracking algorithm branch found! :D \n");
+       hasNucleiTrk = true;
+     } else {
+       if ( verbose ) printf(" Nuclei tracking algorithm branch not found :( !\n");
+       printf(" ok, this is not a problem (it depends on tracker settings) \n");
+       delete tcNucleiTrk;
+       tcNucleiTrk=NULL; // 10RED reprocessing bug
+     }
+     // Nuclei tracking algorithm using calorimeter points
+     tcExtNucleiTrk =  new TClonesArray("ExtTrack");
+     checkAlgo = ttrke->SetBranchAddress("RecoveredTrackNuclei",&tcExtNucleiTrk);
+     if ( !checkAlgo ){
+       if ( verbose ) printf(" Recovered nuclei tracking algorithm branch found! :D \n");
+       hasExtNucleiTrk = true;
+     } else {
+       if ( verbose ) printf(" Recovered nuclei tracking algorithm branch not found :( !\n");
+       printf(" ok, this is not a problem (it depends on tracker settings) \n");
+       delete tcExtNucleiTrk;
+       tcExtNucleiTrk=NULL; // 10RED reprocessing bug
+     }
+     // Tracking algorithm using calorimeter points
+     tcExtTrk =  new TClonesArray("ExtTrack");
+     checkAlgo = ttrke->SetBranchAddress("RecoveredTrack",&tcExtTrk);
+     if ( !checkAlgo ){
+       if ( verbose ) printf(" Recovered track algorithm branch found! :D \n");
+       hasExtTrk = true;
+     } else {
+       if ( verbose ) printf(" Recovered track algorithm branch not found :( !\n");
+       printf(" ok, this is not a problem (it depends on tracker settings) \n");
+       delete tcExtTrk;
+       tcExtTrk=NULL; // 10RED reprocessing bug
+     }
+     if ( (hasNucleiTrk && !hasNucleiTof) || (!hasNucleiTrk && hasNucleiTof) ||
+          (hasExtNucleiTrk && !hasExtNucleiTof) || (!hasExtNucleiTrk && hasExtNucleiTof) ||
+          (hasExtTrk && !hasExtTof) || (!hasExtTrk && hasExtTof)
+          ){
+       if ( verbose ) printf(" ERROR: Mismatch between tracker and tof tree branches concerning extended tracking algorithm(s)\n");
+       if ( debug ) printf("hasNucleiTrk %i hasExtNucleiTrk %i hasExtTrk %i \n",hasNucleiTrk,hasExtNucleiTrk,hasExtTrk);
+       if ( debug ) printf("hasNucleiTof %i hasExtNucleiTof %i hasExtTof %i \n",hasNucleiTof,hasExtNucleiTof,hasExtTof);
+       throw -901;
+     }
+   }
    //
    // Let's start!
    //
-Line 342 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 580 
 int OrbitalInfoCore(UInt_t run, TFile *f
    // number of run to be processed
    //
    numbofrun = runinfo->GetNoRun();
-   UInt_t totnorun = runinfo->GetRunEntries();
+   totnorun = runinfo->GetRunEntries();
    //
    // Try to access the OrbitalInfo tree in the file, if it exists we are reprocessing data if not we are processing a new run
    //
-Line 376 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 614 
 int OrbitalInfoCore(UInt_t run, TFile *f
        //
        reprocall = true;
        //
-       if (verbose) printf("\n OrbitalInfo - WARNING: Reprocessing all runs\n");
+       if (verbose) printf("\n OrbitalInfo - WARNING: Reprocessing all runs\n Deleting old tree...\n");
        //
      } else {
        //
-Line 394 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 632 
 int OrbitalInfoCore(UInt_t run, TFile *f
        tempOrbitalInfo = OrbitalInfotrclone->CloneTree(-1,"fast");
        tempOrbitalInfo->SetName("OrbitalInfo-old");
        tempfile->Write();
+       tempOrbitalInfo->Delete();
        tempfile->Close();
      }
      //
      // Delete the old tree from old file and memory
      //
+     OrbitalInfotrclone->Clear();
      OrbitalInfotrclone->Delete("all");
      //
      if (verbose) printf(" ...done!\n");
-Line 413 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 653 
 int OrbitalInfoCore(UInt_t run, TFile *f
    orbitalinfo->Set();//ELENA **TEMPORANEO?**
    OrbitalInfotr->Branch("OrbitalInfo","OrbitalInfo",&orbitalinfo);
    //
+   // create new branches for new tracking algorithms
+   //
+   if ( hasNucleiTrk ){
+     torbNucleiTrk = new TClonesArray("OrbitalInfoTrkVar",1);
+     OrbitalInfotr->Branch("TrackNuclei",&torbNucleiTrk);
+   }
+   if ( hasExtNucleiTrk ){
+     torbExtNucleiTrk = new TClonesArray("OrbitalInfoTrkVar",1);
+     OrbitalInfotr->Branch("RecoveredTrackNuclei",&torbExtNucleiTrk);
+   }
+   if ( hasExtTrk ){
+     torbExtTrk = new TClonesArray("OrbitalInfoTrkVar",1);
+     OrbitalInfotr->Branch("RecoveredTrack",&torbExtTrk);
+   }
+   //
    if ( reproc && !reprocall ){
      //
      //  open new file and retrieve also tree informations
-Line 430 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 686 
 int OrbitalInfoCore(UInt_t run, TFile *f
        }
        for (UInt_t j = 0; j < nobefrun; j++){
          //
-         OrbitalInfotrclone->GetEntry(j);
+         if ( OrbitalInfotrclone->GetEntry(j) <= 0 ) throw -36;
          //
          // copy orbitalinfoclone to mydec
          //
-         orbitalinfo->Clear();
+         //      orbitalinfo->Clear();
          //
          memcpy(&orbitalinfo,&orbitalinfoclone,sizeof(orbitalinfoclone));
          //
-Line 444 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 700 
 int OrbitalInfoCore(UInt_t run, TFile *f
          //
        };
        if (verbose) printf(" Finished successful copying!\n");
      };
    };
    //
+   //
    // Get the list of run to be processed, if only one run has to be processed the list will contain one entry only.
    //
    runlist = runinfo->GetRunList();
-Line 454 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 711 
 int OrbitalInfoCore(UInt_t run, TFile *f
    // Loop over the run to be processed
    //
    for (UInt_t irun=0; irun < numbofrun; irun++){
+     L_QQ_Q_l_lower = new Quaternions();
+     RYPang_lower = new InclinationInfo();
+     L_QQ_Q_l_upper = new Quaternions();
+     RYPang_upper = new InclinationInfo();
      //
      // retrieve the first run ID to be processed using the RunInfo list
      //
-Line 502 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 765 
 int OrbitalInfoCore(UInt_t run, TFile *f
      fname = ftmpname.str().c_str();
      ftmpname.str("");
      //
-     // print out informations
+     // print nout informations
      //
      totevent = runinfo->NEVENTS;
      evfrom = runinfo->EV_FROM;
-Line 516 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 779 
 int OrbitalInfoCore(UInt_t run, TFile *f
      //
      //    if ( !totevent ) goto closeandexit;
      // Open Level0 file
+     if ( l0File ) l0File->Close();
      l0File = new TFile(fname.Data());
      if ( !l0File ) {
        if ( debug ) printf(" OrbitalInfo - ERROR: problems opening Level0 file\n");
-Line 554 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 818 
 int OrbitalInfoCore(UInt_t run, TFile *f
        code = -12;
        goto closeandexit;
      };
      //
- //     TTree *tp = (TTree*)l0File->Get("RunHeader");
+     // open IGRF files and do it only once if we are processing a full level2 file
- //     tp->SetBranchAddress("Header", &eH);
+     //
- //     tp->SetBranchAddress("RunHeader", &reh);
+     if ( !igrfloaded ){
- //     tp->GetEntry(0);
- //     ph = eH->GetPscuHeader();
+       if ( l0head->GetEntry(runinfo->EV_FROM) > 0 ){
- //     ULong_t TimeSync = reh->LAST_TIME_SYNC_INFO;
+         igrfloaded = true;
- //     ULong_t ObtSync = reh->OBT_TIME_SYNC;
+         //
- //     if ( debug ) printf(" 1 TimeSync %lu ObtSync %lu DeltaOBT %lu\n",TimeSync,ObtSync,TimeSync-ObtSync);
+         // 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);
+         //
+         if (debug) cout<<"initize: "<<(char *)(glparam->PATH+glparam->NAME).Data()<<"\t"<<(char *)(glparam2->PATH+glparam2->NAME).Data()<<"\t"<<(char *)(glparam3->PATH+glparam3->NAME).Data()<<endl;
+       }
+     }
+     //
+     // End IGRF stuff//
+     //
      ULong_t TimeSync = (ULong_t)dbtime->GetTimesync();
      ULong_t ObtSync = (ULong_t)(dbtime->GetObt0()/1000);
      ULong_t DeltaOBT = TimeSync - ObtSync;
      if ( debug ) printf(" 2 TimeSync %lu ObtSync %lu DeltaOBT %lu\n",(ULong_t)(dbtime->GetTimesync()/1000),(ULong_t)dbtime->GetObt0(),TimeSync-ObtSync);
-     l0trm = (TTree*)l0File->Get("Mcmd");
-     neventsm = l0trm->GetEntries();
-     //    neventsm = 0;
      //
-     if (neventsm == 0){
+     // Read MCMDs from up to 11 files, 5 before and 5 after the present one in order to have some kind of inclination information
-       if ( debug ) printf("InclinationInfo - WARNING: No quaternions in this File");
-       //      l0File->Close();
-       code = 900;
-       //      goto closeandexit;
-     }
      //
+     ch = new TChain("Mcmd","Mcmd");
-     l0trm->SetBranchAddress("Mcmd", &mcmdev);
-     //    l0trm->SetBranchAddress("Header", &eh);
      //
+     // look in the DB to find the closest files to this run
      //
+     TSQLResult *pResult = 0;
+     TSQLRow *Row = 0;
+     stringstream myquery;
+     UInt_t l0fid[10];
+     Int_t i = 0;
+     memset(l0fid,0,10*sizeof(Int_t));
      //
-     UInt_t mctren = 0;
+     myquery.str("");
-     UInt_t mcreen = 0;
+     myquery << "select ID_ROOT_L0 from GL_RUN where RUNHEADER_TIME<=" << runinfo->RUNHEADER_TIME << " group by ID_ROOT_L0 order by RUNHEADER_TIME desc limit 5;";
-     UInt_t numrec = 0;
      //
-     Double_t upperqtime = 0;
+     pResult = dbc->Query(myquery.str().c_str());
-     Double_t lowerqtime = 0;
+     //
+     i = 9;
-     Double_t incli = 0;
+     if( pResult ){
-     oi = 0;
+       //
-     UInt_t ooi = 0;
+       Row = pResult->Next();
+       //
+       while ( Row ){
+         //
+         // store infos and exit
+         //
+         l0fid[i] = (UInt_t)atoll(Row->GetField(0));
+         i--;
+         Row = pResult->Next();
+         //
+       };
+       pResult->Delete();
+     };
+     //
+     myquery.str("");
+     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;";
+     //
+     pResult = dbc->Query(myquery.str().c_str());
+     //
+     i = 0;
+     if( pResult ){
+       //
+       Row = pResult->Next();
+       //
+       while ( Row ){
+         //
+         // store infos and exit
+         //
+         l0fid[i] = (UInt_t)atoll(Row->GetField(0));
+         i++;
+         Row = pResult->Next();
+         //
+       };
+       pResult->Delete();
+     };
+     //
+     i = 0;
+     UInt_t previd = 0;
+     while ( i < 10 ){
+       if ( l0fid[i] && previd != l0fid[i] ){
+         previd = l0fid[i];
+         myquery.str("");
+         myquery << "select PATH,NAME from GL_ROOT where ID=" << l0fid[i] << " ;";
+         //
+         pResult = dbc->Query(myquery.str().c_str());
+         //
+         if( pResult ){
+           //
+           Row = pResult->Next();
+           //
+           if ( debug ) printf(" Using inclination informations from file: %s \n",(((TString)gSystem->ExpandPathName(Row->GetField(0)))+"/"+(TString)Row->GetField(1)).Data());
+           ch->Add(((TString)gSystem->ExpandPathName(Row->GetField(0)))+"/"+(TString)Row->GetField(1));
+           //
+           pResult->Delete();
+         };
+       };
+       i++;
+     };
+     //
+     ch->SetBranchAddress("Mcmd",&mcmdev);
+     neventsm = ch->GetEntries();
+     if ( debug ) printf(" entries %u \n", neventsm);
+     //
+     if (neventsm == 0){
+       if ( debug ) printf("InclinationInfo - WARNING: No quaternions in this File");
+       code = 900;
+     }
+     //
+     Double_t lowerqtime = 0;
      //
-     // init quaternions sync
+     // init quaternions information from mcmd-packets
      //
      Bool_t isf = true;
-     Int_t fgh = 0;
+     vector<Float_t> q0;
+     vector<Float_t> q1;
+     vector<Float_t> q2;
+     vector<Float_t> q3;
+     vector<Double_t> qtime;
+     vector<Float_t> qPitch;
+     vector<Float_t> qRoll;
+     vector<Float_t> qYaw;
+     vector<Int_t> qmode;
+     Int_t nt = 0;
+     UInt_t must = 0;
      //
      // run over all the events of the run
      //
      if (verbose) printf("\n Ready to start! \n\n Processed events: \n\n");
      //
-      //
+     //
      for ( re = runinfo->EV_FROM; re < (runinfo->EV_FROM+runinfo->NEVENTS); re++){
        //
        if ( procev%1000 == 0 && procev > 0 && verbose ) printf(" %iK \n",procev/1000);
        if ( debug ) printf(" %i \n",procev);
        //
-       l0head->GetEntry(re);
+       if ( l0head->GetEntry(re) <= 0 ) throw -36;
        //
        // absolute time of this event
        //
        ph = eh->GetPscuHeader();
        atime = dbtime->DBabsTime(ph->GetOrbitalTime());
+       if ( debug ) printf(" %i absolute time \n",procev);
        //
        // paranoid check
        //
-       if ( (atime > runinfo->RUNTRAILER_TIME) || (atime < runinfo->RUNHEADER_TIME)  ) {
+       if ( (atime > (runinfo->RUNTRAILER_TIME+1)) || (atime < (runinfo->RUNHEADER_TIME-1))  ) {
          if (verbose) printf(" OrbitalInfo - WARNING: event at time outside the run time window, skipping it\n");
          jumped++;
- //      debug = true;
+         //      debug = true;
          continue;
        }
-Line 645 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 1022 
 int OrbitalInfoCore(UInt_t run, TFile *f
            if ( verbose ) printf(" OrbitalInfo - ERROR: no tof events with entry = %i in Level2 file\n",itr);
            if ( debug ) printf(" nobefrun %u re %u evfrom %u jumped %u reprocall %i \n",nobefrun,re,evfrom,jumped,reprocall);
            l0File->Close();
-           code = -901;
+           code = -904;
            goto closeandexit;
          };
          //
          tof->Clear();
          //
-         ttof->GetEntry(itr);
+         // Clones array must be cleared before going on
+         //
+         if ( hasNucleiTof ){
+           tcNucleiTof->Delete();
+         }
+         if ( hasExtNucleiTof ){
+           tcExtNucleiTof->Delete();
+         }
+         if ( hasExtTof ){
+           tcExtTof->Delete();
+         }
+         //
+         if ( verbose ) printf(" get tof tree entries... entry = %i in Level2 file\n",itr);
+         if ( ttof->GetEntry(itr) <= 0 ){
+           if ( verbose ) printf(" problems with tof tree entries... entry = %i in Level2 file\n",itr);
+           if ( verbose ) printf(" nobefrun %u re %u evfrom %u jumped %u reprocall %i \n",nobefrun,re,evfrom,jumped,reprocall);
+           throw -36;
+         }
+         if ( verbose ) printf(" gat0\n");
          //
-       };
+       }
+       //
+       // retrieve tracker informations
+       //
+       if ( !standalone ){
+         if ( itr > nevtrkl2 ){
+           if ( verbose ) printf(" OrbitalInfo - ERROR: no trk events with entry = %i in Level2 file\n",itr);
+           if ( debug ) printf(" nobefrun %u re %u evfrom %u jumped %u reprocall %i \n",nobefrun,re,evfrom,jumped,reprocall);
+           l0File->Close();
+           code = -905;
+           goto closeandexit;
+         }
+         //
+         if ( verbose ) printf(" gat1\n");
+         trke->Clear();
+         //
+         // Clones array must be cleared before going on
+         //
+         if ( hasNucleiTrk ){
+           if ( verbose ) printf(" gat2\n");
+           tcNucleiTrk->Delete();
+           if ( verbose ) printf(" gat3\n");
+           torbNucleiTrk->Delete();
+         }
+         if ( hasExtNucleiTrk ){
+           if ( verbose ) printf(" gat4\n");
+           tcExtNucleiTrk->Delete();
+           if ( verbose ) printf(" gat5\n");
+           torbExtNucleiTrk->Delete();
+         }
+         if ( hasExtTrk ){
+           if ( verbose ) printf(" gat6\n");
+           tcExtTrk->Delete();
+           if ( verbose ) printf(" gat7\n");
+           torbExtTrk->Delete();
+         }
+         //
+         if ( verbose ) printf(" get trk tree entries... entry = %i in Level2 file\n",itr);
+         if ( ttrke->GetEntry(itr) <= 0 ) throw -36;
+         //
+       }
        //
        procev++;
        //
        // start processing
        //
+       if ( debug ) printf(" %i start processing \n",procev);
        orbitalinfo->Clear();
        //
        OrbitalInfoTrkVar *t_orb = new OrbitalInfoTrkVar();
        if( !(orbitalinfo->OrbitalInfoTrk) ) orbitalinfo->OrbitalInfoTrk = new TClonesArray("OrbitalInfoTrkVar",2);
        TClonesArray &tor = *orbitalinfo->OrbitalInfoTrk;
+       // Geomagnetic coordinates calculation variables
+       GMtype_CoordSpherical CoordSpherical, DipoleSpherical;
+       GMtype_CoordCartesian CoordCartesian, DipoleCartesian;
+       GMtype_Model Model;
+       GMtype_Pole Pole;
        //
        // Fill OBT, pkt_num and absTime
        //
        orbitalinfo->pkt_num = ph->GetCounter();
        orbitalinfo->OBT = ph->GetOrbitalTime();
        orbitalinfo->absTime = atime;
+       if ( debug ) printf(" %i pktnum obt abstime \n",procev);
        //
        // Propagate the orbit from the tle time to atime, using SGP(D)4.
        //
+       if ( debug ) printf(" %i sgp4 \n",procev);
        cCoordGeo coo;
-       float jyear=0;
+       Float_t jyear=0.;
        //
        if(atime >= gltle->GetToTime()) {
          if ( !gltle->Query(atime, dbc) ){
            //
            // Compute the magnetic dipole moment.
            //
+           if ( debug ) printf(" %i compute magnetic dipole moment \n",procev);
            UInt_t year, month, day, hour, min, sec;
            //
            TTimeStamp t = TTimeStamp(atime, kTRUE);
-Line 688 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 1135 
 int OrbitalInfoCore(UInt_t run, TFile *f
            t.GetTime(kTRUE, 0, &hour, &min, &sec);
            jyear = (float) year
              + (month*31.+ (float) day)/365.
-             + (hour*3600.+min*60.+(float)sec)/(24*3600*365.);
+             + (hour*3600.+min*60.+(float)sec)/(24.*3600.*365.);
            //
+           if ( debug ) printf(" %i compute magnetic dipole moment get dipole moment for year\n",procev);
+           if ( debug ) printf(" %i jyear %f dimo %f \n",procev,jyear,dimo);
            feldcof_(&jyear, &dimo); // get dipole moment for year
+           if ( debug ) printf(" %i compute magnetic dipole moment end\n",procev);
+           GM_TimeAdjustCoefs(year, jyear, G0, G1, H1, &Model);
+           GM_PoleLocation(Model, &Pole);
          } else {
            code = -56;
            goto closeandexit;
-Line 700 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 1154 
 int OrbitalInfoCore(UInt_t run, TFile *f
        //
        cOrbit orbits(*gltle->GetTle());
        //
-       if ( debug ) printf(" I am Here \n");
-       //
        // synchronize with quaternions data
        //
        if ( isf && neventsm>0 ){
-         if ( debug ) printf(" I am here \n");
          //
          // First event
          //
          isf = false;
-         upperqtime = atime;
+         //      upperqtime = atime;
          lowerqtime = runinfo->RUNHEADER_TIME;
-         for ( ik = 0; ik < neventsm; ik++){
+         for ( ik = 0; ik < neventsm; ik++){  //number of macrocommad packets
-           l0trm->GetEntry(ik);
+           if ( ch->GetEntry(ik) <= 0 ) throw -36;
            tmpSize = mcmdev->Records->GetEntries();
-           numrec = tmpSize;
+           //      numrec = tmpSize;
-           for (Int_t j3 = 0;j3<tmpSize;j3++){
+           if ( debug ) cout << "packet number " << ik <<"\tnumber of subpackets is " << tmpSize << endl;
-             if ( debug ) printf(" eh eh eh \n");
+           for (Int_t j3 = 0;j3<tmpSize;j3++){  //number of subpackets
              mcmdrc = (pamela::McmdRecord*)mcmdev->Records->At(j3);
-             if ((int)mcmdrc->ID1 == 226){
+             if ( mcmdrc ){ // missing inclination bug [8RED 090116]
-               L_QQ_Q_l_upper->fill(mcmdrc->McmdData);
+               if ( debug ) printf(" pluto \n");
-               for (UInt_t ui = 0; ui < 6; ui++){
+               if ((int)mcmdrc->ID1 == 226 && mcmdrc->Mcmd_Block_crc_ok == 1){ //Check that it is Inclination Packet
-                 if (ui>0){
+                L_QQ_Q_l_upper->fill(mcmdrc->McmdData);
-                   if (L_QQ_Q_l_upper->time[ui]>L_QQ_Q_l_upper->time[0]){
+                 for (UInt_t ui = 0; ui < 6; ui++){
-                     if (dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[ui]*1000-DeltaOBT*1000))<atime){
+                   if (ui>0){
-                       upperqtime = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[ui]*1000-DeltaOBT*1000));
+                     if (L_QQ_Q_l_upper->time[ui]>L_QQ_Q_l_upper->time[0]){
-                       orbits.getPosition((double) (upperqtime - gltle->GetFromTime())/60., &eCi);
+                       if ( debug ) printf(" here1 %i \n",ui);
-                       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]);
+                       Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[ui]*1000-DeltaOBT*1000));
-                     }else {
+                       Int_t recSize = recqtime.size();
-                       lowerqtime = upperqtime;
+                       if(lowerqtime > recqtime[recSize-1]){
-                       upperqtime = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[ui]*1000-DeltaOBT*1000));
+                          // to avoid interpolation between bad quaternions arrays
-                       orbits.getPosition((double) (upperqtime - gltle->GetFromTime())/60., &eCi);
+                          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){
-                       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]);
+                           Int_t sizeqmcmd = qtime.size();
-                       mcreen = j3;
+                           inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
-                       mctren = ik;
+                           qtime[sizeqmcmd]=u_time;
-                       if(fgh==0){
+                           q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][0];
-                         CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper);
+                           q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][1];
-                         CopyAng(RYPang_lower,RYPang_upper);
+                           q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][2];
+                           q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][3];
+                           qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui);
+                           lowerqtime = u_time;
+                           orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi);
+                           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]);
+                           qRoll[sizeqmcmd]=RYPang_upper->Kren;
+                           qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
+                           qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
+                          }
+                       }
+                       for(Int_t mu = nt;mu<recSize;mu++){
+                         if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){
+                           if(sqrt(pow(recq0[mu],2)+pow(recq1[mu],2)+pow(recq2[mu],2)+pow(recq3[mu],2))>0.99999){
+                             nt=mu;
+                             Int_t sizeqmcmd = qtime.size();
+                             inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
+                             qtime[sizeqmcmd]=recqtime[mu];
+                             q0[sizeqmcmd]=recq0[mu];
+                             q1[sizeqmcmd]=recq1[mu];
+                             q2[sizeqmcmd]=recq2[mu];
+                             q3[sizeqmcmd]=recq3[mu];
+                             qmode[sizeqmcmd]=-10;
+                             orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);
+                             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]);
+                             qRoll[sizeqmcmd]=RYPang_upper->Kren;
+                             qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
+                             qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
+                           }
+                         }
+                         if(recqtime[mu]>=u_time){
+                           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){
+                             Int_t sizeqmcmd = qtime.size();
+                             inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
+                             qtime[sizeqmcmd]=u_time;
+                             q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][0];
+                             q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][1];
+                             q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][2];
+                             q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][3];
+                             qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui);
+                             lowerqtime = u_time;
+                             orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi);
+                             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]);
+                             qRoll[sizeqmcmd]=RYPang_upper->Kren;
+                             qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
+                             qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
+                             break;
+                           }
+                         }
                        }
-                       oi=ui;
-                       goto closethisloop;
                      }
-                     fgh++;
+                   }else{
-                     CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper);
+                     if ( debug ) printf(" here2 %i \n",ui);
-                     CopyAng(RYPang_lower,RYPang_upper);
+                     Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-                   }
+                     if(lowerqtime>u_time)nt=0;
-                 }else{
+                     Int_t recSize = recqtime.size();
-                   if (dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))<atime){
+                     if(lowerqtime > recqtime[recSize-1]){
-                     upperqtime = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
+                       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){
-                     orbits.getPosition((double) (upperqtime - gltle->GetFromTime())/60., &eCi);
+                         Int_t sizeqmcmd = qtime.size();
-                     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]);
+                         inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
-                   }
+                         qtime[sizeqmcmd]=u_time;
-                   else {
+                         q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][0];
-                     lowerqtime = upperqtime;
+                         q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][1];
-                     upperqtime = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
+                         q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][2];
-                     orbits.getPosition((double) (upperqtime - gltle->GetFromTime())/60., &eCi);
+                         q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][3];
-                     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]);
+                         qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui);
-                     mcreen = j3;
+                         lowerqtime = u_time;
-                     mctren = ik;
+                         orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi);
-                     if(fgh==0){
+                         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]);
-                       CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper);
+                         qRoll[sizeqmcmd]=RYPang_upper->Kren;
-                       CopyAng(RYPang_lower,RYPang_upper);
+                         qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
-                       lowerqtime = atime-1;
+                         qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
+                       }
+                     }
+                     for(Int_t mu = nt;mu<recSize;mu++){
+                       if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){
+                          if(sqrt(pow(recq0[mu],2)+pow(recq1[mu],2)+pow(recq2[mu],2)+pow(recq3[mu],2))>0.99999){
+                            nt=mu;
+                            Int_t sizeqmcmd = qtime.size();
+                            inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
+                            qtime[sizeqmcmd]=recqtime[mu];
+                            q0[sizeqmcmd]=recq0[mu];
+                            q1[sizeqmcmd]=recq1[mu];
+                            q2[sizeqmcmd]=recq2[mu];
+                            q3[sizeqmcmd]=recq3[mu];
+                            qmode[sizeqmcmd]=-10;
+                            orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);
+                            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]);
+                            qRoll[sizeqmcmd]=RYPang_upper->Kren;
+                            qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
+                            qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
+                          }
+                       }
+                       if(recqtime[mu]>=u_time){
+                          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){
+                            Int_t sizeqmcmd = qtime.size();
+                            inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
+                            qtime[sizeqmcmd]=u_time;
+                            q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][0];
+                            q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][1];
+                            q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][2];
+                            q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][3];
+                            qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui);
+                            lowerqtime = u_time;
+                            orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi);
+                            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]);
+                            qRoll[sizeqmcmd]=RYPang_upper->Kren;
+                            qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
+                            qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
+                            CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper);
+                            break;
+                          }
+                       }
                      }
-                     oi=ui;
-                     goto closethisloop;
-                     //_0 = true;
                    }
-                   fgh++;
+                 }
-                   CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper);
-                   CopyAng(RYPang_lower,RYPang_upper);
-                   //_0 = true;
-                 };
-                 //cin>>grib;
-               };
-             };
-           };
-         };
-       };
-     closethisloop:
-       //
-       if ( debug ) printf(" I am There \n");
-       //
-       if (((atime>(UInt_t)upperqtime)||(atime<(UInt_t)lowerqtime)) && neventsm>0 ){
-         if ( debug ) printf(" I am there \n");
-         //
-         lowerqtime = upperqtime;
-         Long64_t maxloop = 100000000LL;
-         Long64_t mn = 0;
-         bool gh=false;
-         ooi=oi;
-         if ( verbose ) printf(" OrbitalInfoCore: sync with quaternions data upperqtime %u lowerqtime %u atime %u \n",(UInt_t)upperqtime,(UInt_t)lowerqtime,atime);
-         while (!gh){
-           if ( mn > maxloop ){
-             if ( verbose ) printf(" OrbitalInfoCore: quaternions sync out of range! exiting\n");
-             gh = true;
-             neventsm = 0;
-           };
-           mn++;
-           if (oi<5) oi++;
-           else oi=0;
-           if (oi==0 && numrec > 0){
-             if ( debug ) printf(" mumble \n");
-             mcreen++;
-             if (mcreen == numrec){
-               mctren++;
-               mcreen = 0;
-               l0trm->GetEntry(mctren);
-               numrec = mcmdev->Records->GetEntries();
-             }
-             CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper);
-             CopyAng(RYPang_lower,RYPang_upper);
-             mcmdrc = (pamela::McmdRecord*)mcmdev->Records->At(mcreen);
-             if ((int)mcmdrc->ID1 == 226){
-               L_QQ_Q_l_upper->fill(mcmdrc->McmdData);
-               upperqtime = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-               if (upperqtime<lowerqtime){
-                 upperqtime=runinfo->RUNTRAILER_TIME;
-                 CopyQ(L_QQ_Q_l_upper,L_QQ_Q_l_lower);
-                 CopyAng(RYPang_upper,RYPang_lower);
-               }else{
-                 orbits.getPosition((double) (upperqtime - gltle->GetFromTime())/60., &eCi);
-                 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]);
                }
-               //              re--;
-               gh=true;
              }
-           }else{
+             //if ( debug ) cout << "subpacket " << j3 << "\t qtime = " << qtime[qtime.size()-1] << endl;
-             if ((Int_t)L_QQ_Q_l_upper->time[oi]>(Int_t)L_QQ_Q_l_upper->time[0]){
-               upperqtime = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
-               orbits.getPosition((double) (upperqtime - gltle->GetFromTime())/60., &eCi);
-               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[oi][0],L_QQ_Q_l_upper->quat[oi][1],L_QQ_Q_l_upper->quat[oi][2],L_QQ_Q_l_upper->quat[oi][3]);
-               orbits.getPosition((double) (lowerqtime - gltle->GetFromTime())/60., &eCi);
-               RYPang_lower->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[oi-1][0],L_QQ_Q_l_upper->quat[oi-1][1],L_QQ_Q_l_upper->quat[oi-1][2],L_QQ_Q_l_upper->quat[oi-1][3]);
-               //              re--;
-               gh=true;
-             };
-           };
-         };
-         if ( verbose ) printf(" OrbitalInfoCore: sync with quaternions data now we have upperqtime %u lowerqtime %u atime %u \n",(UInt_t)upperqtime,(UInt_t)lowerqtime,atime);
-       };
-       //
-       if ( debug ) printf(" I am THIS \n");
-       //
-       // Fill in quaternions and angles
-       //
-       if ((atime<=(UInt_t)upperqtime)&&(atime>=(UInt_t)lowerqtime)&& neventsm>0){
-         if ( debug ) printf(" I am this \n");
-         UInt_t tut = holeq(lowerqtime, upperqtime, L_QQ_Q_l_lower, L_QQ_Q_l_upper, oi);
-         if (oi == 0){
-           if ((tut!=5)||(tut!=6)){
-             incli = (L_QQ_Q_l_upper->quat[0][0]-L_QQ_Q_l_lower->quat[ooi][0])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-             orbitalinfo->q0 =  incli*atime+L_QQ_Q_l_upper->quat[0][0]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-             incli =     (L_QQ_Q_l_upper->quat[0][1]-L_QQ_Q_l_lower->quat[ooi][1])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-             orbitalinfo->q1 =  incli*atime+L_QQ_Q_l_upper->quat[0][1]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-             incli = (L_QQ_Q_l_upper->quat[0][2]-L_QQ_Q_l_lower->quat[ooi][2])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-             orbitalinfo->q2 =  incli*atime+L_QQ_Q_l_upper->quat[0][2]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-             incli = (L_QQ_Q_l_upper->quat[0][3]-L_QQ_Q_l_lower->quat[ooi][3])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-             orbitalinfo->q3 =  incli*atime+L_QQ_Q_l_upper->quat[0][3]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-             incli = (RYPang_upper->Tangazh-RYPang_lower->Tangazh)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-             orbitalinfo->theta =  incli*atime+RYPang_upper->Tangazh-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-             incli = (RYPang_upper->Ryskanie-RYPang_lower->Ryskanie)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-             orbitalinfo->phi =  incli*atime+RYPang_upper->Ryskanie-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-             incli = (RYPang_upper->Kren-RYPang_lower->Kren)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000)));
-             orbitalinfo->etha =  incli*atime+RYPang_upper->Kren-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
            }
-           if (tut==6){
+         }
-             if (fabs(RYPang_lower->Kren-RYPang_upper->Kren)<0.1){
-               incli = (L_QQ_Q_l_upper->quat[0][0]-L_QQ_Q_l_lower->quat[ooi][0])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-               orbitalinfo->q0 =  incli*atime+L_QQ_Q_l_upper->quat[0][0]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-               incli =           (L_QQ_Q_l_upper->quat[0][1]-L_QQ_Q_l_lower->quat[ooi][1])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-               orbitalinfo->q1 =  incli*atime+L_QQ_Q_l_upper->quat[0][1]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-               incli = (L_QQ_Q_l_upper->quat[0][2]-L_QQ_Q_l_lower->quat[ooi][2])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-               orbitalinfo->q2 =  incli*atime+L_QQ_Q_l_upper->quat[0][2]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-               incli = (L_QQ_Q_l_upper->quat[0][3]-L_QQ_Q_l_lower->quat[ooi][3])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-               orbitalinfo->q3 =  incli*atime+L_QQ_Q_l_upper->quat[0][3]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-               incli = (RYPang_upper->Tangazh-RYPang_lower->Tangazh)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-               orbitalinfo->theta =  incli*atime+RYPang_upper->Tangazh-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-               incli = (RYPang_upper->Ryskanie-RYPang_lower->Ryskanie)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-               orbitalinfo->phi =  incli*atime+RYPang_upper->Ryskanie-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-               //cout<<"upper = "<<RYPang_upper->Ryskanie<<" lower = "<<RYPang_lower->Ryskanie<<" timeupper[0] = "<<L_QQ_Q_l_upper->time[0]-5500000<<" timelower["<<ooi<<"] = "<<L_QQ_Q_l_lower->time[ooi]-5500000<<" Ryscanie = "<<orbitalinfo->phi<<" incli = "<<incli<<" upper-lower = "<<RYPang_upper->Ryskanie-RYPang_lower->Ryskanie<<" Dtime = "<<dbtime->DBabsTime((UInt_t)L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000)<<"-"<<dbtime->DBabsTime((UInt_t)L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)<<" atime = "<<atime<<"\n";
-               //cin>>grib;
-               incli = (RYPang_upper->Kren-RYPang_lower->Kren)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_lower->time[ooi]*1000-DeltaOBT*1000)));
-               orbitalinfo->etha =  incli*atime+RYPang_upper->Kren-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000));
-             }
-           }
-         } else {
-           if((tut!=6)||(tut!=7)||(tut!=9)){
-             incli = (L_QQ_Q_l_upper->quat[oi][0]-L_QQ_Q_l_upper->quat[oi-1][0])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
-             orbitalinfo->q0 =  incli*atime+L_QQ_Q_l_upper->quat[oi][0]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
-             incli = (L_QQ_Q_l_upper->quat[oi][1]-L_QQ_Q_l_upper->quat[oi-1][1])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
-             orbitalinfo->q1 =  incli*atime+L_QQ_Q_l_upper->quat[oi][1]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
-             incli = (L_QQ_Q_l_upper->quat[oi][2]-L_QQ_Q_l_upper->quat[oi-1][2])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
-             orbitalinfo->q2 =  incli*atime+L_QQ_Q_l_upper->quat[oi][2]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
-             incli = (L_QQ_Q_l_upper->quat[oi][3]-L_QQ_Q_l_upper->quat[oi-1][3])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
-             orbitalinfo->q3 =  incli*atime+L_QQ_Q_l_upper->quat[oi][3]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
-             incli = (RYPang_upper->Tangazh-RYPang_lower->Tangazh)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+         if(qtime.size()==0){                            // in case if no orientation information in data
-             orbitalinfo->theta =  incli*atime+RYPang_upper->Tangazh-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+           if ( debug ) cout << "qtime.size() = 0" << endl;
-             incli = (RYPang_upper->Ryskanie-RYPang_lower->Ryskanie)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+           for(UInt_t my=0;my<recqtime.size();my++){
-             orbitalinfo->phi =  incli*atime+RYPang_upper->Ryskanie-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+             if(sqrt(pow(recq0[my],2)+pow(recq1[my],2)+pow(recq2[my],2)+pow(recq3[my],2))>0.99999){
-             //cout<<"upper = "<<RYPang_upper->Ryskanie<<" lower = "<<RYPang_lower->Ryskanie<<" timeupper["<<oi<<"] = "<<L_QQ_Q_l_upper->time[oi]-5500000<<" timelower["<<oi-1<<"] = "<<L_QQ_Q_l_lower->time[oi-1]-5500000<<" Ryscanie = "<<orbitalinfo->phi<<" incli = "<<incli<<" upper-lower = "<<RYPang_upper->Ryskanie-RYPang_lower->Ryskanie<<" Dtime = "<<dbtime->DBabsTime((UInt_t)L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000)<<"-"<<dbtime->DBabsTime((UInt_t)L_QQ_Q_l_lower->time[oi-1]*1000-DeltaOBT*1000)<<" atime = "<<atime<<"\n";
+               Int_t sizeqmcmd = qtime.size();
-             //cin>>grib;
+               inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw);
-             incli = (RYPang_upper->Kren-RYPang_lower->Kren)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+               qtime[sizeqmcmd]=recqtime[my];
-             orbitalinfo->etha =  incli*atime+RYPang_upper->Kren-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+               q0[sizeqmcmd]=recq0[my];
-           }
+               q1[sizeqmcmd]=recq1[my];
-           if (tut==6){
+               q2[sizeqmcmd]=recq2[my];
-             if (fabs(RYPang_lower->Kren-RYPang_upper->Kren)<0.1){
+               q3[sizeqmcmd]=recq3[my];
-               incli = (L_QQ_Q_l_upper->quat[oi][0]-L_QQ_Q_l_upper->quat[oi-1][0])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+               qmode[sizeqmcmd]=-10;
-               orbitalinfo->q0 =  incli*atime+L_QQ_Q_l_upper->quat[oi][0]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+               orbits.getPosition((double) (qtime[sizeqmcmd] - gltle->GetFromTime())/60., &eCi);
-               incli = (L_QQ_Q_l_upper->quat[oi][1]-L_QQ_Q_l_upper->quat[oi-1][1])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+               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]);
-               orbitalinfo->q1 =  incli*atime+L_QQ_Q_l_upper->quat[oi][1]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+               qRoll[sizeqmcmd]=RYPang_upper->Kren;
-               incli = (L_QQ_Q_l_upper->quat[oi][2]-L_QQ_Q_l_upper->quat[oi-1][2])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+               qYaw[sizeqmcmd]=RYPang_upper->Ryskanie;
-               orbitalinfo->q2 =  incli*atime+L_QQ_Q_l_upper->quat[oi][2]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+               qPitch[sizeqmcmd]=RYPang_upper->Tangazh;
-               incli = (L_QQ_Q_l_upper->quat[oi][3]-L_QQ_Q_l_upper->quat[oi-1][3])/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+             }
-               orbitalinfo->q3 =  incli*atime+L_QQ_Q_l_upper->quat[oi][3]-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+           }
+         }
-               incli = (RYPang_upper->Tangazh-RYPang_lower->Tangazh)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
-               orbitalinfo->theta =  incli*atime+RYPang_upper->Tangazh-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+         if ( debug ) printf(" puffi \n");
-               incli = (RYPang_upper->Ryskanie-RYPang_lower->Ryskanie)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+         Double_t tmin = 9999999999.;
-               orbitalinfo->phi =  incli*atime+RYPang_upper->Ryskanie-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+         Double_t tmax = 0.;
-               //cout<<"upper = "<<RYPang_upper->Ryskanie<<" lower = "<<RYPang_lower->Ryskanie<<" timeupper["<<oi<<"] = "<<L_QQ_Q_l_upper->time[oi]-5500000<<" timelower["<<oi-1<<"] = "<<L_QQ_Q_l_lower->time[oi-1]-5500000<<" Ryscanie = "<<orbitalinfo->phi<<" incli = "<<incli<<" upper-lower = "<<RYPang_upper->Ryskanie-RYPang_lower->Ryskanie<<" Dtime = "<<dbtime->DBabsTime((UInt_t)L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000)<<"-"<<dbtime->DBabsTime((UInt_t)L_QQ_Q_l_lower->time[oi-1]*1000-DeltaOBT*1000)<<" atime = "<<atime<<"\n";
+         for(UInt_t tre = 0;tre<qtime.size();tre++){
-               //cin>>grib;
+           if(qtime[tre]>tmax)tmax = qtime[tre];
-               incli = (RYPang_upper->Kren-RYPang_lower->Kren)/(dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000))-dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi-1]*1000-DeltaOBT*1000)));
+           if(qtime[tre]<tmin)tmin = qtime[tre];
-               orbitalinfo->etha =  incli*atime+RYPang_upper->Kren-incli*dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[oi]*1000-DeltaOBT*1000));
+         }
+         // sorting quaternions by time
+        Bool_t t = true;
+         while(t){
+          t=false;
+           for(UInt_t i=0;i<qtime.size()-1;i++){
+             if(qtime[i]>qtime[i+1]){
+               Double_t tmpr = qtime[i];
+               qtime[i]=qtime[i+1];
+               qtime[i+1] = tmpr;
+               tmpr = q0[i];
+               q0[i]=q0[i+1];
+               q0[i+1] = tmpr;
+               tmpr = q1[i];
+               q1[i]=q1[i+1];
+               q1[i+1] = tmpr;
+               tmpr = q2[i];
+               q2[i]=q2[i+1];
+               q2[i+1] = tmpr;
+               tmpr = q3[i];
+               q3[i]=q3[i+1];
+               q3[i+1] = tmpr;
+               tmpr = qRoll[i];
+               qRoll[i]=qRoll[i+1];
+               qRoll[i+1] = tmpr;
+               tmpr = qYaw[i];
+               qYaw[i]=qYaw[i+1];
+               qYaw[i+1] = tmpr;
+               tmpr = qPitch[i];
+               qPitch[i]=qPitch[i+1];
+               qPitch[i+1] = tmpr;
+                 t=true;
              }
            }
          }
-         //
-         orbitalinfo->mode = holeq(lowerqtime, upperqtime, L_QQ_Q_l_lower, L_QQ_Q_l_upper, oi);
+         if ( debug ){
-         //
+           cout << "we have loaded quaternions: size of quaternions set is "<< qtime.size() << endl;
-       } else {
+          for(UInt_t i=0;i<qtime.size();i++) cout << qtime[i] << "\t";
-         if ( debug ) printf(" ops no incl! \n");
+           cout << endl << endl;
-         orbitalinfo->mode = 10;
+           Int_t lopu;
-       };
+           cin >> lopu;
+        }
+       } // if we processed first event
+       //Filling Inclination information
+       Double_t incli = 0;
+       if ( qtime.size() > 1 ){
+         if ( debug ) cout << "ok quaternions is exist and mu = " << must << endl;
+         if ( debug ) cout << "qtimes[ " << qtime[0] << " , " << qtime[qtime.size()-1] << " ]\tatime = "<<atime<<endl;
+         for(UInt_t mu = must;mu<qtime.size()-1;mu++){
+           if ( debug ) printf(" ??grfuffi %i sixe %i must %i \n",mu,qtime.size()-1,must);
+           if(qtime[mu+1]>qtime[mu]){
+             if ( debug ) cout << "qtime[" << mu << "] = " << qtime[mu] << "\tqtime[" << mu+1 << "] = " << qtime[mu+1] << "\tatime = " << atime << endl;
+             if(atime<=qtime[mu+1] && atime>=qtime[mu]){
+               if ( debug ) cout << "here we have found proper quaternions for interpolation: mu = "<<mu<<endl;
+               must = mu;
+               incli = (qPitch[mu+1]-qPitch[mu])/(qtime[mu+1]-qtime[mu]);
+               orbitalinfo->theta =  incli*atime+qPitch[mu+1]-incli*qtime[mu+1];
+               incli = (qRoll[mu+1]-qRoll[mu])/(qtime[mu+1]-qtime[mu]);
+               orbitalinfo->etha =  incli*atime+qRoll[mu+1]-incli*qtime[mu+1];
+               incli = (qYaw[mu+1]-qYaw[mu])/(qtime[mu+1]-qtime[mu]);
+               orbitalinfo->phi =  incli*atime+qYaw[mu+1]-incli*qtime[mu+1];
+               incli = (q0[mu+1]-q0[mu])/(qtime[mu+1]-qtime[mu]);
+               orbitalinfo->q0 =  incli*atime+q0[mu+1]-incli*qtime[mu+1];
+               incli = (q1[mu+1]-q1[mu])/(qtime[mu+1]-qtime[mu]);
+               orbitalinfo->q1 =  incli*atime+q1[mu+1]-incli*qtime[mu+1];
+               incli = (q2[mu+1]-q2[mu])/(qtime[mu+1]-qtime[mu]);
+               orbitalinfo->q2 =  incli*atime+q2[mu+1]-incli*qtime[mu+1];
+               incli = (q3[mu+1]-q3[mu])/(qtime[mu+1]-qtime[mu]);
+               orbitalinfo->q3 =  incli*atime+q3[mu+1]-incli*qtime[mu+1];
+               Float_t tg = (qtime[mu+1]-qtime[mu])/1000.0;
+               if(tg>=1) tg=0.00;
+               orbitalinfo->TimeGap = TMath::Min(TMath::Abs(qtime[mu+1])-atime,TMath::Abs(atime-qtime[mu]))+tg;//qtime[mu+1]-qtime[mu];
+               orbitalinfo->mode = qmode[mu+1];
+               //if(atime==qtime[mu] || atime==qtime[mu+1]) orbitalinfo->qkind = 0; else orbitalinfo->qkind=1;
+               //if(qmode[mu+1]==-10) orbitalinfo->R10r = true;else orbitalinfo->R10r = false;
+               if ( debug ) printf(" grfuffi4 %i \n",mu);
+               break;
+             }
+           }
+         }
+       }
+       if ( debug ) printf(" grfuffi5  \n");
        //
        // ops no inclination information
        //
        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 ( debug ) cout << "ops no iclination information" << endl;
          orbitalinfo->mode = 10;
          orbitalinfo->q0 = -1000.;
          orbitalinfo->q1 = -1000.;
-Line 949 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 1439 
 int OrbitalInfoCore(UInt_t run, TFile *f
          orbitalinfo->etha = -1000.;
          orbitalinfo->phi = -1000.;
          orbitalinfo->theta = -1000.;
-       };
+         orbitalinfo->TimeGap = -1000.;
+         //orbitalinfo->qkind = -1000;
+         //      if ( debug ){
+         //        Int_t lopu;
+         //         cin >> lopu;
+         //      }
+         if ( debug ) printf(" grfuffi6 \n");
+       }
        //
+       if ( debug ) printf(" filling \n");
        // #########################################################################################################################
        //
        // fill orbital positions
-Line 961 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 1460 
 int OrbitalInfoCore(UInt_t run, TFile *f
        lon = (coo.m_Lon > M_PI) ? rad2deg(coo.m_Lon - 2*M_PI) : rad2deg(coo.m_Lon);
        lat = rad2deg(coo.m_Lat);
        alt = coo.m_Alt;
-       //
+       cOrbit orbits2(*gltle->GetTle());
+       orbits2.getPosition((double) (atime - gltle->GetFromTime())/60., &eCi);
+       //      Float_t x=eCi.getPos().m_x;
+       //      Float_t y=eCi.getPos().m_y;
+       //      Float_t z=eCi.getPos().m_z;
+       TVector3 V(eCi.getVel().m_x,eCi.getVel().m_y,eCi.getVel().m_z);
+       TVector3 Pos(eCi.getPos().m_x,eCi.getPos().m_y,eCi.getPos().m_z);
+       Float_t dlon=Pos.Phi()*TMath::RadToDeg()-lon;
+       Pos.RotateZ(-dlon*TMath::DegToRad());
+       V.RotateZ(-dlon*TMath::DegToRad());
+       Float_t diro;
+       if(V.Z()>0) diro=1; else diro=-1;
+       // 10REDNEW
+       Int_t errq=0;
+       Int_t azim=0;
+       Int_t MU=0;
+       for(UInt_t mu = must;mu<RTtime2.size()-1;mu++){
+         if(atime<=RTstart[mu+1] && atime>=RTstart[mu]){
+           errq=RTerrq[mu];
+           azim=RTazim[mu];
+           MU=mu;
+           break;
+         }
+       }
+       orbitalinfo->errq = errq;
+       orbitalinfo->azim = azim;
+       orbitalinfo->qkind = 0;
+       if ( debug ) printf(" coord done \n");
        if( lon<180 && lon>-180 && lat<90 && lat>-90 && alt>0 ){
          //
          orbitalinfo->lon = lon;
          orbitalinfo->lat = lat;
-         orbitalinfo->alt = alt ;
+         orbitalinfo->alt = alt;
+         orbitalinfo->V = V;
+         //      GMtype_CoordGeodetic  location;
+         location.lambda = lon;
+         location.phi = lat;
+         location.HeightAboveEllipsoid = alt;
+         GM_GeodeticToSpherical(Ellip, location, &CoordSpherical);
+         GM_SphericalToCartesian(CoordSpherical,  &CoordCartesian);
+         GM_EarthCartToDipoleCartCD(Pole, CoordCartesian, &DipoleCartesian);
+         GM_CartesianToSpherical(DipoleCartesian, &DipoleSpherical);
+         orbitalinfo->londip = DipoleSpherical.lambda;
+         orbitalinfo->latdip = DipoleSpherical.phig;
+         if(debug)cout<<"geodetic:\t"<<lon<<"\t"<<lat<<"\tgeomagnetic:\t"<<orbitalinfo->londip<<"\t"<<orbitalinfo->latdip<<endl;
          //
          // compute mag field components and L shell.
          //
+         if ( debug ) printf(" call igrf feldg \n");
          feldg_(&lat, &lon, &alt, &bnorth, &beast, &bdown, &babs);
+         if ( debug ) printf(" call igrf shellg \n");
          shellg_(&lat, &lon, &alt, &dimo, &xl, &icode, &bab1);
+         if ( debug ) printf(" call igrf findb \n");
          findb0_(&stps, &bdel, &value, &bequ, &rr0);
          //
+         if ( debug ) printf(" done igrf \n");
          orbitalinfo->Bnorth = bnorth;
          orbitalinfo->Beast = beast;
          orbitalinfo->Bdown = bdown;
          orbitalinfo->Babs = babs;
+         orbitalinfo->M = dimo;
          orbitalinfo->BB0 = babs/bequ;
          orbitalinfo->L = xl;
          // Set Stormer vertical cutoff using L shell.
-         orbitalinfo->cutoff[0] = 14.9/(xl*xl);
+         orbitalinfo->cutoffsvl = 14.295 / (xl*xl); //
+         if(debug)cout << "L = " << xl << "\tM = " << dimo << "\tvertical cutoff:  "<< orbitalinfo->cutoffsvl << endl;
+         /*
+           ---------- Forwarded message ----------
+           Date: Wed, 09 May 2012 12:16:47 +0200
+           From: Alessandro Bruno <alessandro.bruno@ba.infn.it>
+           To: Mirko Boezio <mirko.boezio@ts.infn.it>
+           Cc: Francesco S. Cafagna <Francesco.Cafagna@ba.infn.it>
+           Subject: St�rmer vertical cutoff
+           Ciao Mirko,
+           volevo segnalarti che il valore dello St�rmer vertical cutoff nel Level2 �
+           sovrastimato di circa il 4%.
+           Dopo un'approfondita analisi con l'IGRF-05 abbiamo ricavano un valore pari
+           a: 14.295 / L^2 anzich� 14.9 / L^2, valore obsoleto in quanto riferito agli
+           anni '50.
+         */
+         //14.9/(xl*xl);
+         orbitalinfo->igrf_icode = icode;
          //
-       };
+       }
+       //
+       if ( debug ) printf(" pitch angle \n");
        //
        // pitch angles
        //
-       if ( orbitalinfo->mode != 10 && orbitalinfo->mode != 5 && orbitalinfo->mode !=7 && orbitalinfo->mode != 9 ){
+       if( orbitalinfo->TimeGap>0){
          //
-         Float_t Bx = -orbitalinfo->Bdown;                       //don't need for PamExp ExpOnly for all geography areas
+         if ( debug ) printf(" timegap %f \n",orbitalinfo->TimeGap);
-         Float_t By = orbitalinfo->Beast;                        //don't need for PamExp ExpOnly for all geography areas
+         Float_t Bx = -orbitalinfo->Bdown;
-         Float_t Bz = orbitalinfo->Bnorth;                       //don't need for PamExp ExpOnly for all geography areas
+         Float_t By = orbitalinfo->Beast;
-         //
+         Float_t Bz = orbitalinfo->Bnorth;
-         TMatrixD Fij = PO->ECItoGreenwich(PO->QuatoECI(orbitalinfo->q0,orbitalinfo->q1,orbitalinfo->q2,orbitalinfo->q3),orbitalinfo->absTime);
-         TMatrixD Dij = PO->GreenwichtoGEO(orbitalinfo->lat,orbitalinfo->lon,Fij);
+         TMatrixD Qiji(3,3);
+         TMatrixD Qij = PO->QuatoECI(orbitalinfo->q0,orbitalinfo->q1,orbitalinfo->q2,orbitalinfo->q3);
+         TMatrixD Dij = PO->ECItoGEO(Qij,orbitalinfo->absTime,orbitalinfo->lat,orbitalinfo->lon);
+ //10REDNEW
+         /* If initial orientation data have reason to be inaccurate */
+         Float_t tg = 0.00;
+        Float_t tmptg;
+        if(MU!=0){
+ //      if(orbitalinfo->TimeGap>0 && errq==0 && azim==0){               // 10RED CHECK  (comparison between three metod of recovering orientation)
+        if((atime>=RTstart[MU] && atime<RTstart[MU+1] && RTbank1[MU]==0 && RTbank2[MU]==0 && TMath::Abs(orbitalinfo->etha)>0.01) || ((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)))){
+         /*  found in Rotation Table this data for this time interval*/
+         if(atime<RTtime1[0])
+           orbitalinfo->azim = 5;        //means that RotationTable no started yet
+        else{
+                 // search for angle betwean velosity and direction to north in tangential to Earth surfase plane in satellite position
+               Double_t bank=RTstart[MU];
+               Double_t tlat=orbitalinfo->lat;
+               tg=modf(orbitalinfo->TimeGap,&tg)*1000;
+               if(atime>=RTpluto1[MU] && atime<=RTpluto2[MU]){
+                 Double_t kar=(RTbank2[MU]-RTbank1[MU])/(RTtime2[MU]-RTtime1[MU]);
+                 Double_t bak=RTbank1[MU]-kar*RTtime1[MU];
+                 bank=kar*atime+bak;
+               }
+               if(atime>=RTstart[MU] && atime<RTpluto1[MU]){
+                  Double_t s_dBdt2=(RTbpluto1[MU]-RTbank1[MU])/(RTpluto1[MU]-RTstart[MU]);
+                  Double_t s_t2=((Double_t)RTpluto1[MU]+(Double_t)RTstart[MU])/2. - RTstart[MU];
+                  Double_t s_t1=RTstart[MU]-RTstart[MU];
+                  Double_t s_k=s_dBdt2/(s_t2-s_t1);
+                  Double_t s_b=-s_k*s_t1;
+                  Double_t s_t3=RTpluto1[MU]-RTstart[MU];
+                  Double_t s_b3=RTbpluto1[MU];
+                  Double_t s_c=s_b3-0.5*s_k*s_t3*s_t3 -s_b*s_t3;
+                  bank=0.5*s_k*(atime-RTstart[MU])*(atime-RTstart[MU]) + s_b*(atime-RTstart[MU]) + s_c;
+              }
+               if(atime>RTpluto2[MU] && atime<=RTstart[MU+1]){
+                  Double_t s_dBdt2=(RTbpluto2[MU] - RTbank2[MU])/(RTpluto2[MU]-RTstart[MU+1]);
+                  Double_t s_t2=((Double_t)RTpluto2[MU]+(Double_t)RTstart[MU+1])/2. - RTstart[MU];
+                  Double_t s_t1=RTstart[MU+1]-RTstart[MU];
+                  Double_t s_k=s_dBdt2/(s_t2-s_t1);
+                  Double_t s_b=-s_k*s_t1;
+                  Double_t s_t3=RTpluto2[MU]-RTstart[MU];
+                  Double_t s_b3=RTbpluto2[MU];
+                  Double_t s_c=s_b3-0.5*s_k*s_t3*s_t3 -s_b*s_t3;
+                bank=0.5*s_k*(atime-RTstart[MU])*(atime-RTstart[MU]) + s_b*(atime-RTstart[MU]) + s_c;
+              }
+               orbitalinfo->etha=bank;
+               Double_t spitch = 0.00001;  // temprary not zero to avoid problem with tranzition from Euler angles to orientation matrix
+                 //Estimations of pitch angle of satellite
+               if(TMath::Abs(bank)>0.7){
+                  Float_t spitch1=TMath::DegToRad()*0.7*diro;//RTdir1[MU];
+                  Float_t spitch2=TMath::DegToRad()*0.7*diro;//RTdir2[MU];
+                  Float_t kva=(spitch2-spitch1)/(RTtime2[MU]-RTtime1[MU]);
+                  Float_t bva=spitch1-kva*RTtime1[MU];
+                  spitch=kva*atime+bva;
+               }
+               //Calculate Yaw angle accordingly with fit, see picture FitYaw.jpg
+               Double_t yaw=0.00001;  // temprary not zero to avoid problem with tranzition from Euler angles to orientation matrix
+               if(TMath::Abs(tlat)<70)
+                 yaw = -3.7e-8*tlat*tlat*tlat*tlat + 1.4e-7*tlat*tlat*tlat - 0.0005*tlat*tlat - 0.00025*tlat + 3.6;
+               yaw = diro*yaw;   //because should be different sign for ascending and descending orbits!
+               orbitalinfo->phi=yaw;
+               if(TMath::Abs(bank)>0.5 && TMath::Abs(yaw-orbitalinfo->phi)<3.0) yaw=orbitalinfo->phi;
+ //            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
+               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
+               orbitalinfo->qkind = 1;
+           //Qij = PO->GEOtoECI(Dij,orbitalinfo->absTime,orbitalinfo->lat,orbitalinfo->lon); // to convert from Dij to Qij
+         } // end of if(atime<RTtime1[0]
+         } // end of f(((orbitalinfo->TimeGap>60.0 && TMath...
+        } // end of MU~=0
+         TMatrixD qij = PO->ColPermutation(Qij);
+         TMatrixD Fij = PO->ECItoGreenwich(Qij,orbitalinfo->absTime);
+         TMatrixD Gij = PO->ColPermutation(Fij);
+         Dij = PO->ECItoGEO(Qij,orbitalinfo->absTime,orbitalinfo->lat,orbitalinfo->lon);
          TMatrixD Iij = PO->ColPermutation(Dij);
+         TVector3 SP = PO->GetSunPosition(orbitalinfo->absTime);
+         // go to Pamela reference frame from Resurs reference frame
+         Float_t tmpy = SP.Y();
+         SP.SetY(SP.Z());
+         SP.SetZ(-tmpy);
+         TVector3 SunZenith;
+         SunZenith.SetMagThetaPhi(1,23.439281*TMath::DegToRad(),TMath::Pi()/2.);
+         TVector3 SunMag = -SP;
+         SunMag.Rotate(-45*TMath::DegToRad(),SunZenith);
+         tmpy=SunMag.Y();
+         SunMag.SetY(SunMag.Z());
+         SunMag.SetZ(-tmpy);
+         orbitalinfo->Iij.ResizeTo(Iij);
+         orbitalinfo->Iij = Iij;
          //
-         A1 = Iij(0,2);
+         //      A1 = Iij(0,2);
-         A2 = Iij(1,2);
+         //      A2 = Iij(1,2);
-         A3 = Iij(2,2);
+         //      A3 = Iij(2,2);
          //
-         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
-         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
          //
-         if ( !standalone && tof->ntrk() > 0 ){
+         if ( debug ) printf(" matrixes done  \n");
+         if ( !standalone ){
+           if ( debug ) printf(" !standalone \n");
            //
+           // Standard tracking algorithm
+           //
            Int_t nn = 0;
+           if ( verbose ) printf(" standard tracking \n");
            for(Int_t nt=0; nt < tof->ntrk(); nt++){
              //
              ToFTrkVar *ptt = tof->GetToFTrkVar(nt);
+             if (debug) cout<<"tof->ntrk() = "<<tof->ntrk()<<"\tptt->trkseqno = "<<ptt->trkseqno<<"\ttrke->ntrk() = "<<trke->ntrk()<<endl;
              Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];
              Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];
              Double_t E11z = zin[0];
              Double_t E22x = ptt->xtr_tof[3];//tr->x[3];
              Double_t E22y = ptt->ytr_tof[3];//tr->y[3];
              Double_t E22z = zin[3];
-             if ( E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.  ){
+             if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){
+               TrkTrack *mytrack = trke->GetStoredTrack(ptt->trkseqno);
+               Float_t rig=1/mytrack->GetDeflection();
                Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));
-               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;
                Px = (E22x-E11x)/norm;
                Py = (E22y-E11y)/norm;
                Pz = (E22z-E11z)/norm;
                //
-               TMatrixD Eij = PO->PamelatoGEO(Iij,Px,Py,Pz);
-               //
                t_orb->trkseqno = ptt->trkseqno;
+               //
+               TMatrixD Eij = PO->PamelatoGEO(Iij,Px,Py,Pz);
+               t_orb->Eij.ResizeTo(Eij);
+               t_orb->Eij = Eij;
+               //
+               TMatrixD Sij = PO->PamelatoGEO(Gij,Px,Py,Pz);
+               t_orb->Sij.ResizeTo(Sij);
+               t_orb->Sij = Sij;
+               //
                t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);
+               //
+               // SunPosition in instrumental reference frame
+               TMatrixD Kij = PO->PamelatoGEO(qij,Px,Py,Pz);
+               TMatrixD Lij = PO->PamelatoGEO(qij,0,0,1);
+               t_orb->sunangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),-SP.X(),-SP.Y(),-SP.Z());
+               t_orb->sunmagangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),SunMag.X(),SunMag.Y(),SunMag.Z());
+               //
+               //
+               Double_t omega = PO->GetPitchAngle(-Eij(0,0),-Eij(1,0),-Eij(2,0),1,0,0) * TMath::DegToRad();
+               TVector3 Bxy(0,By,Bz);
+               TVector3 Exy(0,-Eij(1,0),-Eij(2,0));
+               Double_t dzeta=Bxy.Angle(Exy);
+               if (-Eij(1,0) < 0) dzeta=2.0*TMath::Pi() - dzeta;
+               if(debug) cout << "omega = "<<omega*TMath::RadToDeg()<<"\tdzeta = "<<dzeta*TMath::RadToDeg()<<endl;
+               // Formula from D.F. Smart *, M.A. Shea [2005]; A review of geomagnetic cutoff rigidities for earth-orbiting spacecraft
+               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));
+               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));
+               if (debug) cout << "R = " << rig << "\tcutoff = " << t_orb->cutoff << endl;
+               //
+               if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;
+               if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;
+               if ( t_orb->sunangle != t_orb->sunangle ) t_orb->sunangle = -1000.;
+               if ( t_orb->sunmagangle != t_orb->sunmagangle ) t_orb->sunmagangle = -1000.;
+               //
+               if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);
                //
                new(tor[nn]) OrbitalInfoTrkVar(*t_orb);
                nn++;
                //
                t_orb->Clear();
                //
-             };
+             }
              //
-           };
+           } // end standard tracking algorithm
+           //
+           // Code for extended tracking algorithm:
+           //
+           if ( hasNucleiTrk ){
+             Int_t ttentry = 0;
+             if ( verbose ) printf(" hasNucleiTrk \n");
+             for(Int_t nt=0; nt < tcNucleiTof->GetEntries() ; nt++){
+               //
+               if ( verbose ) printf(" got1\n");
+               ToFTrkVar *ptt = (ToFTrkVar*)(tcNucleiTof->At(nt));
+               if (verbose) cout<<" tcNucleiTof->GetEntries() = "<<tcNucleiTof->GetEntries()<<"\tptt->trkseqno = "<<ptt->trkseqno<<endl;
+               Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];
+               Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];
+               Double_t E11z = zin[0];
+               Double_t E22x = ptt->xtr_tof[3];//tr->x[3];
+               Double_t E22y = ptt->ytr_tof[3];//tr->y[3];
+               Double_t E22z = zin[3];
+               if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){
+                 TrkTrack *mytrack = (TrkTrack*)(tcNucleiTrk->At(ptt->trkseqno));
+                 if ( verbose ) printf(" got tcNucleiTrk \n");
+                 Float_t rig=1/mytrack->GetDeflection();
+                 Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));
+                 //
+                 Px = (E22x-E11x)/norm;
+                 Py = (E22y-E11y)/norm;
+                 Pz = (E22z-E11z)/norm;
+                 //
+                 t_orb->trkseqno = ptt->trkseqno;
+                 //
+                 TMatrixD Eij = PO->PamelatoGEO(Iij,Px,Py,Pz);
+                 t_orb->Eij.ResizeTo(Eij);
+                 t_orb->Eij = Eij;
+                 //
+                 TMatrixD Sij = PO->PamelatoGEO(Gij,Px,Py,Pz);
+                 t_orb->Sij.ResizeTo(Sij);
+                 t_orb->Sij = Sij;
+                 //
+                 t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);
+                 //
+                 // SunPosition in instrumental reference frame
+                 TMatrixD Kij = PO->PamelatoGEO(qij,Px,Py,Pz);
+                 TMatrixD Lij = PO->PamelatoGEO(qij,0,0,1);
+                 t_orb->sunangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),-SP.X(),-SP.Y(),-SP.Z());
+                 t_orb->sunmagangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),SunMag.X(),SunMag.Y(),SunMag.Z());
+                 //
+                 //
+                 Double_t omega = PO->GetPitchAngle(-Eij(0,0),-Eij(1,0),-Eij(2,0),1,0,0) * TMath::DegToRad();
+                 TVector3 Bxy(0,By,Bz);
+                 TVector3 Exy(0,-Eij(1,0),-Eij(2,0));
+                 Double_t dzeta=Bxy.Angle(Exy);
+                 if (-Eij(1,0) < 0) dzeta=2.0*TMath::Pi() - dzeta;
+                 if(debug) cout << "omega = "<<omega*TMath::RadToDeg()<<"\tdzeta = "<<dzeta*TMath::RadToDeg()<<endl;
+                 // Formula from D.F. Smart *, M.A. Shea [2005]; A review of geomagnetic cutoff rigidities for earth-orbiting spacecraft
+                 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));
+                 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));
+                 if (debug) cout << "R = " << rig << "\tcutoff = " << t_orb->cutoff << endl;
+                 //
+                 if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;
+                 if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;
+                 if ( t_orb->sunangle != t_orb->sunangle ) t_orb->sunangle = -1000.;
+                 if ( t_orb->sunmagangle != t_orb->sunmagangle ) t_orb->sunmagangle = -1000.;
+                 //
+                 if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);
+                 //
+                 TClonesArray &tt1 = *torbNucleiTrk;
+                 new(tt1[ttentry]) OrbitalInfoTrkVar(*t_orb);
+                 ttentry++;
+                 //
+                 t_orb->Clear();
+                 //
+               }
+               //
+             }
+           } // end standard tracking algorithm: nuclei
+           if ( hasExtNucleiTrk ){
+             Int_t ttentry = 0;
+             if ( verbose ) printf(" hasExtNucleiTrk \n");
+             for(Int_t nt=0; nt < tcExtNucleiTof->GetEntries() ; nt++){
+               //
+               if ( verbose ) printf(" got2\n");
+               ToFTrkVar *ptt = (ToFTrkVar*)(tcExtNucleiTof->At(nt));
+               if (verbose) cout<<" tcExtNucleiTof->GetEntries() = "<<tcExtNucleiTof->GetEntries()<<"\tptt->trkseqno = "<<ptt->trkseqno<<endl;
+               Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];
+               Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];
+               Double_t E11z = zin[0];
+               Double_t E22x = ptt->xtr_tof[3];//tr->x[3];
+               Double_t E22y = ptt->ytr_tof[3];//tr->y[3];
+               Double_t E22z = zin[3];
+               if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){
+                 ExtTrack *mytrack = (ExtTrack*)(tcExtNucleiTrk->At(ptt->trkseqno));
+                 if ( verbose ) printf(" got tcExtNucleiTrk \n");
+                 Float_t rig=1/mytrack->GetDeflection();
+                 Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));
+                 //
+                 Px = (E22x-E11x)/norm;
+                 Py = (E22y-E11y)/norm;
+                 Pz = (E22z-E11z)/norm;
+                 //
+                 t_orb->trkseqno = ptt->trkseqno;
+                 //
+                 TMatrixD Eij = PO->PamelatoGEO(Iij,Px,Py,Pz);
+                 t_orb->Eij.ResizeTo(Eij);
+                 t_orb->Eij = Eij;
+                 //
+                 TMatrixD Sij = PO->PamelatoGEO(Gij,Px,Py,Pz);
+                 t_orb->Sij.ResizeTo(Sij);
+                 t_orb->Sij = Sij;
+                 //
+                 t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);
+                 //
+                 // SunPosition in instrumental reference frame
+                 TMatrixD Kij = PO->PamelatoGEO(qij,Px,Py,Pz);
+                 TMatrixD Lij = PO->PamelatoGEO(qij,0,0,1);
+                 t_orb->sunangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),-SP.X(),-SP.Y(),-SP.Z());
+                 t_orb->sunmagangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),SunMag.X(),SunMag.Y(),SunMag.Z());
+                 //
+                 //
+                 Double_t omega = PO->GetPitchAngle(-Eij(0,0),-Eij(1,0),-Eij(2,0),1,0,0) * TMath::DegToRad();
+                 TVector3 Bxy(0,By,Bz);
+                 TVector3 Exy(0,-Eij(1,0),-Eij(2,0));
+                 Double_t dzeta=Bxy.Angle(Exy);
+                 if (-Eij(1,0) < 0) dzeta=2.0*TMath::Pi() - dzeta;
+                 if(debug) cout << "omega = "<<omega*TMath::RadToDeg()<<"\tdzeta = "<<dzeta*TMath::RadToDeg()<<endl;
+                 // Formula from D.F. Smart *, M.A. Shea [2005]; A review of geomagnetic cutoff rigidities for earth-orbiting spacecraft
+                 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));
+                 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));
+                 if (debug) cout << "R = " << rig << "\tcutoff = " << t_orb->cutoff << endl;
+                 //
+                 if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;
+                 if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;
+                 if ( t_orb->sunangle != t_orb->sunangle ) t_orb->sunangle = -1000.;
+                 if ( t_orb->sunmagangle != t_orb->sunmagangle ) t_orb->sunmagangle = -1000.;
+                 //
+                 if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);
+                 //
+                 TClonesArray &tt2 = *torbExtNucleiTrk;
+                 new(tt2[ttentry]) OrbitalInfoTrkVar(*t_orb);
+                 ttentry++;
+                 //
+                 t_orb->Clear();
+                 //
+               }
+               //
+             }
+           } // end standard tracking algorithm: nuclei extended
+          if ( hasExtTrk ){
+             Int_t ttentry = 0;
+             if ( verbose ) printf(" hasExtTrk \n");
+             for(Int_t nt=0; nt < tcExtTof->GetEntries() ; nt++){
+               //
+               if ( verbose ) printf(" got3\n");
+               ToFTrkVar *ptt = (ToFTrkVar*)(tcExtTof->At(nt));
+               if (verbose) cout<<" tcExtTof->GetEntries() = "<<tcExtTof->GetEntries()<<"\tptt->trkseqno = "<<ptt->trkseqno<<endl;
+               Double_t E11x = ptt->xtr_tof[0]; // tr->x[0];
+               Double_t E11y = ptt->ytr_tof[0]; //tr->y[0];
+               Double_t E11z = zin[0];
+               Double_t E22x = ptt->xtr_tof[3];//tr->x[3];
+               Double_t E22y = ptt->ytr_tof[3];//tr->y[3];
+               Double_t E22z = zin[3];
+               if ( (E11x < 100. && E11y < 100. && E22x < 100. && E22y < 100.) || ptt->trkseqno != -1  ){
+                 ExtTrack *mytrack = (ExtTrack*)(tcExtTrk->At(ptt->trkseqno));
+                 if ( verbose ) printf(" got tcExtTrk \n");
+                 Float_t rig=1/mytrack->GetDeflection();
+                 Double_t norm = sqrt(pow(E22x-E11x,2)+pow(E22y-E11y,2)+pow(E22z-E11z,2));
+                 //
+                 Px = (E22x-E11x)/norm;
+                 Py = (E22y-E11y)/norm;
+                 Pz = (E22z-E11z)/norm;
+                 //
+                 t_orb->trkseqno = ptt->trkseqno;
+                 //
+                 TMatrixD Eij = PO->PamelatoGEO(Iij,Px,Py,Pz);
+                 t_orb->Eij.ResizeTo(Eij);
+                 t_orb->Eij = Eij;
+                 //
+                 TMatrixD Sij = PO->PamelatoGEO(Gij,Px,Py,Pz);
+                 t_orb->Sij.ResizeTo(Sij);
+                 t_orb->Sij = Sij;
+                 //
+                 t_orb->pitch = (Float_t)PO->GetPitchAngle(Eij(0,0),Eij(1,0),Eij(2,0),Bx,By,Bz);
+                 //
+                 // SunPosition in instrumental reference frame
+                 TMatrixD Kij = PO->PamelatoGEO(qij,Px,Py,Pz);
+                 TMatrixD Lij = PO->PamelatoGEO(qij,0,0,1);
+                 t_orb->sunangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),-SP.X(),-SP.Y(),-SP.Z());
+                 t_orb->sunmagangle=(Float_t)PO->GetPitchAngle(Kij(0,0),Kij(1,0),Kij(2,0),SunMag.X(),SunMag.Y(),SunMag.Z());
+                 //
+                 //
+                 Double_t omega = PO->GetPitchAngle(-Eij(0,0),-Eij(1,0),-Eij(2,0),1,0,0) * TMath::DegToRad();
+                 TVector3 Bxy(0,By,Bz);
+                 TVector3 Exy(0,-Eij(1,0),-Eij(2,0));
+                 Double_t dzeta=Bxy.Angle(Exy);
+                 if (-Eij(1,0) < 0) dzeta=2.0*TMath::Pi() - dzeta;
+                 if(debug) cout << "omega = "<<omega*TMath::RadToDeg()<<"\tdzeta = "<<dzeta*TMath::RadToDeg()<<endl;
+                 // Formula from D.F. Smart *, M.A. Shea [2005]; A review of geomagnetic cutoff rigidities for earth-orbiting spacecraft
+                 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));
+                 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));
+                 if (debug) cout << "R = " << rig << "\tcutoff = " << t_orb->cutoff << endl;
+                 //
+                 if ( t_orb->pitch != t_orb->pitch ) t_orb->pitch = -1000.;
+                 if ( t_orb->cutoff != t_orb->cutoff ) t_orb->cutoff = -1000.;
+                 if ( t_orb->sunangle != t_orb->sunangle ) t_orb->sunangle = -1000.;
+                 if ( t_orb->sunmagangle != t_orb->sunmagangle ) t_orb->sunmagangle = -1000.;
+                 //
+                 if ( debug ) printf(" orbitalinfo->cutoffsvl %f vitaly %f \n",orbitalinfo->cutoffsvl,t_orb->cutoff);
+                 //
+                 TClonesArray &tt3 = *torbExtTrk;
+                 new(tt3[ttentry]) OrbitalInfoTrkVar(*t_orb);
+                 ttentry++;
+                 //
+                 t_orb->Clear();
+                 //
+               }
+               //
+             }
+           } // end standard tracking algorithm: extended
          } else {
-           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);
-         };
+         }
          //
-       };
+       } else { // HERE IT MISS ALL CODE FOR EXTENDED TRACKING!
+         if ( !standalone ){
+           //
+           if ( verbose ) printf(" no orb info for tracks \n");
+           Int_t nn = 0;
+           for(Int_t nt=0; nt < tof->ntrk(); nt++){
+             //
+             ToFTrkVar *ptt = tof->GetToFTrkVar(nt);
+             if ( ptt->trkseqno != -1  ){
+               //
+               t_orb->trkseqno = ptt->trkseqno;
+               //
+               t_orb->Eij = 0;
+               //
+               t_orb->Sij = 0;
+               //
+               t_orb->pitch = -1000.;
+               //
+               t_orb->sunangle = -1000.;
+               //
+               t_orb->sunmagangle = -1000;
+               //
+               t_orb->cutoff = -1000.;
+               //
+               new(tor[nn]) OrbitalInfoTrkVar(*t_orb);
+               nn++;
+               //
+               t_orb->Clear();
+               //
+             }
+             //
+           }
+           //
+           // Code for extended tracking algorithm:
+           //
+           if ( hasNucleiTrk ){
+             Int_t ttentry = 0;
+             if ( verbose ) printf(" hasNucleiTrk \n");
+             for(Int_t nt=0; nt < tcNucleiTof->GetEntries() ; nt++){
+               //
+               ToFTrkVar *ptt = (ToFTrkVar*)(tcNucleiTof->At(nt));
+               if ( ptt->trkseqno != -1  ){
+                 //
+                 t_orb->trkseqno = ptt->trkseqno;
+                 //
+                 t_orb->Eij = 0;
+                 //
+                 t_orb->Sij = 0;
+                 //
+                 t_orb->pitch = -1000.;
+                 //
+                 t_orb->sunangle = -1000.;
+                 //
+                 t_orb->sunmagangle = -1000;
+                 //
+                 t_orb->cutoff = -1000.;
+                 //
+                 TClonesArray &tz1 = *torbNucleiTrk;
+                 new(tz1[ttentry]) OrbitalInfoTrkVar(*t_orb);
+                 ttentry++;
+                 //
+                 t_orb->Clear();
+                 //
+               }
+               //
+             }
+           }
+           if ( hasExtNucleiTrk ){
+             Int_t ttentry = 0;
+             if ( verbose ) printf(" hasExtNucleiTrk \n");
+             for(Int_t nt=0; nt < tcExtNucleiTof->GetEntries() ; nt++){
+               //
+               if ( verbose ) printf(" got2\n");
+               ToFTrkVar *ptt = (ToFTrkVar*)(tcExtNucleiTof->At(nt));
+               if ( ptt->trkseqno != -1  ){
+                 //
+                 t_orb->trkseqno = ptt->trkseqno;
+                 //
+                 t_orb->Eij = 0;
+                 //
+                 t_orb->Sij = 0;
+                 //
+                 t_orb->pitch = -1000.;
+                 //
+                 t_orb->sunangle = -1000.;
+                 //
+                 t_orb->sunmagangle = -1000;
+                 //
+                 t_orb->cutoff = -1000.;
+                 //
+                 TClonesArray &tz2 = *torbExtNucleiTrk;
+                 new(tz2[ttentry]) OrbitalInfoTrkVar(*t_orb);
+                 ttentry++;
+                 //
+                 t_orb->Clear();
+                 //
+               }
+               //
+             }
+           }
+           if ( hasExtTrk ){
+             Int_t ttentry = 0;
+             if ( verbose ) printf(" hasExtTrk \n");
+             for(Int_t nt=0; nt < tcExtTof->GetEntries() ; nt++){
+               //
+               if ( verbose ) printf(" got3\n");
+               ToFTrkVar *ptt = (ToFTrkVar*)(tcExtTof->At(nt));
+               if ( ptt->trkseqno != -1  ){
+                 //
+                 t_orb->trkseqno = ptt->trkseqno;
+                 //
+                 t_orb->Eij = 0;
+                 //
+                 t_orb->Sij = 0;
+                 //
+                 t_orb->pitch = -1000.;
+                 //
+                 t_orb->sunangle = -1000.;
+                 //
+                 t_orb->sunmagangle = -1000;
+                 //
+                 t_orb->cutoff = -1000.;
+                 //
+                 TClonesArray &tz3 = *torbExtNucleiTrk;
+                 new(tz3[ttentry]) OrbitalInfoTrkVar(*t_orb);
+                 ttentry++;
+                 //
+                 t_orb->Clear();
+                 //
+               }
+               //
+             }
+           }
+         }
+       } // if( orbitalinfo->TimeGap>0){
        //
        // Fill the class
        //
-Line 1056 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 2127 
 int OrbitalInfoCore(UInt_t run, TFile *f
      //
      // Here you may want to clear some variables before processing another run
      //
+     if ( verbose ) printf(" Clear before new run \n");
      delete dbtime;
-     if ( L_QQ_Q_l_upper ) delete L_QQ_Q_l_upper;
+     if ( mcmdrc ) mcmdrc->Clear();
+     mcmdrc = 0;
+     if ( verbose ) printf(" Clear before new run1 \n");
      if ( L_QQ_Q_l_lower ) delete L_QQ_Q_l_lower;
+     if ( verbose ) printf(" Clear before new run2 \n");
+     if ( L_QQ_Q_l_upper ) delete L_QQ_Q_l_upper;
+     if ( verbose ) printf(" Clear before new run3 \n");
      if ( RYPang_upper ) delete RYPang_upper;
+     if ( verbose ) printf(" Clear before new run4 \n");
      if ( RYPang_lower ) delete RYPang_lower;
+     if ( l0tr ) l0tr->Delete();
+     if ( verbose ) printf(" End run \n");
    }; // process all the runs
    if (verbose) printf("\n Finished processing data \n");
-Line 1080 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 2166 
 int OrbitalInfoCore(UInt_t run, TFile *f
          //
          // Get entry from old tree
          //
-         OrbitalInfotrclone->GetEntry(j);
+         if ( OrbitalInfotrclone->GetEntry(j) <= 0 ) throw -36;
          //
          // copy orbitalinfoclone to OrbitalInfo
          //
-         orbitalinfo->Clear();
+         //      orbitalinfo->Clear();
          //
          memcpy(&orbitalinfo,&orbitalinfoclone,sizeof(orbitalinfoclone));
          //
-Line 1094 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 2180 
 int OrbitalInfoCore(UInt_t run, TFile *f
        };
        if (verbose) printf(" Finished successful copying!\n");
      };
+     //if ( OrbitalInfotrclone )    OrbitalInfotrclone->Clear();
+     //if ( OrbitalInfotrclone )    OrbitalInfotrclone->Delete();
    };
    //
    // Close files, delete old tree(s), write and close level2 file
    //
    if ( l0File ) l0File->Close();
-   if ( tempfile ) tempfile->Close();
    if ( myfold ) gSystem->Unlink(tempname.str().c_str());
    //
-   if ( runinfo ) runinfo->Close();
    if ( OrbitalInfotr ) OrbitalInfotr->SetName("OrbitalInfo");
-   if ( tof ) tof->Delete();
-   if ( ttof ) ttof->Delete();
    //
    if ( file ){
      file->cd();
-     file->Write();
+     if ( OrbitalInfotr ) OrbitalInfotr->Write("OrbitalInfo", TObject::kOverwrite); // 10 RED bug fixed
    };
    //
+   if (verbose) printf("\n Exiting...\n");
    if ( myfold ) gSystem->Unlink(OrbitalInfofolder.str().c_str());
    //
    // the end
-Line 1120 
 int OrbitalInfoCore(UInt_t run, TFile *f
+Line 2207 
 int OrbitalInfoCore(UInt_t run, TFile *f
      dbc->Close();
      delete dbc;
    };
-   if (verbose) printf("\n Exiting...\n");
-   if(OrbitalInfotr)OrbitalInfotr->Delete();
    //
+   if (verbose) printf("\n Exiting...\n");
+   if ( tempfile ) tempfile->Close();
    if ( PO ) delete PO;
-   if ( orbitalinfo ) delete orbitalinfo;
+   if ( gltle ) delete gltle;
-   if ( orbitalinfoclone ) delete orbitalinfoclone;
+   if ( glparam ) delete glparam;
+   if ( glparam2 ) delete glparam2;
+   if ( glparam3 ) delete glparam3;
+   if (verbose) printf("\n Exiting3...\n");
    if ( glroot ) delete glroot;
+   if (verbose) printf("\n Exiting4...\n");
+   if ( runinfo ) runinfo->Close();
    if ( runinfo ) delete runinfo;
+   if ( tcNucleiTrk ){
+     tcNucleiTrk->Delete();
+     delete tcNucleiTrk;
+     tcNucleiTrk = NULL;
+   }
+   if ( tcExtNucleiTrk ){
+     tcExtNucleiTrk->Delete();
+     delete tcExtNucleiTrk;
+     tcExtNucleiTrk = NULL;
+   }
+   if ( tcExtTrk ){
+     tcExtTrk->Delete();
+     delete tcExtTrk;
+     tcExtTrk = NULL;
+   }
+   if ( tcNucleiTof ){
+     tcNucleiTof->Delete();
+     delete tcNucleiTof;
+     tcNucleiTof = NULL;
+   }
+   if ( tcExtNucleiTof ){
+     tcExtNucleiTof->Delete();
+     delete tcExtNucleiTof;
+     tcExtNucleiTof = NULL;
+   }
+   if ( tcExtTof ){
+     tcExtTof->Delete();
+     delete tcExtTof;
+     tcExtTrk = NULL;
+   }
+   if ( tof ) delete tof;
+   if ( trke ) delete trke;
+   if ( debug ){
+   cout << "1   0x" << OrbitalInfotr << endl;
+   cout << "2   0x" << OrbitalInfotrclone << endl;
+   cout << "3   0x" << l0tr << endl;
+   cout << "4   0x" << tempOrbitalInfo << endl;
+   cout << "5   0x" << ttof << endl;
+   }
+   //
+   if ( debug )  file->ls();
    //
    if(code < 0)  throw code;
    return(code);
-Line 1172 
 void CopyAng(InclinationInfo *A1, Inclin
+Line 2311 
 void CopyAng(InclinationInfo *A1, Inclin
  UInt_t holeq(Double_t lower,Double_t upper,Quaternions *Qlower, Quaternions *Qupper, UInt_t f){
    UInt_t hole = 10;
-   bool R10l = false;     // Sign of R10 mode in lower quaternions array
+   Bool_t R10l = false;     // Sign of R10 mode in lower quaternions array
-   bool R10u = false;     // Sign of R10 mode in upper quaternions array
+   Bool_t R10u = false;     // Sign of R10 mode in upper quaternions array
-   bool insm = false;     // Sign that we inside quaternions array
+   Bool_t insm = false;     // Sign that we inside quaternions array
-   bool mxtml = false;    // Sign of mixt mode in lower quaternions array
+   //  Bool_t mxtml = false;    // Sign of mixt mode in lower quaternions array
-   bool mxtmu = false;    // Sign of mixt mode in upper quaternions array
+   //  Bool_t mxtmu = false;    // Sign of mixt mode in upper quaternions array
-   bool 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
    UInt_t NCQl = 6;       // Number of correct quaternions in lower array
-   UInt_t NCQu = 6;       // Number of correct quaternions in upper array
+   //  UInt_t NCQu = 6;       // Number of correct quaternions in upper array
    if (f>0){
      insm = true;
      if(Qupper->time[f]-Qupper->time[f-1]==30) R10u = false;
-Line 1191 
 UInt_t holeq(Double_t lower,Double_t upp
+Line 2330 
 UInt_t holeq(Double_t lower,Double_t upp
      if((Qlower->time[5]-Qlower->time[0]==150)&&(Qlower->time[1]-Qlower->time[0]==30)) R10l = false;
      if((Qupper->time[5]-Qupper->time[0]==150)&&(Qupper->time[1]-Qupper->time[0]==30)) R10u = false;
      if((Qlower->time[5]-Qlower->time[0]<2)&&(Qlower->time[1]-Qlower->time[0]==30)){
-       mxtml = true;
+       //      mxtml = true;
        for(UInt_t i = 1; i < 6; i++){
          if(Qlower->time[i]-Qlower->time[0]==30*i) NCQl=i;
        }
      }
-     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)){
-       mxtmu = true;
+       //      mxtmu = true;
-       for(UInt_t i = 1; i < 6; i++){
+       //      for(UInt_t i = 1; i < 6; i++){
-         if(Qupper->time[i]-Qupper->time[0]==30*i) NCQu=i;
+       //        if(Qupper->time[i]-Qupper->time[0]==30*i) NCQu=i;
-       }
+       //      }
-     }
+     //    }
    }
    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 1220 
 UInt_t holeq(Double_t lower,Double_t upp
+Line 2359 
 UInt_t holeq(Double_t lower,Double_t upp
    return hole;
  }
+ void inclresize(vector<Double_t>& t,vector<Float_t>& q0,vector<Float_t>& q1,vector<Float_t>& q2,vector<Float_t>& q3,vector<Int_t>& mode,vector<Float_t>& Roll,vector<Float_t>& Pitch,vector<Float_t>& Yaw){
+   Int_t sizee = t.size()+1;
+   t.resize(sizee);
+   q0.resize(sizee);
+   q1.resize(sizee);
+   q2.resize(sizee);
+   q3.resize(sizee);
+   mode.resize(sizee);
+   Roll.resize(sizee);
+   Pitch.resize(sizee);
+   Yaw.resize(sizee);
+ }
+ // geomagnetic calculation staff
+ //void GM_ScanIGRF(TString PATH, GMtype_Data *G0, GMtype_Data *G1, GMtype_Data *H1)
+ void GM_ScanIGRF(TSQLServer *dbc, GMtype_Data *G0, GMtype_Data *G1, GMtype_Data *H1)
+ {
+   GL_PARAM *glp = new GL_PARAM();
+   Int_t parerror=glp->Query_GL_PARAM(1,304,dbc); // parameters stored in DB in GL_PRAM table
+   if ( parerror<0 ) {
+     throw -902;
+   }
+         /*This function scans inputs G0, G1, and H1 of the IGRF table into 3 data arrays*/
+   //    TString SATH="/data03/Malakhov/pam9Malakhov/installed10/calib/orb-param/";
+         int i;
+         double temp;
+         char buffer[200];
+         FILE *IGRF;
+         IGRF = fopen((glp->PATH+glp->NAME).Data(), "r");
+         //      IGRF = fopen(PATH+"IGRF.tab", "r");
+         G0->size = 25;
+         G1->size = 25;
+         H1->size = 25;
+         for( i = 0; i < 4; i++)
+         {
+                 fgets(buffer, 200, IGRF);
+         }
+         fscanf(IGRF, "g 1 0 %lf ", &G0->element[0]);
+         for(i = 1; i <= 22; i++)
+         {
+                 fscanf(IGRF ,"%lf ", &G0->element[i]);
+         }
+         fscanf(IGRF ,"%lf\n", &temp);
+         G0->element[23] = temp * 5 + G0->element[22];
+         G0->element[24] = G0->element[23] + 5 * temp;
+         fscanf(IGRF, "g 1 1 %lf ", &G1->element[0]);
+         for(i = 1; i <= 22; i++)
+         {
+                 fscanf( IGRF, "%lf ", &G1->element[i]);
+         }
+         fscanf(IGRF, "%lf\n", &temp);
+         G1->element[23] = temp * 5 + G1->element[22];
+         G1->element[24] = temp * 5 + G1->element[23];
+         fscanf(IGRF, "h 1 1 %lf ", &H1->element[0]);
+         for(i = 1; i <= 22; i++)
+         {
+                 fscanf( IGRF, "%lf ", &H1->element[i]);
+         }
+         fscanf(IGRF, "%lf\n", &temp);
+         H1->element[23] = temp * 5 + H1->element[22];
+         H1->element[24] = temp * 5 + H1->element[23];
+   if ( glp ) delete glp;
+ } /*GM_ScanIGRF*/
+ void GM_SetEllipsoid(GMtype_Ellipsoid *Ellip)
+ {
+         /*This function sets the WGS84 reference ellipsoid to its default values*/
+         Ellip->a        =                       6378.137; /*semi-major axis of the ellipsoid in */
+         Ellip->b        =                       6356.7523142;/*semi-minor axis of the ellipsoid in */
+         Ellip->fla      =                       1/298.257223563;/* flattening */
+         Ellip->eps      =                       sqrt(1- ( Ellip->b *    Ellip->b) / (Ellip->a * Ellip->a ));  /*first eccentricity */
+         Ellip->epssq    =                       (Ellip->eps * Ellip->eps);   /*first eccentricity squared */
+         Ellip->re       =                       6371.2;/* Earth's radius */
+ } /*GM_SetEllipsoid*/
+ void GM_EarthCartToDipoleCartCD(GMtype_Pole Pole, GMtype_CoordCartesian EarthCoord, GMtype_CoordCartesian *DipoleCoords)
+ {
+         /*This function converts from Earth centered cartesian coordinates to dipole centered cartesian coordinates*/
+         double X, Y, Z, CosPhi, SinPhi, CosLambda, SinLambda;
+         CosPhi = cos(TMath::DegToRad()*Pole.phi);
+         SinPhi = sin(TMath::DegToRad()*Pole.phi);
+         CosLambda = cos(TMath::DegToRad()*Pole.lambda);
+         SinLambda = sin(TMath::DegToRad()*Pole.lambda);
+         X = EarthCoord.x;
+         Y = EarthCoord.y;
+         Z = EarthCoord.z;
+         /*These equations are taken from a document by Wallace H. Campbell*/
+         DipoleCoords->x = X * CosPhi * CosLambda + Y * CosPhi * SinLambda - Z * SinPhi;
+         DipoleCoords->y = -X * SinLambda + Y * CosLambda;
+         DipoleCoords->z = X * SinPhi * CosLambda + Y * SinPhi * SinLambda + Z * CosPhi;
+ } /*GM_EarthCartToDipoleCartCD*/
+ void GM_GeodeticToSpherical(GMtype_Ellipsoid Ellip, GMtype_CoordGeodetic CoordGeodetic, GMtype_CoordSpherical *CoordSpherical)
+ {
+         double CosLat, SinLat, rc, xp, zp; /*all local variables */
+         /*
+         ** Convert geodetic coordinates, (defined by the WGS-84
+         ** reference ellipsoid), to Earth Centered Earth Fixed Cartesian
+         ** coordinates, and then to spherical coordinates.
+         */
+         CosLat = cos(TMath::DegToRad()*CoordGeodetic.phi);
+         SinLat = sin(TMath::DegToRad()*CoordGeodetic.phi);
+         /* compute the local radius of curvature on the WGS-84 reference ellipsoid */
+         rc = Ellip.a / sqrt(1.0 - Ellip.epssq * SinLat * SinLat);
+         /* compute ECEF Cartesian coordinates of specified point (for longitude=0) */
+         xp = (rc + CoordGeodetic.HeightAboveEllipsoid) * CosLat;
+         zp = (rc*(1.0 - Ellip.epssq) + CoordGeodetic.HeightAboveEllipsoid) * SinLat;
+         /* compute spherical radius and angle lambda and phi of specified point */
+         CoordSpherical->r = sqrt(xp * xp + zp * zp);
+         CoordSpherical->phig = TMath::RadToDeg()*asin(zp / CoordSpherical->r);     /* geocentric latitude */
+         CoordSpherical->lambda = CoordGeodetic.lambda;                   /* longitude */
+ } /*GM_GeodeticToSpherical*/
+ void GM_PoleLocation(GMtype_Model Model, GMtype_Pole *Pole)
+ {
+         /*This function finds the location of the north magnetic pole in spherical coordinates.  The equations are
+         **from Wallace H. Campbell's Introduction to Geomagnetic Fields*/
+         Pole->phi = TMath::RadToDeg()*-atan(sqrt(Model.h1 * Model.h1 + Model.g1 * Model.g1)/Model.g0);
+         Pole->lambda = TMath::RadToDeg()*atan(Model.h1/Model.g1);
+ } /*GM_PoleLocation*/
+ void GM_SphericalToCartesian(GMtype_CoordSpherical CoordSpherical, GMtype_CoordCartesian *CoordCartesian)
+ {
+         /*This function converts spherical coordinates into Cartesian coordinates*/
+         double CosPhi = cos(TMath::DegToRad()*CoordSpherical.phig);
+         double SinPhi = sin(TMath::DegToRad()*CoordSpherical.phig);
+         double CosLambda = cos(TMath::DegToRad()*CoordSpherical.lambda);
+         double SinLambda = sin(TMath::DegToRad()*CoordSpherical.lambda);
+         CoordCartesian->x = CoordSpherical.r * CosPhi * CosLambda;
+         CoordCartesian->y = CoordSpherical.r * CosPhi * SinLambda;
+         CoordCartesian->z = CoordSpherical.r * SinPhi;
+ } /*GM_SphericalToCartesian*/
+ void GM_TimeAdjustCoefs(Float_t year, Float_t jyear, GMtype_Data g0d, GMtype_Data g1d, GMtype_Data h1d, GMtype_Model *Model)
+ {
+         /*This function calls GM_LinearInterpolation for the coefficients to estimate the value of the
+         **coefficient for the given date*/
+         int index;
+         double x;
+         index = (year - GM_STARTYEAR) / 5;
+         x = (jyear - GM_STARTYEAR) / 5;
+         Model->g0 = GM_LinearInterpolation(index, index+1, g0d.element[index], g0d.element[index+1], x);
+         Model->g1 = GM_LinearInterpolation(index, index+1, g1d.element[index], g1d.element[index+1], x);
+         Model->h1 = GM_LinearInterpolation(index, index+1, h1d.element[index], h1d.element[index+1], x);
+ } /*GM_TimeAdjustCoefs*/
+ double GM_LinearInterpolation(double x1, double x2, double y1, double y2, double x)
+ {
+         /*This function takes a linear interpolation between two given points for x*/
+         double weight, y;
+         weight  = (x - x1) / (x2 - x1);
+         y = y1 * (1 - weight) + y2 * weight;
+         return y;
+ }/*GM_LinearInterpolation*/
+ void GM_CartesianToSpherical(GMtype_CoordCartesian CoordCartesian, GMtype_CoordSpherical *CoordSpherical)
+ {
+         /*This function converts a point from Cartesian coordinates into spherical coordinates*/
+         double X, Y, Z;
+         X = CoordCartesian.x;
+         Y = CoordCartesian.y;
+         Z = CoordCartesian.z;
+         CoordSpherical->r = sqrt(X * X + Y * Y + Z * Z);
+         CoordSpherical->phig = TMath::RadToDeg()*asin(Z / (CoordSpherical->r));
+         CoordSpherical->lambda = TMath::RadToDeg()*atan2(Y, X);
+ } /*GM_CartesianToSpherical*/

 Legend:



Removed from v.1.30
 


changed lines


 
Added in v.1.78
 Legend:



Removed from v.1.30
 


changed lines


 
Added in v.1.78
-Removed from v.1.30
+Added in v.1.78

	ViewVC Help
Powered by ViewVC 1.1.23