]>
Commit | Line | Data |
---|---|---|
e4c1cb11 | 1 | |
2 | TVector3 v[28]; | |
3 | Int_t nCh; | |
4 | ||
5 | ||
6 | TGeoHMatrix GetResSurvAlign(Int_t survNch); | |
7 | ||
8 | void SurveyToAlignHmpid(){ | |
9 | ||
10 | ||
11 | AliSurveyObj *so = new AliSurveyObj(); | |
12 | ||
13 | ||
14 | Int_t size = so->GetEntries(); | |
15 | printf("-> %d\n", size); | |
16 | ||
17 | so->FillFromLocalFile("Survey_781282_HMPID.txt"); | |
18 | size = so->GetEntries(); | |
19 | printf("--> %d\n", size); | |
20 | ||
21 | ||
22 | TObjArray *points = so->GetData(); | |
23 | // TVector3 v[28]; | |
24 | ||
25 | for (Int_t i = 0; i < points->GetEntries(); ++i) | |
26 | { | |
27 | AliSurveyPoint *p=(AliSurveyPoint *) points->At(i); | |
28 | v[i].SetXYZ(p->GetX()*100.,p->GetY()*100.,p->GetZ()*100.); | |
29 | } | |
30 | ||
31 | ||
32 | // // To produce the alignment object for the given volume you would | |
33 | // // then do something like this: | |
34 | // // Calculate the global delta transformation as ng * g3-1 | |
35 | // TGeoHMatrix gdelta = g3->Inverse(); //now equal to the inverse of g3 | |
36 | // gdelta.MultiplyLeft(&ng); | |
37 | // Int_t index = 0; | |
38 | // // if the volume is in the look-up table use something like this instead: | |
39 | // // AliGeomManager::LayerToVolUID(AliGeomManager::kTOF,i); | |
40 | // AliAlignObjMatrix* mobj = new AliAlignObjMatrix("symname",index,gdelta,kTRUE); | |
41 | ||
42 | ||
43 | TGeoHMatrix mtx = GetResSurvAlign(5); | |
44 | ||
45 | TGeoManager::Import("/home/mserio/tstesdtrk/geometry.root"); | |
46 | gGeoManager->cd(Form("ALIC_1/Hmp_%1i",nCh)); | |
47 | TGeoHMatrix g0 = *gGeoManager->GetCurrentMatrix(); | |
48 | cout<<"\n\n*********Ideal Matrix (chamber "<<nCh<<")*********"<<endl; | |
49 | g0.Print(); | |
50 | TGeoHMatrix gdelta = g0.Inverse(); | |
51 | gdelta.MultiplyLeft(&mtx); | |
52 | ||
53 | //gdelta.Print(); | |
54 | ||
55 | AliAlignObjMatrix* mobj = new | |
56 | AliAlignObjMatrix(AliGeomManager::SymName(AliGeomManager::LayerToVolUID(AliGeomManager::kHMPID,nCh)), | |
57 | AliGeomManager::LayerToVolUID(AliGeomManager::kHMPID,nCh),gdelta,kTRUE); | |
58 | /* | |
59 | cout<<"\n************* obtained AliAlignObjMatrix************\n"; | |
60 | mobj->Print(); | |
61 | cout<<""<<endl; | |
62 | ||
63 | TGeoHMatrix pa=gdelta*g0; | |
64 | ||
65 | pa.Print(); | |
66 | */ | |
67 | } | |
68 | ||
69 | ||
70 | TGeoHMatrix GetResSurvAlign(Int_t survNch) | |
71 | { | |
72 | cout<<" ************Survey numbering********Offline Numbering**********"<<endl; | |
73 | cout<<"\nChamber No 0 4 "<<endl; | |
74 | cout<<"Chamber No 1 3 "<<endl; | |
75 | cout<<"Chamber No 2 5 "<<endl; | |
76 | cout<<"Chamber No 3 1 "<<endl; | |
77 | cout<<"Chamber No 4 6 "<<endl; | |
78 | cout<<"Chamber No 5 2 "<<endl; | |
79 | cout<<"Chamber No 6 0 "<<endl; | |
80 | ||
81 | ||
82 | // From the new fiducial marks coordinates derive back the | |
83 | // new global position of the surveyed volume | |
84 | //*** The 4 fiducial marks are assumed on a rectangle | |
85 | //*** parallel to a surface of the Hmp (main volume) | |
86 | //*** at a certain offset from the origin (zdepth) and with | |
87 | //*** x and y sides parallel to the box's x and y axes. | |
88 | ||
89 | if(survNch==0) nCh=4; | |
90 | if(survNch==1) nCh=3; | |
91 | if(survNch==2) nCh=5; | |
92 | if(survNch==3) nCh=1; | |
93 | if(survNch==4) nCh=6; | |
94 | if(survNch==5) nCh=2; | |
95 | if(survNch==6) nCh=0; | |
96 | ||
97 | Double_t ab[3], bc[3], n[3]; | |
98 | Double_t plane[4], s; | |
99 | Double_t ngA[3]={v[0+4*survNch].X(),v[0+4*survNch].Y(),v[0+4*survNch].Z()}; | |
100 | Double_t ngB[3]={v[1+4*survNch].X(),v[1+4*survNch].Y(),v[1+4*survNch].Z()}; | |
101 | Double_t ngC[3]={v[2+4*survNch].X(),v[2+4*survNch].Y(),v[2+4*survNch].Z()}; | |
102 | Double_t ngD[3]={v[3+4*survNch].X(),v[3+4*survNch].Y(),v[3+4*survNch].Z()}; | |
103 | if(survNch>4) | |
104 | { | |
105 | // first vector on the plane of the fiducial marks | |
106 | for(Int_t i=0;i<3;i++){ | |
107 | ab[i] = ngB[i] - ngA[i]; | |
108 | } | |
109 | ||
110 | // second vector on the plane of the fiducial marks | |
111 | for(Int_t i=0;i<3;i++){ | |
112 | bc[i] = ngC[i] - ngB[i]; | |
113 | } | |
114 | } | |
115 | ||
116 | else{ | |
117 | // first vector on the plane of the fiducial marks | |
118 | for(Int_t i=0;i<3;i++){ | |
119 | ab[i] = ngB[i] - ngA[i]; | |
120 | } | |
121 | ||
122 | // second vector on the plane of the fiducial marks | |
123 | for(Int_t i=0;i<3;i++){ | |
124 | bc[i] = ngD[i] - ngB[i]; | |
125 | } | |
126 | ||
127 | } | |
128 | // vector normal to the plane of the fiducial marks obtained | |
129 | // as cross product of the two vectors on the plane d0^d1 | |
130 | n[0] = ab[1] * bc[2] - ab[2] * bc[1]; | |
131 | n[1] = ab[2] * bc[0] - ab[0] * bc[2]; | |
132 | n[2] = ab[0] * bc[1] - ab[1] * bc[0]; | |
133 | ||
134 | Double_t sizen = TMath::Sqrt( n[0]*n[0] + n[1]*n[1] + n[2]*n[2] ); | |
135 | if(sizen>1.e-8){ | |
136 | s = Double_t(1.)/sizen ; //normalization factor | |
137 | }else{ | |
138 | return 0; | |
139 | } | |
140 | ||
141 | // plane expressed in the hessian normal form, see: | |
142 | // http://mathworld.wolfram.com/HessianNormalForm.html | |
143 | // the first three are the coordinates of the orthonormal vector | |
144 | // the fourth coordinate is equal to the distance from the origin | |
145 | ||
146 | for(i=0;i<3;i++){ | |
147 | plane[i] = n[i] * s; | |
148 | } | |
149 | plane[3] = -( plane[0] * ngA[0] + plane[1] * ngA[1] + plane[2] * ngA[2] ); | |
150 | cout<<"normal to plane and distance from IP: "<<plane[0]<<" "<<plane[1]<<" "<<plane[2]<<" "<<plane[3]<<" "<<endl; | |
151 | ||
152 | // The center of the square with fiducial marks as corners | |
153 | // as the middle point of one diagonal - md | |
154 | // Used below to get the center - orig - of the surveyed box | |
155 | Double_t orig[3], md[3]; | |
156 | ||
157 | if(survNch>4){ | |
158 | for(i=0;i<3;i++){ | |
159 | md[i] = (ngA[i] + ngC[i]) * 0.5;//modified!!!!!!!!! | |
160 | } | |
161 | ||
162 | } | |
163 | ||
164 | else { | |
165 | for(i=0;i<3;i++){ | |
166 | md[i] = (ngA[i] + ngD[i]) * 0.5;//modified!!!!!!!!! | |
167 | } | |
168 | } | |
169 | cout<<endl<<"The center of the box from Survey data: "<<md[0]<<" "<<md[1]<<" "<<md[2]<<endl; | |
170 | const Double_t zdepth=-0.9-4.85; //the survey data are down the radiator (behind the honeycomb structure). They | |
171 | //lay on 4 cylinders whose height is 9 mm. | |
172 | ||
173 | // The center of the box | |
174 | for(i=0;i<1;i++){ | |
175 | orig[i] = md[i] - (-plane[i])*(zdepth+plane[3]); | |
176 | } | |
177 | orig[1] = md[1] - (-plane[1])*(zdepth+plane[3]); | |
178 | orig[2] = md[2] - (-plane[2])*(zdepth+plane[3]); | |
179 | ||
180 | cout<<endl<<"The origin of the box: "<<orig[0]<<" "<<orig[1]<<" "<<orig[2]<<endl; | |
181 | ||
182 | // get x,y local directions needed to write the global rotation matrix | |
183 | // for the surveyed volume by normalising vectors ab and bc | |
184 | Double_t sx = TMath::Sqrt(ab[0]*ab[0] + ab[1]*ab[1] + ab[2]*ab[2]); | |
185 | if(sx>1.e-8){ | |
186 | for(i=0;i<3;i++){ | |
187 | ab[i] /= sx; | |
188 | } | |
189 | cout<<endl<<"x "<<ab[0]<<" "<<ab[1]<<" "<<ab[2]<<endl; | |
190 | } | |
191 | Double_t sy = TMath::Sqrt(bc[0]*bc[0] + bc[1]*bc[1] + bc[2]*bc[2]); | |
192 | if(sy>1.e-8){ | |
193 | for(i=0;i<3;i++){ | |
194 | bc[i] /= sy; | |
195 | } | |
196 | cout<<endl<<"y "<<bc[0]<<" "<<bc[1]<<" "<<bc[2]<<endl; | |
197 | } | |
198 | ||
199 | ||
200 | // the global matrix for the surveyed volume - ng | |
201 | Double_t rot[9] = {-ab[0],bc[0],-plane[0],-ab[1],bc[1],-plane[1],-ab[2],bc[2],-plane[2]}; | |
202 | TGeoHMatrix ng; | |
203 | ng.SetTranslation(md); | |
204 | ng.SetRotation(rot); | |
205 | ||
206 | cout<<"\n********* global matrix inferred from surveyed fiducial marks for chamber"<<survNch<<"***********\n"; | |
207 | ng.Print(); | |
208 | ||
209 | ||
210 | return ng; | |
211 | ||
212 | } | |
213 | ||
214 | ||
215 | ||
216 |