TGeoCombiTrans* GetGlobalPosition(TGeoCombiTrans *fRef)
{
if (fLocalTrans == kTRUE ) {
if ( ( fThetaX == 0 ) && ( fThetaY==0 ) && ( fThetaZ == 0 )
&&
( fX == 0 ) && ( fY == 0 ) && ( fZ == 0 )
) return fRef;
// X axis
Double_t xAxis[3] = { 1. , 0. , 0. };
Double_t yAxis[3] = { 0. , 1. , 0. };
Double_t zAxis[3] = { 0. , 0. , 1. };
// Reference Rotation
fRefRot = fRef->GetRotation();
if (fRefRot) {
Double_t mX[3] = {0.,0.,0.};
Double_t mY[3] = {0.,0.,0.};
Double_t mZ[3] = {0.,0.,0.};
fRefRot->LocalToMasterVect(xAxis,mX);
fRefRot->LocalToMasterVect(yAxis,mY);
fRefRot->LocalToMasterVect(zAxis,mZ);
Double_t a[4]={ mX[0],mX[1],mX[2], fThetaX };
Double_t b[4]={ mY[0],mY[1],mY[2], fThetaY };
Double_t c[4]={ mZ[0],mZ[1],mZ[2], fThetaZ };
ROOT::Math::AxisAngle aX(a,a+4);
ROOT::Math::AxisAngle aY(b,b+4);
ROOT::Math::AxisAngle aZ(c,c+4);
ROOT::Math::Rotation3D fMatX( aX );
ROOT::Math::Rotation3D fMatY( aY );
ROOT::Math::Rotation3D fMatZ( aZ );
ROOT::Math::Rotation3D fRotXYZ = (fMatZ * (fMatY * fMatX));
//cout << fRotXYZ << endl;
Double_t fRotable[9]={0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0,0.0};
fRotXYZ.GetComponents(
fRotable[0],fRotable[3],fRotable[6],
fRotable[1],fRotable[4],fRotable[7],
fRotable[2],fRotable[5],fRotable[8]
);
TGeoRotation *pRot = new TGeoRotation();
pRot->SetMatrix(fRotable);
TGeoCombiTrans *pTmp = new TGeoCombiTrans(*fGlobalTrans,*pRot);
// ne peut pas etre applique ici
// il faut differencier trans et rot dans la multi.
TGeoRotation rot_id;
rot_id.SetAngles(0.0,0.0,0.0);
TGeoCombiTrans c1;
c1.SetRotation(rot_id);
const Double_t *t = pTmp->GetTranslation();
c1.SetTranslation(t[0],t[1],t[2]);
TGeoCombiTrans c2;
c2.SetRotation(rot_id);
const Double_t *tt = fRefRot->GetTranslation();
c2.SetTranslation(tt[0],tt[1],tt[2]);
TGeoCombiTrans cc = c1 * c2 ;
TGeoCombiTrans c3;
c3.SetRotation(pTmp->GetRotation());
TGeoCombiTrans c4;
c4.SetRotation(fRefRot);
TGeoCombiTrans ccc = c3 * c4;
TGeoCombiTrans pGlobal;
pGlobal.SetRotation(ccc.GetRotation());
const Double_t *allt = cc.GetTranslation();
pGlobal.SetTranslation(allt[0],allt[1],allt[2]);
return ( new TGeoCombiTrans( pGlobal ) );
}else{
cout << "-E- R3BDetector::GetGlobalPosition() \
No. Ref. Transformation defined ! " << endl;
cout << "-E- R3BDetector::GetGlobalPosition() \
cannot create Local Transformation " << endl;
return NULL;
} //! fRefRot
} else {
// Lab Transf.
if ( ( fPhi == 0 ) && ( fTheta==0 ) && ( fPsi == 0 )
void ax(double a, void *x, int len, QudaPrecision precision) {
if (precision == QUDA_DOUBLE_PRECISION) aX(a, (double*)x, len);
else aX((float)a, (float*)x, len);
}
