| 272 |
ifstream in((glparam->PATH+glparam->NAME).Data(),ios::in); |
ifstream in((glparam->PATH+glparam->NAME).Data(),ios::in); |
| 273 |
if ( parerror<0 ) { |
if ( parerror<0 ) { |
| 274 |
code = parerror; |
code = parerror; |
| 275 |
goto closeandexit; |
//goto closeandexit; |
| 276 |
}; |
} |
| 277 |
while(!in.eof()){ |
while(!in.eof()){ |
| 278 |
recqtime.resize(recqtime.size()+1); |
recqtime.resize(recqtime.size()+1); |
| 279 |
Int_t sizee = recqtime.size(); |
Int_t sizee = recqtime.size(); |
| 899 |
if ( debug ) printf(" here1 %i \n",ui); |
if ( debug ) printf(" here1 %i \n",ui); |
| 900 |
Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[ui]*1000-DeltaOBT*1000)); |
Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[ui]*1000-DeltaOBT*1000)); |
| 901 |
Int_t recSize = recqtime.size(); |
Int_t recSize = recqtime.size(); |
| 902 |
|
if(lowerqtime > recqtime[recSize-1]){ |
| 903 |
|
Int_t sizeqmcmd = qtime.size(); |
| 904 |
|
inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw); |
| 905 |
|
qtime[sizeqmcmd]=u_time; |
| 906 |
|
q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][0]; |
| 907 |
|
q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][1]; |
| 908 |
|
q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][2]; |
| 909 |
|
q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[ui][3]; |
| 910 |
|
qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui); |
| 911 |
|
lowerqtime = u_time; |
| 912 |
|
orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi); |
| 913 |
|
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]); |
| 914 |
|
qRoll[sizeqmcmd]=RYPang_upper->Kren; |
| 915 |
|
qYaw[sizeqmcmd]=RYPang_upper->Ryskanie; |
| 916 |
|
qPitch[sizeqmcmd]=RYPang_upper->Tangazh; |
| 917 |
|
} |
| 918 |
for(Int_t mu = nt;mu<recSize;mu++){ |
for(Int_t mu = nt;mu<recSize;mu++){ |
| 919 |
if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){ |
if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){ |
| 920 |
nt=mu; |
nt=mu; |
| 956 |
Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000)); |
Double_t u_time = dbtime->DBabsTime((UInt_t)(L_QQ_Q_l_upper->time[0]*1000-DeltaOBT*1000)); |
| 957 |
if(lowerqtime>u_time)nt=0; |
if(lowerqtime>u_time)nt=0; |
| 958 |
Int_t recSize = recqtime.size(); |
Int_t recSize = recqtime.size(); |
| 959 |
|
if(lowerqtime > recqtime[recSize-1]){ |
| 960 |
|
Int_t sizeqmcmd = qtime.size(); |
| 961 |
|
inclresize(qtime,q0,q1,q2,q3,qmode,qRoll,qPitch,qYaw); |
| 962 |
|
qtime[sizeqmcmd]=u_time; |
| 963 |
|
q0[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][0]; |
| 964 |
|
q1[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][1]; |
| 965 |
|
q2[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][2]; |
| 966 |
|
q3[sizeqmcmd]=L_QQ_Q_l_upper->quat[0][3]; |
| 967 |
|
qmode[sizeqmcmd]=holeq(lowerqtime,qtime[sizeqmcmd],L_QQ_Q_l_lower,L_QQ_Q_l_upper,ui); |
| 968 |
|
lowerqtime = u_time; |
| 969 |
|
orbits.getPosition((double) (u_time - gltle->GetFromTime())/60., &eCi); |
| 970 |
|
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]); |
| 971 |
|
qRoll[sizeqmcmd]=RYPang_upper->Kren; |
| 972 |
|
qYaw[sizeqmcmd]=RYPang_upper->Ryskanie; |
| 973 |
|
qPitch[sizeqmcmd]=RYPang_upper->Tangazh; |
| 974 |
|
} |
| 975 |
for(Int_t mu = nt;mu<recSize;mu++){ |
for(Int_t mu = nt;mu<recSize;mu++){ |
| 976 |
if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){ |
if(recqtime[mu]>lowerqtime && recqtime[mu]<u_time){ |
| 977 |
nt=mu; |
nt=mu; |