OrbitalInfo/src/OrbitalInfo.cpp

#include <OrbitalInfo.h>

using namespace std;

ClassImp(OrbitalInfoTrkVar);
ClassImp(OrbitalInfo);

OrbitalInfoTrkVar::OrbitalInfoTrkVar(){
  this->Clear();
  //  Eij = new TMatrixD(3,3);
  //  Sij = new TMatrixD(3,3);
}

void OrbitalInfoTrkVar::Clear(Option_t *t){
  trkseqno = 0;
  pitch = -1000.;
  sunangle = -1000;
  sunmagangle = -1000;
  cutoff = -1000.;
  Eij.Zero();
  Sij.Zero();
}

void OrbitalInfoTrkVar::Delete(Option_t *t){
  //  if ( Eij ) Eij->Delete();
  //  if ( Sij ) Sij->Delete();
}

OrbitalInfo::OrbitalInfo(){
  OrbitalInfoTrk = 0; //ELENA
  this->Clear();
}

OrbitalInfoTrkVar::OrbitalInfoTrkVar(const OrbitalInfoTrkVar &t){
  //
  trkseqno = t.trkseqno;  
  //
  pitch = t.pitch;
  cutoff = t.cutoff;
  sunangle=t.sunangle;
  sunmagangle=t.sunmagangle;
  //
  Eij.ResizeTo(t.Eij);  
  Eij = t.Eij;  
  Sij.ResizeTo(t.Sij);  
  Sij = t.Sij;  
  //
};

void OrbitalInfo::Delete(Option_t *t){ //ELENA
  //
  //  if ( Iij ) Iij->Delete();
  if(OrbitalInfoTrk){ 
    OrbitalInfoTrk->Delete(); //ELENA
    delete OrbitalInfoTrk;  //ELENA
  }
  // 
}; //ELENA

void OrbitalInfo::Set(){//ELENA
  if ( !OrbitalInfoTrk ) OrbitalInfoTrk = new TClonesArray("OrbitalInfoTrkVar",2); //ELENA}  
  //  if ( !Iij ) Iij = new TMatrixD(3,3);
}//ELENA
//--------------------------------------
//
//
//--------------------------------------
void OrbitalInfo::SetTrackArray(TClonesArray *track){//ELENA
//    if(track && strcmp(track->GetClass()->GetName(),"OrbitalInfoTrkVar")==0){
        if(OrbitalInfoTrk)OrbitalInfoTrk->Clear("C");
        OrbitalInfoTrk = track;
//    }
}

OrbitalInfoTrkVar *OrbitalInfo::GetOrbitalInfoTrkVar(Int_t itrk){
  //    
  if(itrk >= ntrk()){
    printf(" OrbitalInfo ERROR: track related variables set %i does not exists! \n",itrk);
    printf("                    stored track related variables = %i \n",ntrk());
    return(NULL);
  }  
  //
  if(!OrbitalInfoTrk)return 0; //ELENA
  TClonesArray &t = *(OrbitalInfoTrk);
  OrbitalInfoTrkVar *orbtrack = (OrbitalInfoTrkVar*)t[itrk];
  return orbtrack;
}
/**
 * Retrieves the tof track matching the seqno-th tracker stored track. 
 * 
 */
OrbitalInfoTrkVar *OrbitalInfo::GetOrbitalInfoStoredTrack(int seqno){

  if( ntrk()==0 ){
    printf("OrbitalInfo::GetOrbitalInfoStoredTrack(int) : requested tracker SeqNo %i but no OrbitalInforimeter tracks are stored\n",seqno);
    return NULL;
  };
  
  OrbitalInfoTrkVar *c = 0;
  Int_t it_tof=0;
     
  do { 
    c = GetOrbitalInfoTrkVar(it_tof);
    it_tof++; 
  } while( c && seqno != c->trkseqno && it_tof < ntrk());       
  
  if(!c || seqno != c->trkseqno){
    c = 0;
    if(seqno!=-1 ) printf("OrbitalInfo::GetOrbitalInfoStoredTrack(int) : requested tracker SeqNo %i does not match OrbitalInfo stored tracks\n",seqno);
  };
  return c;
     
}

