--- DarthVader/OrbitalInfo/src/OrbitalInfo.cpp 2006/09/05 14:49:45 1.5 +++ DarthVader/OrbitalInfo/src/OrbitalInfo.cpp 2008/12/11 10:08:18 1.14 @@ -1,16 +1,134 @@ #include +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.; + cutoff = -1000.; + Eij.Zero(); + Sij.Zero(); +} + +void OrbitalInfoTrkVar::Delete(Option_t *t){ + // if ( Eij ) Eij->Delete(); + // if ( Sij ) Sij->Delete(); +} + OrbitalInfo::OrbitalInfo(){ - absTime = 0; - OBT = 0; - pkt_num = 0; + OrbitalInfoTrk = 0; //ELENA + this->Clear(); } +OrbitalInfoTrkVar::OrbitalInfoTrkVar(const OrbitalInfoTrkVar &t){ + // + trkseqno = t.trkseqno; + // + pitch = t.pitch; + cutoff = t.cutoff; + // + 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; + + lon = -1000.; + lat = -1000.; + alt = -1000.; + + Bnorth = -1000.; + Beast = -1000.; + Bdown = -1000.; + Babs = -1000.; + BB0 = -1000.; + L = -1000.; + +// londip = -1000.; +// latdip = -1000.; +// altdip = -1000.; + +// loncgm = -1000.; +// latcgm = -1000.; +// altcgm = -1000.; + +// loncbm = -1000.; +// latcbm = -1000.; +// altcbm = -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.; + + // Euler angles (local field reference frame) + // thetamag = -1000.; + // phimag = -1000.; + // ethamag = -1000.; + + // pamzenitangle = -1000.; + // pamBangle = -1000.; + Iij.Zero(); + + mode = 0; + // std::fill_n(goodAttitude, 5, 0); } /** @@ -20,13 +138,101 @@ l2->abstime = absTime; l2->obt = OBT; l2->pkt_num = pkt_num; + + l2->lon = lon; + l2->lat = lat; + l2->alt = alt; + + l2->Bnorth = Bnorth; + l2->Beast = Beast; + l2->Bdown = Bdown; + l2->Babs = Babs; + 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->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; + // Euler angles (local field reference frame) +// l2->thetamag = thetamag; +// l2->phimag = phimag; +// l2->ethamag = ethamag; + +// 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; + + l2->Bnorth = Bnorth; + l2->Beast = Beast; + l2->Bdown = Bdown; + l2->Babs = Babs; + 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; + +// 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; + // Euler angles (local field reference frame) +// thetamag = l2->thetamag; +// phimag = l2->phimag; +// ethamag = l2->ethamag; + +// memcpy(goodAttitude, l2->goodAttitude, sizeof(l2->goodAttitude)); } -ClassImp(OrbitalInfo) -