| 1300 |
qRoll[sizeqmcmd]=RYPang_upper->Kren; |
qRoll[sizeqmcmd]=RYPang_upper->Kren; |
| 1301 |
qYaw[sizeqmcmd]=RYPang_upper->Ryskanie; |
qYaw[sizeqmcmd]=RYPang_upper->Ryskanie; |
| 1302 |
qPitch[sizeqmcmd]=RYPang_upper->Tangazh; |
qPitch[sizeqmcmd]=RYPang_upper->Tangazh; |
|
/* CHECK RECOVERED QUATERNIONS PROBLEM */ |
|
|
if(recqtime[mu]>=1160987921.75 && recqtime[mu]<=1160987932.00){ |
|
|
cout<<"We found it while checking all quaternions"<<"\t"<<recqtime[mu]<<endl; |
|
|
} |
|
| 1303 |
} |
} |
| 1304 |
} |
} |
| 1305 |
if(recqtime[mu]>=u_time){ |
if(recqtime[mu]>=u_time){ |
| 1318 |
qRoll[sizeqmcmd]=RYPang_upper->Kren; |
qRoll[sizeqmcmd]=RYPang_upper->Kren; |
| 1319 |
qYaw[sizeqmcmd]=RYPang_upper->Ryskanie; |
qYaw[sizeqmcmd]=RYPang_upper->Ryskanie; |
| 1320 |
qPitch[sizeqmcmd]=RYPang_upper->Tangazh; |
qPitch[sizeqmcmd]=RYPang_upper->Tangazh; |
|
/* CHECK RECOVERED QUATERNIONS PROBLEM */ |
|
|
if(recqtime[mu]>=1160987921.75 && recqtime[mu]<=1160987932.00){ |
|
|
cout<<"We found it while checking all quaternions"<<"\t"<<recqtime[mu]<<endl; |
|
|
} |
|
| 1321 |
break; |
break; |
| 1322 |
} |
} |
| 1323 |
} |
} |
| 1386 |
qYaw[sizeqmcmd]=RYPang_upper->Ryskanie; |
qYaw[sizeqmcmd]=RYPang_upper->Ryskanie; |
| 1387 |
qPitch[sizeqmcmd]=RYPang_upper->Tangazh; |
qPitch[sizeqmcmd]=RYPang_upper->Tangazh; |
| 1388 |
CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper); |
CopyQ(L_QQ_Q_l_lower,L_QQ_Q_l_upper); |
|
/* CHECK RECOVERED QUATERNIONS PROBLEM */ |
|
|
if(recqtime[mu]>=1160987921.75 && recqtime[mu]<=1160987932.00){ |
|
|
cout<<"We found it while checking all quaternions"<<"\t"<<recqtime[mu]<<endl; |
|
|
} |
|
| 1389 |
break; |
break; |
| 1390 |
} |
} |
| 1391 |
} |
} |