void OrbitalInfo::Clear(Option_t *t){
  //
  if ( OrbitalInfoTrk ) OrbitalInfoTrk->Delete();
  //
  absTime = 0;
  OBT = 0;
  pkt_num = 0;

  lon = -1000.;
  lat = -1000.;
  alt = -1000.;
  V.SetXYZ(-1000.,-1000.,-1000.);

  Bnorth = -1000.;
  Beast = -1000.;
  Bdown = -1000.;
  Babs = -1000.;
  M = -1000;
  BB0 = -1000.;
  L = -1000.;

   londip = -1000.;
   latdip = -1000.;

  //  std::fill_n(cutoff, 20, 0.);
  //  std::fill_n(cutoff, 2, 0.);
  cutoffsvl = 0.;

  // Quaternions
  q0 = -1000.;
  q1 = -1000.;
  q2 = -1000.;
  q3 = -1000.;

  // Euler angles (nadir reference frame)
  theta = -1000.;
  phi = -1000.;
  etha = -1000.;

  Iij.Zero();

  mode = 0;
  qkind = -1000;
  errq =  -1000;
  azim =  -1000;
  //  std::fill_n(goodAttitude, 5, 0);
}

/**
 * Fills a struct cOrbitalInfo with values from a OrbitalInfo object (to put data into a F77 common).
 */
void OrbitalInfo::GetLevel2Struct(cOrbitalInfo *l2) const{
  l2->abstime  = absTime;
  l2->obt      = OBT;
  l2->pkt_num  = pkt_num;

  l2->lon = lon;
  l2->lat = lat;
  l2->alt = alt;
  l2->V = V;

  l2->Bnorth = Bnorth;
  l2->Beast = Beast;
  l2->Bdown = Bdown;
  l2->Babs = Babs;
  l2->M = M;
  l2->BB0 = BB0;
  l2->L = L;

   l2->londip = londip;
   l2->latdip = latdip;

  l2->cutoffsvl = cutoffsvl;
//  memcpy(l2->cutoffsvl, cutoffsvl, sizeof(cutoffsvl));

  // Quaternions
  l2->q0 = q0;
  l2->q1 = q1;
  l2->q2 = q2;
  l2->q3 = q3;

  // Euler angles (nadir reference frame)
  l2->theta = theta;
  l2->phi = phi;
  l2->etha = etha;

  l2->mode = mode;
  l2->qkind = qkind;
  l2->errq = errq;
  l2->azim = azim;

//   memcpy(l2->goodAttitude, goodAttitude, sizeof(goodAttitude));
}

void OrbitalInfo::SetFromLevel2Struct(cOrbitalInfo *l2){
  absTime  = l2->abstime;
  OBT      = l2->obt;
  pkt_num  = l2->pkt_num;

  lon = l2->lon;
  lat = l2->lat;
  alt = l2->alt;
  V = l2->V;

  l2->Bnorth = Bnorth;
  l2->Beast = Beast;
  l2->Bdown = Bdown;
  l2->Babs = Babs;
  M = l2->M;
  BB0 = l2->BB0;
  L = l2->L;

   londip = l2->londip;
   latdip = l2->latdip;

//  memcpy(cutoff, l2->cutoff, sizeof(l2->cutoff));
  l2->cutoffsvl = cutoffsvl;

  // Quaternions
  q0 = l2->q0;
  q1 = l2->q1;
  q2 = l2->q2;
  q3 = l2->q3;

  // Euler angles (nadir reference frame)
  theta = l2->theta;
  phi = l2->phi;
  etha = l2->etha;

  mode = l2->mode;
  qkind = l2->qkind;
  errq = l2->errq;
  azim = l2->azim;

//   memcpy(goodAttitude, l2->goodAttitude, sizeof(l2->goodAttitude));
}

