--- DarthVader/OrbitalInfo/src/OrbitalInfo.cpp 2007/03/15 12:42:47 1.7 +++ DarthVader/OrbitalInfo/src/OrbitalInfo.cpp 2014/03/28 20:47:15 1.16 @@ -1,56 +1,85 @@ #include -OrbitalInfo::OrbitalInfo(){ - absTime = 0; - OBT = 0; - pkt_num = 0; - - lon = 0.; - lat = 0.; - alt = 0.; - - Bnorth = 0.; - Beast = 0.; - Bdown = 0.; - Babs = 0.; - BB0 = 0.; - L = 0.; - - londip = -1000.; - latdip = -1000.; - altdip = -1000.; - - loncgm = -1000.; - latcgm = -1000.; - altcgm = -1000.; - - loncbm = -1000.; - latcbm = -1000.; - altcbm = -1000.; +using namespace std; - std::fill_n(cutoff, 20, 0.); +ClassImp(OrbitalInfoTrkVar); +ClassImp(OrbitalInfo); - // Quaternions - q0 = -1000.; - q1 = -1000.; - q2 = -1000.; - q3 = -1000.; +OrbitalInfoTrkVar::OrbitalInfoTrkVar(){ + this->Clear(); + // Eij = new TMatrixD(3,3); + // Sij = new TMatrixD(3,3); +} - // Euler angles (nadir reference frame) -// theta = -1000.; -// phi = -1000.; -// etha = -1000.; +void OrbitalInfoTrkVar::Clear(Option_t *t){ + trkseqno = 0; + pitch = -1000.; + sunangle = -1000; + sunmagangle = -1000; + cutoff = -1000.; + Eij.Zero(); + Sij.Zero(); +} - // Euler angles (local field reference frame) -// thetamag = -1000.; -// phimag = -1000.; -// ethamag = -1000.; +void OrbitalInfoTrkVar::Delete(Option_t *t){ + // if ( Eij ) Eij->Delete(); + // if ( Sij ) Sij->Delete(); +} - std::fill_n(goodAttitude, 5, 0); +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 + +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; +} -void OrbitalInfo::Clear(){ +void OrbitalInfo::Clear(Option_t *t){ + // + if ( OrbitalInfoTrk ) OrbitalInfoTrk->Delete(); + // absTime = 0; OBT = 0; pkt_num = 0; @@ -58,27 +87,22 @@ 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.; - altdip = -1000.; - - loncgm = -1000.; - latcgm = -1000.; - altcgm = -1000.; - - loncbm = -1000.; - latcbm = -1000.; - altcbm = -1000.; + londip = -1000.; + latdip = -1000.; - std::fill_n(cutoff, 20, 0.); + // std::fill_n(cutoff, 20, 0.); + // std::fill_n(cutoff, 2, 0.); + cutoffsvl = 0.; // Quaternions q0 = -1000.; @@ -87,16 +111,17 @@ q3 = -1000.; // Euler angles (nadir reference frame) - // theta = -1000.; - // phi = -1000.; - // etha = -1000.; - - // Euler angles (local field reference frame) - //thetamag = -1000.; - // phimag = -1000.; - //ethamag = -1000.; - - std::fill_n(goodAttitude, 5, 0); + theta = -1000.; + phi = -1000.; + etha = -1000.; + + Iij.Zero(); + + mode = 0; + qkind = -1000; + errq = -1000; + azim = -1000; + // std::fill_n(goodAttitude, 5, 0); } /** @@ -110,27 +135,21 @@ 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->altdip = altdip; - - l2->loncgm = loncgm; - l2->latcgm = latcgm; - l2->altcgm = altcgm; - - l2->loncbm = loncbm; - l2->latcbm = latcbm; - l2->altcbm = altcbm; + l2->londip = londip; + l2->latdip = latdip; - memcpy(l2->cutoff, cutoff, sizeof(cutoff)); + l2->cutoffsvl = cutoffsvl; +// memcpy(l2->cutoffsvl, cutoffsvl, sizeof(cutoffsvl)); // Quaternions l2->q0 = q0; @@ -139,16 +158,16 @@ l2->q3 = q3; // Euler angles (nadir reference frame) - // l2->theta = theta; - // l2->phi = phi; - // l2->etha = etha; - - // Euler angles (local field reference frame) - // l2->thetamag = thetamag; - // l2->phimag = phimag; - // l2->ethamag = ethamag; + 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)); +// memcpy(l2->goodAttitude, goodAttitude, sizeof(goodAttitude)); } void OrbitalInfo::SetFromLevel2Struct(cOrbitalInfo *l2){ @@ -159,27 +178,21 @@ 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; - altdip = l2->altdip; - - loncgm = l2->loncgm; - latcgm = l2->latcgm; - altcgm = l2->altcgm; - - loncbm = l2->loncbm; - latcbm = l2->latcbm; - altcbm = l2->altcbm; + londip = l2->londip; + latdip = l2->latdip; - memcpy(cutoff, l2->cutoff, sizeof(l2->cutoff)); +// memcpy(cutoff, l2->cutoff, sizeof(l2->cutoff)); + l2->cutoffsvl = cutoffsvl; // Quaternions q0 = l2->q0; @@ -188,16 +201,15 @@ q3 = l2->q3; // Euler angles (nadir reference frame) - //theta = l2->theta; - //phi = l2->phi; - //etha = l2->etha; - - // Euler angles (local field reference frame) - //thetamag = l2->thetamag; - //phimag = l2->phimag; - //ethamag = l2->ethamag; + 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)); +// memcpy(goodAttitude, l2->goodAttitude, sizeof(l2->goodAttitude)); } -ClassImp(OrbitalInfo)