1	mocchiut	1.1	#include <OrbitalInfo.h>
2
3	mocchiut	1.11	using namespace std;
4	pam-rm2	1.6
5	mocchiut	1.11	ClassImp(OrbitalInfoTrkVar);
6			ClassImp(OrbitalInfo);
7	pam-rm2	1.6
8	mocchiut	1.11	OrbitalInfoTrkVar::OrbitalInfoTrkVar(){
9			this->Clear();
10	mocchiut	1.13	// Eij = new TMatrixD(3,3);
11			// Sij = new TMatrixD(3,3);
12	mocchiut	1.11	}
13	pam-rm2	1.6
14	mocchiut	1.11	void OrbitalInfoTrkVar::Clear(Option_t *t){
15			trkseqno = 0;
16			pitch = -1000.;
17	pam-mep	1.16	sunangle = -1000;
18			sunmagangle = -1000;
19	mocchiut	1.14	cutoff = -1000.;
20	mocchiut	1.13	Eij.Zero();
21			Sij.Zero();
22	mocchiut	1.11	}
23	pam-rm2	1.6
24	mocchiut	1.13	void OrbitalInfoTrkVar::Delete(Option_t *t){
25			// if ( Eij ) Eij->Delete();
26			// if ( Sij ) Sij->Delete();
27			}
28	pam-rm2	1.6
29	mocchiut	1.11	OrbitalInfo::OrbitalInfo(){
30			OrbitalInfoTrk = 0; //ELENA
31			this->Clear();
32			}
33	pam-rm2	1.6
34	mocchiut	1.14	OrbitalInfoTrkVar::OrbitalInfoTrkVar(const OrbitalInfoTrkVar &t){
35			//
36			trkseqno = t.trkseqno;
37			//
38			pitch = t.pitch;
39			cutoff = t.cutoff;
40	pam-mep	1.16	sunangle=t.sunangle;
41			sunmagangle=t.sunmagangle;
42	mocchiut	1.14	//
43			Eij.ResizeTo(t.Eij);
44			Eij = t.Eij;
45			Sij.ResizeTo(t.Sij);
46			Sij = t.Sij;
47			//
48			};
49
50	mocchiut	1.11	void OrbitalInfo::Delete(Option_t *t){ //ELENA
51			//
52	mocchiut	1.13	// if ( Iij ) Iij->Delete();
53	mocchiut	1.11	if(OrbitalInfoTrk){
54			OrbitalInfoTrk->Delete(); //ELENA
55			delete OrbitalInfoTrk; //ELENA
56			}
57			//
58			}; //ELENA
59
60			void OrbitalInfo::Set(){//ELENA
61	mocchiut	1.13	if ( !OrbitalInfoTrk ) OrbitalInfoTrk = new TClonesArray("OrbitalInfoTrkVar",2); //ELENA}
62			// if ( !Iij ) Iij = new TMatrixD(3,3);
63	mocchiut	1.11	}//ELENA
64	pam-fi	1.17	//--------------------------------------
65			//
66			//
67			//--------------------------------------
68			void OrbitalInfo::SetTrackArray(TClonesArray *track){//ELENA
69			// if(track && strcmp(track->GetClass()->GetName(),"OrbitalInfoTrkVar")==0){
70			if(OrbitalInfoTrk)OrbitalInfoTrk->Clear("C");
71			OrbitalInfoTrk = track;
72			// }
73			}
74	mocchiut	1.1
75	mocchiut	1.12	OrbitalInfoTrkVar *OrbitalInfo::GetOrbitalInfoTrkVar(Int_t itrk){
76			//
77			if(itrk >= ntrk()){
78			printf(" OrbitalInfo ERROR: track related variables set %i does not exists! \n",itrk);
79			printf(" stored track related variables = %i \n",ntrk());
80			return(NULL);
81			}
82			//
83			if(!OrbitalInfoTrk)return 0; //ELENA
84			TClonesArray &t = *(OrbitalInfoTrk);
85			OrbitalInfoTrkVar orbtrack = (OrbitalInfoTrkVar)t[itrk];
86			return orbtrack;
87			}
88	pam-fi	1.17	/**
89			* Retrieves the tof track matching the seqno-th tracker stored track.
90			*
91			*/
92			OrbitalInfoTrkVar *OrbitalInfo::GetOrbitalInfoStoredTrack(int seqno){
93
94			if( ntrk()==0 ){
95			printf("OrbitalInfo::GetOrbitalInfoStoredTrack(int) : requested tracker SeqNo %i but no OrbitalInforimeter tracks are stored\n",seqno);
96			return NULL;
97			};
98
99			OrbitalInfoTrkVar *c = 0;
100			Int_t it_tof=0;
101
102			do {
103			c = GetOrbitalInfoTrkVar(it_tof);
104			it_tof++;
105			} while( c && seqno != c->trkseqno && it_tof < ntrk());
106
107			if(!c \|\| seqno != c->trkseqno){
108			c = 0;
109			if(seqno!=-1 ) printf("OrbitalInfo::GetOrbitalInfoStoredTrack(int) : requested tracker SeqNo %i does not match OrbitalInfo stored tracks\n",seqno);
110			};
111			return c;
112
113			}
114	mocchiut	1.1
115	mocchiut	1.10	void OrbitalInfo::Clear(Option_t *t){
116	mocchiut	1.11	//
117			if ( OrbitalInfoTrk ) OrbitalInfoTrk->Delete();
118			//
119	mocchiut	1.5	absTime = 0;
120			OBT = 0;
121			pkt_num = 0;
122	pam-rm2	1.6
123			lon = -1000.;
124			lat = -1000.;
125			alt = -1000.;
126	pam-mep	1.16	V.SetXYZ(-1000.,-1000.,-1000.);
127	pam-rm2	1.6
128			Bnorth = -1000.;
129			Beast = -1000.;
130			Bdown = -1000.;
131			Babs = -1000.;
132	pam-mep	1.15	M = -1000;
133	pam-rm2	1.6	BB0 = -1000.;
134			L = -1000.;
135
136	pam-mep	1.16	londip = -1000.;
137			latdip = -1000.;
138	mocchiut	1.13
139			// std::fill_n(cutoff, 20, 0.);
140			// std::fill_n(cutoff, 2, 0.);
141			cutoffsvl = 0.;
142	pam-rm2	1.6
143			// Quaternions
144			q0 = -1000.;
145			q1 = -1000.;
146			q2 = -1000.;
147			q3 = -1000.;
148
149			// Euler angles (nadir reference frame)
150	mocchiut	1.8	theta = -1000.;
151			phi = -1000.;
152			etha = -1000.;
153	pam-rm2	1.6
154	mocchiut	1.13	Iij.Zero();
155	mocchiut	1.11
156	mocchiut	1.9	mode = 0;
157	pam-mep	1.16	qkind = -1000;
158			errq = -1000;
159			azim = -1000;
160	mocchiut	1.9	// std::fill_n(goodAttitude, 5, 0);
161	mocchiut	1.3	}
162
163	pam-fi	1.4	/**
164			* Fills a struct cOrbitalInfo with values from a OrbitalInfo object (to put data into a F77 common).
165			*/
166			void OrbitalInfo::GetLevel2Struct(cOrbitalInfo *l2) const{
167			l2->abstime = absTime;
168			l2->obt = OBT;
169			l2->pkt_num = pkt_num;
170	pam-rm2	1.6
171			l2->lon = lon;
172			l2->lat = lat;
173			l2->alt = alt;
174	pam-mep	1.16	l2->V = V;
175	pam-rm2	1.6
176			l2->Bnorth = Bnorth;
177			l2->Beast = Beast;
178			l2->Bdown = Bdown;
179			l2->Babs = Babs;
180	pam-mep	1.15	l2->M = M;
181	pam-rm2	1.6	l2->BB0 = BB0;
182			l2->L = L;
183
184	pam-mep	1.16	l2->londip = londip;
185			l2->latdip = latdip;
186	pam-rm2	1.6
187	mocchiut	1.13	l2->cutoffsvl = cutoffsvl;
188			// memcpy(l2->cutoffsvl, cutoffsvl, sizeof(cutoffsvl));
189	pam-rm2	1.6
190			// Quaternions
191			l2->q0 = q0;
192			l2->q1 = q1;
193			l2->q2 = q2;
194			l2->q3 = q3;
195
196			// Euler angles (nadir reference frame)
197	mocchiut	1.8	l2->theta = theta;
198			l2->phi = phi;
199			l2->etha = etha;
200	pam-rm2	1.6
201	mocchiut	1.9	l2->mode = mode;
202	pam-mep	1.16	l2->qkind = qkind;
203			l2->errq = errq;
204			l2->azim = azim;
205	pam-rm2	1.6
206	mocchiut	1.9	// memcpy(l2->goodAttitude, goodAttitude, sizeof(goodAttitude));
207	pam-fi	1.4	}
208
209			void OrbitalInfo::SetFromLevel2Struct(cOrbitalInfo *l2){
210			absTime = l2->abstime;
211			OBT = l2->obt;
212			pkt_num = l2->pkt_num;
213	pam-rm2	1.6
214			lon = l2->lon;
215			lat = l2->lat;
216			alt = l2->alt;
217	pam-mep	1.16	V = l2->V;
218	pam-rm2	1.6
219			l2->Bnorth = Bnorth;
220			l2->Beast = Beast;
221			l2->Bdown = Bdown;
222			l2->Babs = Babs;
223	pam-mep	1.15	M = l2->M;
224	pam-rm2	1.6	BB0 = l2->BB0;
225			L = l2->L;
226
227	pam-mep	1.16	londip = l2->londip;
228			latdip = l2->latdip;
229	pam-rm2	1.6
230	mocchiut	1.13	// memcpy(cutoff, l2->cutoff, sizeof(l2->cutoff));
231			l2->cutoffsvl = cutoffsvl;
232	pam-rm2	1.6
233			// Quaternions
234			q0 = l2->q0;
235			q1 = l2->q1;
236			q2 = l2->q2;
237			q3 = l2->q3;
238
239			// Euler angles (nadir reference frame)
240	mocchiut	1.8	theta = l2->theta;
241			phi = l2->phi;
242			etha = l2->etha;
243	pam-rm2	1.6
244	mocchiut	1.9	mode = l2->mode;
245	pam-mep	1.16	qkind = l2->qkind;
246			errq = l2->errq;
247			azim = l2->azim;
248	pam-rm2	1.6
249	mocchiut	1.9	// memcpy(goodAttitude, l2->goodAttitude, sizeof(l2->goodAttitude));
250	pam-fi	1.4	}
251