1 | /* ======================================================================== *\
|
---|
2 | !
|
---|
3 | ! *
|
---|
4 | ! * This file is part of MARS, the MAGIC Analysis and Reconstruction
|
---|
5 | ! * Software. It is distributed to you in the hope that it can be a useful
|
---|
6 | ! * and timesaving tool in analysing Data of imaging Cerenkov telescopes.
|
---|
7 | ! * It is distributed WITHOUT ANY WARRANTY.
|
---|
8 | ! *
|
---|
9 | ! * Permission to use, copy, modify and distribute this software and its
|
---|
10 | ! * documentation for any purpose is hereby granted without fee,
|
---|
11 | ! * provided that the above copyright notice appear in all copies and
|
---|
12 | ! * that both that copyright notice and this permission notice appear
|
---|
13 | ! * in supporting documentation. It is provided "as is" without express
|
---|
14 | ! * or implied warranty.
|
---|
15 | ! *
|
---|
16 | !
|
---|
17 | !
|
---|
18 | ! Author(s): Thomas Bretz, 2003 <mailto:tbretz@astro.uni-wuerzburg.de>
|
---|
19 | !
|
---|
20 | ! Copyright: MAGIC Software Development, 2000-2004
|
---|
21 | !
|
---|
22 | !
|
---|
23 | \* ======================================================================== */
|
---|
24 |
|
---|
25 | /////////////////////////////////////////////////////////////////////////////
|
---|
26 | //
|
---|
27 | // MPointing
|
---|
28 | // =========
|
---|
29 | //
|
---|
30 | // This is the class used for the pointing correction done in the MAGIC
|
---|
31 | // drive software cosy. NEVER CHANGE IT WITHOUT CONTACTING THE AUTHOR FIRST!
|
---|
32 | //
|
---|
33 | // Variables/Coefficients
|
---|
34 | // ----------------------
|
---|
35 | //
|
---|
36 | // Double_t fIe ; // [rad] Index Error in Elevation
|
---|
37 | // Double_t fIa ; // [rad] Index Error in Azimuth
|
---|
38 | //
|
---|
39 | // Double_t fFlop ; // [rad] Vertical Sag
|
---|
40 | // * do not use if not data: Zd<0
|
---|
41 | //
|
---|
42 | // Double_t fNpae ; // [rad] Az-El Nonperpendicularity
|
---|
43 | //
|
---|
44 | // Double_t fCa ; // [rad] Left-Right Collimation Error
|
---|
45 | //
|
---|
46 | // Double_t fAn ; // [rad] Azimuth Axis Misalignment (N-S)
|
---|
47 | // Double_t fAw ; // [rad] Azimuth Axis Misalignment (E-W)
|
---|
48 | //
|
---|
49 | // Double_t fTf ; // [rad] Tube fluxture (sin)
|
---|
50 | // * same as ecec if no data: Zd<0
|
---|
51 | // Double_t fTx ; // [rad] Tube fluxture (tan)
|
---|
52 | // * do not use with NPAE if no data: Zd<0
|
---|
53 | //
|
---|
54 | // Double_t fNrx ; // [rad] Nasmyth rotator displacement, horizontan
|
---|
55 | // Double_t fNry ; // [rad] Nasmyth rotator displacement, vertical
|
---|
56 | //
|
---|
57 | // Double_t fCrx ; // [rad] Alt/Az Coude Displacement (N-S)
|
---|
58 | // Double_t fCry ; // [rad] Alt/Az Coude Displacement (E-W)
|
---|
59 | //
|
---|
60 | // Double_t fEces ; // [rad] Elevation Centering Error (sin)
|
---|
61 | // Double_t fAces ; // [rad] Azimuth Centering Error (sin)
|
---|
62 | // Double_t fEcec ; // [rad] Elevation Centering Error (cos)
|
---|
63 | // Double_t fAcec ; // [rad] Azimuth Centering Error (cos)
|
---|
64 | //
|
---|
65 | // Double_t fMagic1;// [rad] ZA Hysteresis
|
---|
66 | // Double_t fMagic2;// [rad] undefined
|
---|
67 | //
|
---|
68 | ////////////////////////////////////////////////////////////////////////////
|
---|
69 | #include "MPointing.h"
|
---|
70 |
|
---|
71 | #include <fstream>
|
---|
72 |
|
---|
73 | #include <TVector3.h>
|
---|
74 |
|
---|
75 | #include <TMinuit.h>
|
---|
76 |
|
---|
77 | #include "MLog.h"
|
---|
78 | #include "MLogManip.h"
|
---|
79 |
|
---|
80 | #include "MTime.h"
|
---|
81 |
|
---|
82 | ClassImp(AltAz);
|
---|
83 | ClassImp(ZdAz);
|
---|
84 | ClassImp(MPointing);
|
---|
85 |
|
---|
86 | using namespace std;
|
---|
87 |
|
---|
88 | #undef DEBUG
|
---|
89 | //#define DEBUG(txt) txt
|
---|
90 | #define DEBUG(txt)
|
---|
91 |
|
---|
92 | const Int_t MPointing::fNumPar=19;
|
---|
93 |
|
---|
94 | void MPointing::Init(const char *name, const char *title)
|
---|
95 | {
|
---|
96 | fName = name ? name : "MPointing";
|
---|
97 | fTitle = title ? title : "Pointing correction model for the MAGIC telescope";
|
---|
98 |
|
---|
99 | fCoeff = new Double_t*[fNumPar];
|
---|
100 | fNames = new TString[fNumPar];
|
---|
101 | fDescr = new TString[fNumPar];
|
---|
102 |
|
---|
103 | fCoeff[ 0] = &fIa; fNames[ 0] = "IA";
|
---|
104 | fCoeff[ 1] = &fIe; fNames[ 1] = "IE";
|
---|
105 | fCoeff[ 2] = &fFlop; fNames[ 2] = "FLOP";
|
---|
106 | fCoeff[ 3] = &fAn; fNames[ 3] = "AN";
|
---|
107 | fCoeff[ 4] = &fAw; fNames[ 4] = "AW";
|
---|
108 | fCoeff[ 5] = &fNpae; fNames[ 5] = "NPAE";
|
---|
109 | fCoeff[ 6] = &fCa; fNames[ 6] = "CA";
|
---|
110 | fCoeff[ 7] = &fTf; fNames[ 7] = "TF";
|
---|
111 | fCoeff[ 8] = &fTx; fNames[ 8] = "TX";
|
---|
112 | fCoeff[ 9] = &fEces; fNames[ 9] = "ECES";
|
---|
113 | fCoeff[10] = &fAces; fNames[10] = "ACES";
|
---|
114 | fCoeff[11] = &fEcec; fNames[11] = "ECEC";
|
---|
115 | fCoeff[12] = &fAcec; fNames[12] = "ACEC";
|
---|
116 | fCoeff[13] = &fNrx; fNames[13] = "NRX";
|
---|
117 | fCoeff[14] = &fNry; fNames[14] = "NRY";
|
---|
118 | fCoeff[15] = &fCrx; fNames[15] = "CRX";
|
---|
119 | fCoeff[16] = &fCry; fNames[16] = "CRY";
|
---|
120 | fCoeff[17] = &fMagic1; fNames[17] = "MAGIC1";
|
---|
121 | fCoeff[18] = &fMagic2; fNames[18] = "MAGIC2";
|
---|
122 |
|
---|
123 | fDescr[ 0] = "Index Error Azimuth";
|
---|
124 | fDescr[ 1] = "Index Error Zenith Distance";
|
---|
125 | fDescr[ 2] = "Vertical Sag";
|
---|
126 | fDescr[ 3] = "Azimuth Axis Misalignment (N-S)";
|
---|
127 | fDescr[ 4] = "Azimuth Axis Misalignment (E-W)";
|
---|
128 | fDescr[ 5] = "Az-El Nonperpendicularity";
|
---|
129 | fDescr[ 6] = "Left-Right Collimation Error";
|
---|
130 | fDescr[ 7] = "Tube fluxture (sin)";
|
---|
131 | fDescr[ 8] = "Tube fluxture (tan)";
|
---|
132 | fDescr[ 9] = "Elevation Centering Error (sin)";
|
---|
133 | fDescr[10] = "Azimuth Centering Error (sin)";
|
---|
134 | fDescr[11] = "Elevation Centering Error (cos)";
|
---|
135 | fDescr[12] = "Azimuth Centering Error (cos)";
|
---|
136 | fDescr[13] = "Nasmyth rotator displacement (horizontal)";
|
---|
137 | fDescr[14] = "Nasmyth rotator displacement (vertical)";
|
---|
138 | fDescr[15] = "Alt/Az Coude Displacement (N-S)";
|
---|
139 | fDescr[16] = "Alt/Az Coude Displacement (E-W)";
|
---|
140 | fDescr[17] = "n/a <ZA Hysteresis>";
|
---|
141 | fDescr[18] = "n/a";
|
---|
142 | }
|
---|
143 | void MPointing::Reset()
|
---|
144 | {
|
---|
145 | Clear();
|
---|
146 | }
|
---|
147 |
|
---|
148 | void MPointing::Load(const char *name)
|
---|
149 | {
|
---|
150 | /*
|
---|
151 | ! MMT 1987 July 8
|
---|
152 | ! T 36 7.3622 41.448 -0.0481
|
---|
153 | ! IA -37.5465 20.80602
|
---|
154 | ! IE -13.9180 1.25217
|
---|
155 | ! NPAE +7.0751 26.44763
|
---|
156 | ! CA -6.9149 32.05358
|
---|
157 | ! AN +0.5053 1.40956
|
---|
158 | ! AW -2.2016 1.37480
|
---|
159 | ! END
|
---|
160 | */
|
---|
161 |
|
---|
162 | ifstream fin(name);
|
---|
163 | if (!fin)
|
---|
164 | {
|
---|
165 | *fLog << err << "ERROR - Cannot open file '" << name << "'" << endl;
|
---|
166 | return;
|
---|
167 | }
|
---|
168 |
|
---|
169 | char c;
|
---|
170 | while (fin && fin.get()!='\n');
|
---|
171 | fin >> c;
|
---|
172 |
|
---|
173 | if (c!='S' && c!='s')
|
---|
174 | {
|
---|
175 | *fLog << err << "Error: This in not a model correcting the star position (" << c << ")" << endl;
|
---|
176 | return;
|
---|
177 | }
|
---|
178 |
|
---|
179 | Clear();
|
---|
180 |
|
---|
181 | cout << endl;
|
---|
182 |
|
---|
183 | Double_t val;
|
---|
184 | fin >> val;
|
---|
185 | *fLog << inf << "Number of observed stars: " << val << endl;
|
---|
186 | fin >> val;
|
---|
187 | *fLog << inf << "Sky RMS: " << val << "\"" << endl;
|
---|
188 | fin >> val;
|
---|
189 | *fLog << inf << "Refraction Constant A: " << val << "\"" << endl;
|
---|
190 | fin >> val;
|
---|
191 | *fLog << inf << "Refraction Constant B: " << val << "\"" << endl;
|
---|
192 |
|
---|
193 | *fLog << inf << endl;
|
---|
194 |
|
---|
195 | *fLog << inf << " & = Name Value Sigma" << endl;
|
---|
196 | *fLog << inf << "--------------------------------------------------" << endl;
|
---|
197 |
|
---|
198 | while (fin)
|
---|
199 | {
|
---|
200 | TString str;
|
---|
201 | fin >> str;
|
---|
202 |
|
---|
203 | if (str=="END")
|
---|
204 | break;
|
---|
205 |
|
---|
206 | if (str[0]=='&')
|
---|
207 | {
|
---|
208 | *fLog << inf << " & ";
|
---|
209 | str.Remove(0);
|
---|
210 | }
|
---|
211 | else
|
---|
212 | cout << " ";
|
---|
213 |
|
---|
214 | if (str[1]=='=')
|
---|
215 | {
|
---|
216 | *fLog << inf << "= ";
|
---|
217 | str.Remove(0);
|
---|
218 | }
|
---|
219 | else
|
---|
220 | *fLog << inf << " ";
|
---|
221 |
|
---|
222 | fin >> val;
|
---|
223 | *fLog << inf << str << "\t" << setw(11) << val << "° \t";
|
---|
224 | val *= TMath::DegToRad();
|
---|
225 |
|
---|
226 | // Find parameter
|
---|
227 | Int_t n = -1;
|
---|
228 | for (int i=0; i<fNumPar; i++)
|
---|
229 | if (str==fNames[i])
|
---|
230 | {
|
---|
231 | n = i;
|
---|
232 | *fCoeff[i] = val;
|
---|
233 | break;
|
---|
234 | }
|
---|
235 |
|
---|
236 | fin >> val;
|
---|
237 | *fLog << inf << setw(9) << val << "°" << endl;
|
---|
238 |
|
---|
239 | // corresponding error
|
---|
240 | fError[n] = val*TMath::DegToRad();
|
---|
241 | }
|
---|
242 | *fLog << inf << endl;
|
---|
243 | }
|
---|
244 |
|
---|
245 | void MPointing::Save(const char *name)
|
---|
246 | {
|
---|
247 | /*
|
---|
248 | ! MMT 1987 July 8
|
---|
249 | ! T 36 7.3622 41.448 -0.0481
|
---|
250 | ! IA -37.5465 20.80602
|
---|
251 | ! IE -13.9180 1.25217
|
---|
252 | ! NPAE +7.0751 26.44763
|
---|
253 | ! CA -6.9149 32.05358
|
---|
254 | ! AN +0.5053 1.40956
|
---|
255 | ! AW -2.2016 1.37480
|
---|
256 | ! END
|
---|
257 | */
|
---|
258 |
|
---|
259 | ofstream fout(name);
|
---|
260 | if (!fout)
|
---|
261 | {
|
---|
262 | cout << "Error: Cannot open file '" << name << "'" << endl;
|
---|
263 | return;
|
---|
264 | }
|
---|
265 |
|
---|
266 | MTime t;
|
---|
267 | t.Now();
|
---|
268 |
|
---|
269 | fout << "MAGIC1 " << t << endl;
|
---|
270 | fout << "S 00 000000 000000 0000000" << endl;
|
---|
271 | fout << setprecision(8);
|
---|
272 | for (int i=0; i<fNumPar; i++)
|
---|
273 | {
|
---|
274 | fout << " " << setw(6) << GetVarName(i) << " ";
|
---|
275 | fout << setw(13) << *fCoeff[i]*kRad2Deg << " ";
|
---|
276 | fout << setw(11) << fError[i]*kRad2Deg << endl;
|
---|
277 | }
|
---|
278 | fout << "END" << endl;
|
---|
279 | }
|
---|
280 |
|
---|
281 | Double_t MPointing::Sign(Double_t val, Double_t alt)
|
---|
282 | {
|
---|
283 | // Some pointing corrections are defined as Delta ZA, which
|
---|
284 | // is (P. Wallace) defined [0,90]deg while Alt is defined
|
---|
285 | // [0,180]deg
|
---|
286 | return (TMath::Pi()/2-alt < 0 ? -val : val);
|
---|
287 | }
|
---|
288 |
|
---|
289 | AltAz MPointing::AddOffsets(const AltAz &aa) const
|
---|
290 | {
|
---|
291 | // Correct [rad]
|
---|
292 | // zdaz [rad]
|
---|
293 | AltAz p = aa;
|
---|
294 |
|
---|
295 | const AltAz I(fIe, fIa);
|
---|
296 | p += I;
|
---|
297 |
|
---|
298 | return p;
|
---|
299 | }
|
---|
300 |
|
---|
301 | AltAz MPointing::SubtractOffsets(const AltAz &aa) const
|
---|
302 | {
|
---|
303 | // Correct [rad]
|
---|
304 | // zdaz [rad]
|
---|
305 | AltAz p = aa;
|
---|
306 |
|
---|
307 | const AltAz I(fIe, fIa);
|
---|
308 | p -= I;
|
---|
309 |
|
---|
310 | return p;
|
---|
311 | }
|
---|
312 |
|
---|
313 | AltAz MPointing::CalcAnAw(const AltAz &p, Int_t sign) const
|
---|
314 | {
|
---|
315 | // Corrections for AN and AW without approximations
|
---|
316 | // as done by Patrick Wallace. The approximation cannot
|
---|
317 | // be used for MAGIC because the correctioon angle
|
---|
318 | // AW (~1.5deg) is not small enough.
|
---|
319 |
|
---|
320 | // Vector in cartesian coordinates
|
---|
321 | TVector3 v1;
|
---|
322 |
|
---|
323 | // Set Azimuth and Elevation
|
---|
324 | v1.SetMagThetaPhi(1, TMath::Pi()/2-p.Alt(), p.Az());
|
---|
325 |
|
---|
326 |
|
---|
327 | TVector3 v2(v1);
|
---|
328 | // cout << sign << endl;
|
---|
329 |
|
---|
330 | // cout << "v1: " << v1.Theta()*TMath::RadToDeg() << " " << v1.Phi()*TMath::RadToDeg() << endl;
|
---|
331 |
|
---|
332 | // Rotate around the x- and y-axis
|
---|
333 | v1.RotateY(sign*fAn);
|
---|
334 | v1.RotateX(sign*fAw);
|
---|
335 |
|
---|
336 | // cout << "v1: " << v1.Theta()*TMath::RadToDeg() << " " << v1.Phi()*TMath::RadToDeg() << endl;
|
---|
337 | // cout << "v2: " << v2.Theta()*TMath::RadToDeg() << " " << v2.Theta()*TMath::RadToDeg() << endl;
|
---|
338 |
|
---|
339 | // cout << "dv: " << (v2.Theta()-v1.Theta())*TMath::RadToDeg() << " " << (v2.Phi()-v1.Phi())*TMath::RadToDeg() << endl;
|
---|
340 |
|
---|
341 | Double_t dalt = v1.Theta()-v2.Theta();
|
---|
342 | Double_t daz = v1.Phi() -v2.Phi();
|
---|
343 |
|
---|
344 | //cout << dalt*TMath::RadToDeg() << " " << daz*TMath::RadToDeg() << endl;
|
---|
345 |
|
---|
346 | if (daz>TMath::Pi())
|
---|
347 | daz -= TMath::TwoPi();
|
---|
348 | if (daz<-TMath::Pi())
|
---|
349 | daz += TMath::TwoPi();
|
---|
350 |
|
---|
351 | // if (daz>TMath::Pi()/2)
|
---|
352 | // {
|
---|
353 | // }
|
---|
354 |
|
---|
355 | AltAz d(dalt, daz);
|
---|
356 | return d;
|
---|
357 |
|
---|
358 | // Calculate Delta Azimuth and Delta Elevation
|
---|
359 | /*
|
---|
360 | AltAz d(TMath::Pi()/2-v1.Theta(), v1.Phi());
|
---|
361 |
|
---|
362 | cout << "p : " << p.Alt()*TMath::RadToDeg() << " " << p.Az()*TMath::RadToDeg() << endl;
|
---|
363 | cout << "d : " << d.Alt()*TMath::RadToDeg() << " " << d.Az()*TMath::RadToDeg() << endl;
|
---|
364 | d -= p;
|
---|
365 | cout << "d-p: " << d.Alt()*TMath::RadToDeg() << " " << d.Az()*TMath::RadToDeg() << endl;
|
---|
366 | d *= sign;
|
---|
367 | cout << "d* : " << d.Alt()*TMath::RadToDeg() << " " << d.Az()*TMath::RadToDeg() << endl;
|
---|
368 |
|
---|
369 |
|
---|
370 | cout << "p2: " << 90-p.Alt()*TMath::RadToDeg() << " " << p.Az()*TMath::RadToDeg() << endl;
|
---|
371 | cout << "d2: " << 90-d.Alt()*TMath::RadToDeg() << " " << d.Az()*TMath::RadToDeg() << endl;
|
---|
372 |
|
---|
373 | Int_t s1 = 90-d.Alt()*TMath::RadToDeg() < 0 ? -1 : 1;
|
---|
374 | Int_t s2 = 90-p.Alt()*TMath::RadToDeg() < 0 ? -1 : 1;
|
---|
375 |
|
---|
376 |
|
---|
377 | if (s1 != s2)
|
---|
378 | {
|
---|
379 | //90-d.Alt() <-- -90+d.Alt()
|
---|
380 |
|
---|
381 | d.Alt(d.Alt()-TMath::Pi());
|
---|
382 | cout << "Alt-" << endl;
|
---|
383 | }
|
---|
384 | cout << "d': " << 90-d.Alt()*TMath::RadToDeg() << " " << d.Az()*TMath::RadToDeg() << endl;*/
|
---|
385 | /*
|
---|
386 | // Fix 'direction' of output depending on input vector
|
---|
387 | if (TMath::Pi()/2-sign*p.Alt()<0)
|
---|
388 | {
|
---|
389 | d.Alt(d.Alt()-TMath::Pi());
|
---|
390 | cout << "Alt-" << endl;
|
---|
391 | }
|
---|
392 | //if (TMath::Pi()/2-sign*p.Alt()>TMath::Pi())
|
---|
393 | //{
|
---|
394 | // d.Alt(TMath::Pi()-d.Alt());
|
---|
395 | // cout << "Alt+" << endl;
|
---|
396 | //}
|
---|
397 |
|
---|
398 | // Align correction into [-180,180]
|
---|
399 | while (d.Az()>TMath::Pi())
|
---|
400 | {
|
---|
401 | d.Az(d.Az()-TMath::Pi()*2);
|
---|
402 | cout << "Az-" << endl;
|
---|
403 | }
|
---|
404 | while (d.Az()<-TMath::Pi())
|
---|
405 | {
|
---|
406 | d.Az(d.Az()+TMath::Pi()*2);
|
---|
407 | cout << "Az+" << endl;
|
---|
408 | }
|
---|
409 | */
|
---|
410 | return d;
|
---|
411 | }
|
---|
412 |
|
---|
413 |
|
---|
414 | AltAz MPointing::Correct(const AltAz &aa) const
|
---|
415 | {
|
---|
416 | // Correct [rad]
|
---|
417 | // zdaz [rad]
|
---|
418 | AltAz p = aa;
|
---|
419 |
|
---|
420 | DEBUG(cout << setprecision(16));
|
---|
421 | DEBUG(cout << "Bend7: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
422 |
|
---|
423 | const AltAz CRX(-fCrx*sin(p.Az()-p.Alt()), fCrx*cos(p.Az()-p.Alt())/cos(p.Alt()));
|
---|
424 | const AltAz CRY(-fCry*cos(p.Az()-p.Alt()), -fCry*sin(p.Az()-p.Alt())/cos(p.Alt()));
|
---|
425 | p += CRX;
|
---|
426 | p += CRY;
|
---|
427 |
|
---|
428 | DEBUG(cout << "Bend6: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
429 |
|
---|
430 | const AltAz NRX(fNrx*sin(p.Alt()), -fNrx);
|
---|
431 | const AltAz NRY(fNry*cos(p.Alt()), -fNry*tan(p.Alt()));
|
---|
432 | p += NRX;
|
---|
433 | p += NRY;
|
---|
434 |
|
---|
435 | DEBUG(cout << "Bend5: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
436 |
|
---|
437 | const AltAz CES(-fEces*sin(p.Alt()), -fAces*sin(p.Az()));
|
---|
438 | const AltAz CEC(-fEcec*cos(p.Alt()), -fAcec*cos(p.Az()));
|
---|
439 | p += CES;
|
---|
440 | p += CEC;
|
---|
441 |
|
---|
442 | DEBUG(cout << "Bend4: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
443 |
|
---|
444 | const AltAz TX(Sign(fTx/tan(p.Alt()), p.Alt()), 0);
|
---|
445 | const AltAz TF(Sign(fTf*cos(p.Alt()), p.Alt()), 0);
|
---|
446 | //p += TX;
|
---|
447 | p += TF;
|
---|
448 |
|
---|
449 |
|
---|
450 | DEBUG(cout << "Bend3: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
451 |
|
---|
452 | /*
|
---|
453 | //New Corrections for NPAE and CA:
|
---|
454 | TVector3 v(1.,1.,1.); // Vector in cartesian coordinates
|
---|
455 |
|
---|
456 | //Set Azimuth and Elevation
|
---|
457 | v.SetPhi(p.Az());
|
---|
458 | v.SetTheta(TMath::Pi()/2-p.Alt());
|
---|
459 | //Rotation Vectors:
|
---|
460 | TVector3 vNpae( cos(p.Az()), sin(p.Az()), 0);
|
---|
461 | TVector3 vCa( -cos(p.Az())*cos(p.Alt()), -sin(p.Az())*cos(p.Alt()), sin(p.Alt()));
|
---|
462 | //Rotate around the vectors vNpae and vCa
|
---|
463 | v.Rotate(fNpae, vNpae);
|
---|
464 | v.Rotate(fCa, vCa);
|
---|
465 |
|
---|
466 | p.Az(v.Phi());
|
---|
467 | p.Alt(TMath::Pi()/2-v.Theta());
|
---|
468 | */
|
---|
469 |
|
---|
470 | //Old correction terms for Npae and Ca:
|
---|
471 | const AltAz CA(0, -fCa/cos(p.Alt()));
|
---|
472 | p += CA;
|
---|
473 |
|
---|
474 | const AltAz NPAE(0, -fNpae*tan(p.Alt()));
|
---|
475 | p += NPAE;
|
---|
476 |
|
---|
477 | DEBUG(cout << "Bend2: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
478 |
|
---|
479 | const AltAz ANAW(CalcAnAw(p, -1));
|
---|
480 | p += ANAW;
|
---|
481 |
|
---|
482 | /* Old correction terms for An and Aw:
|
---|
483 | const AltAz AW( fAw*sin(p.Az()), -fAw*cos(p.Az())*tan(p.Alt()));
|
---|
484 | const AltAz AN(-fAn*cos(p.Az()), -fAn*sin(p.Az())*tan(p.Alt()));
|
---|
485 | p += AW;
|
---|
486 | p += AN;
|
---|
487 | */
|
---|
488 |
|
---|
489 | DEBUG(cout << "Bend1: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
490 |
|
---|
491 | const AltAz FLOP(Sign(fFlop, p.Alt()), 0);
|
---|
492 | p += FLOP;
|
---|
493 |
|
---|
494 | const AltAz MAGIC1(fMagic1*TMath::Sign(1., sin(p.Az())), 0);
|
---|
495 | p += MAGIC1;
|
---|
496 |
|
---|
497 | const AltAz I(fIe, fIa);
|
---|
498 | p += I;
|
---|
499 |
|
---|
500 | DEBUG(cout << "Bend0: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
501 |
|
---|
502 | return p;
|
---|
503 | }
|
---|
504 |
|
---|
505 | AltAz MPointing::CorrectBack(const AltAz &aa) const
|
---|
506 | {
|
---|
507 | // Correct [rad]
|
---|
508 | // zdaz [rad]
|
---|
509 | AltAz p = aa;
|
---|
510 |
|
---|
511 | DEBUG(cout << setprecision(16));
|
---|
512 | DEBUG(cout << "Back0: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
513 |
|
---|
514 | const AltAz I(fIe, fIa);
|
---|
515 | p -= I;
|
---|
516 |
|
---|
517 | const AltAz MAGIC1(fMagic1*TMath::Sign(1., sin(p.Az())), 0);
|
---|
518 | p -= MAGIC1;
|
---|
519 |
|
---|
520 | //const AltAz MAGIC1(fMagic1*sin(p.Az()), 0);
|
---|
521 | //p -= MAGIC1;
|
---|
522 |
|
---|
523 | const AltAz FLOP(Sign(fFlop, p.Alt()), 0);
|
---|
524 | p -= FLOP;
|
---|
525 |
|
---|
526 | DEBUG(cout << "Back1: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
527 |
|
---|
528 | /* Old correction terms for An and Aw:
|
---|
529 | const AltAz AN(-fAn*cos(p.Az()), -fAn*sin(p.Az())*tan(p.Alt()));
|
---|
530 | const AltAz AW( fAw*sin(p.Az()), -fAw*cos(p.Az())*tan(p.Alt()));
|
---|
531 | p -= AN;
|
---|
532 | p -= AW;
|
---|
533 | */
|
---|
534 |
|
---|
535 | const AltAz ANAW(CalcAnAw(p, -1));
|
---|
536 | p -= ANAW;
|
---|
537 |
|
---|
538 | DEBUG(cout << "Back2: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
539 |
|
---|
540 | //Old Correction terms for Npae and Ca:
|
---|
541 | const AltAz NPAE(0, -fNpae*tan(p.Alt()));
|
---|
542 | p -= NPAE;
|
---|
543 |
|
---|
544 | const AltAz CA(0, -fCa/cos(p.Alt()));
|
---|
545 | p -= CA;
|
---|
546 |
|
---|
547 | /*
|
---|
548 | //New Correction term for Npae and Ca:
|
---|
549 | TVector3 v2(1.,1.,1.); // Vector in cartesian coordinates
|
---|
550 | //Set Azimuth and Elevation
|
---|
551 | v2.SetPhi(p.Az());
|
---|
552 | v2.SetTheta(TMath::Pi()/2-p.Alt());
|
---|
553 | //Rotation Vectors:
|
---|
554 | TVector3 vNpae( cos(p.Az()), sin(p.Az()), 0);
|
---|
555 | TVector3 vCa( -cos(p.Az())*cos(p.Alt()), -sin(p.Az())*cos(p.Alt()), sin(p.Alt()));
|
---|
556 | //Rotate around the vectors vCa and vNpae
|
---|
557 | v2.Rotate(-fCa, vCa);
|
---|
558 | v2.Rotate(-fNpae, vNpae);
|
---|
559 |
|
---|
560 | p.Az(v2.Phi());
|
---|
561 | p.Alt(TMath::Pi()/2-v2.Theta());
|
---|
562 | */
|
---|
563 |
|
---|
564 | DEBUG(cout << "Back3: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
565 |
|
---|
566 | const AltAz TF(Sign(fTf*cos(p.Alt()), p.Alt()), 0);
|
---|
567 | const AltAz TX(Sign(fTx/tan(p.Alt()), p.Alt()), 0);
|
---|
568 | p -= TF;
|
---|
569 | //p -= TX;
|
---|
570 |
|
---|
571 | DEBUG(cout << "Back4: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
572 |
|
---|
573 | const AltAz CEC(-fEcec*cos(p.Alt()), -fAcec*cos(p.Az()));
|
---|
574 | const AltAz CES(-fEces*sin(p.Alt()), -fAces*sin(p.Az()));
|
---|
575 | p -= CEC;
|
---|
576 | p -= CES;
|
---|
577 |
|
---|
578 | DEBUG(cout << "Back5: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
579 |
|
---|
580 | const AltAz NRY(fNry*cos(p.Alt()), -fNry*tan(p.Alt()));
|
---|
581 | const AltAz NRX(fNrx*sin(p.Alt()), -fNrx);
|
---|
582 | p -= NRY;
|
---|
583 | p -= NRX;
|
---|
584 |
|
---|
585 | DEBUG(cout << "Back6: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
586 |
|
---|
587 | const AltAz CRY(-fCry*cos(p.Az()-p.Alt()), -fCry*sin(p.Az()-p.Alt())/cos(p.Alt()));
|
---|
588 | const AltAz CRX(-fCrx*sin(p.Az()-p.Alt()), fCrx*cos(p.Az()-p.Alt())/cos(p.Alt()));
|
---|
589 | p -= CRY;
|
---|
590 | p -= CRX;
|
---|
591 |
|
---|
592 | DEBUG(cout << "Back7: " << 90-p.Alt()*180/TMath::Pi() << " " << p.Az()*180/TMath::Pi() << endl);
|
---|
593 |
|
---|
594 | return p;
|
---|
595 | }
|
---|
596 |
|
---|
597 | ZdAz MPointing::Correct(const ZdAz &zdaz) const
|
---|
598 | {
|
---|
599 | // Correct [rad]
|
---|
600 | // zdaz [rad]
|
---|
601 | AltAz p(TMath::Pi()/2-zdaz.Zd(), zdaz.Az());
|
---|
602 | AltAz c = Correct(p);
|
---|
603 | return ZdAz(TMath::Pi()/2-c.Alt(), c.Az());
|
---|
604 | }
|
---|
605 |
|
---|
606 | TVector3 MPointing::Correct(const TVector3 &v) const
|
---|
607 | {
|
---|
608 | // Correct [rad]
|
---|
609 | // zdaz [rad]
|
---|
610 | AltAz p(TMath::Pi()/2-v.Theta(), v.Phi());
|
---|
611 | AltAz c = Correct(p);
|
---|
612 | TVector3 rc;
|
---|
613 | rc.SetMagThetaPhi(1, TMath::Pi()/2-c.Alt(), c.Az());
|
---|
614 | return rc;
|
---|
615 | }
|
---|
616 |
|
---|
617 | ZdAz MPointing::CorrectBack(const ZdAz &zdaz) const
|
---|
618 | {
|
---|
619 | // Correct [rad]
|
---|
620 | // zdaz [rad]
|
---|
621 | AltAz p(TMath::Pi()/2-zdaz.Zd(), zdaz.Az());
|
---|
622 | AltAz c = CorrectBack(p);
|
---|
623 | return ZdAz(TMath::Pi()/2-c.Alt(), c.Az());
|
---|
624 | }
|
---|
625 |
|
---|
626 | TVector3 MPointing::CorrectBack(const TVector3 &v) const
|
---|
627 | {
|
---|
628 | // Correct [rad]
|
---|
629 | // zdaz [rad]
|
---|
630 | AltAz p(TMath::Pi()/2-v.Theta(), v.Phi());
|
---|
631 | AltAz c = CorrectBack(p);
|
---|
632 | TVector3 rc;
|
---|
633 | rc.SetMagThetaPhi(1, TMath::Pi()/2-c.Alt(), c.Az());
|
---|
634 | return rc;
|
---|
635 | }
|
---|
636 |
|
---|
637 | void MPointing::SetParameters(const Double_t *par, Int_t n)
|
---|
638 | {
|
---|
639 | Clear();
|
---|
640 |
|
---|
641 | while (n--)
|
---|
642 | *fCoeff[n] = par[n]/kRad2Deg;
|
---|
643 | }
|
---|
644 |
|
---|
645 | void MPointing::GetParameters(Double_t *par, Int_t n) const
|
---|
646 | {
|
---|
647 | while (n--)
|
---|
648 | par[n] = *fCoeff[n]*kRad2Deg;
|
---|
649 | }
|
---|
650 |
|
---|
651 | void MPointing::SetMinuitParameters(TMinuit &m, Int_t n) const
|
---|
652 | {
|
---|
653 | if (n<0)
|
---|
654 | n = fNumPar;
|
---|
655 |
|
---|
656 | Int_t ierflg = 0;
|
---|
657 |
|
---|
658 | while (n--)
|
---|
659 | m.mnparm(n, fNames[n], *fCoeff[n]*kRad2Deg, 1, -360, 360, ierflg);
|
---|
660 | }
|
---|
661 |
|
---|
662 | void MPointing::GetMinuitParameters(TMinuit &m, Int_t n)
|
---|
663 | {
|
---|
664 | if (n<0 || n>m.GetNumPars())
|
---|
665 | n = m.GetNumPars();
|
---|
666 |
|
---|
667 | while (n--)
|
---|
668 | {
|
---|
669 | m.GetParameter(n, *fCoeff[n], fError[n]);
|
---|
670 | *fCoeff[n] /= kRad2Deg;
|
---|
671 | fError[n] /= kRad2Deg;
|
---|
672 | }
|
---|
673 | }
|
---|
674 | /*
|
---|
675 | void FormatPar(TMinuit &m, Int_t n)
|
---|
676 | {
|
---|
677 | Double_t par, err;
|
---|
678 | m.GetParameter(n, par, err);
|
---|
679 |
|
---|
680 | int expp = (int)log10(par);
|
---|
681 | int expe = (int)log10(err);
|
---|
682 |
|
---|
683 | if (err<2*pow(10, expe))
|
---|
684 | expe--;
|
---|
685 |
|
---|
686 | Int_t exp = expe>expp ? expp : expe;
|
---|
687 |
|
---|
688 | par = (int)(par/pow(10, exp)) * pow(10, exp);
|
---|
689 | err = (int)(err/pow(10, exp)) * pow(10, exp);
|
---|
690 |
|
---|
691 | cout << par << " +- " << err << flush;
|
---|
692 | }
|
---|
693 | */
|
---|
694 | void MPointing::PrintMinuitParameters(TMinuit &m, Int_t n) const
|
---|
695 | {
|
---|
696 | if (n<0)
|
---|
697 | n = m.GetNumPars();
|
---|
698 |
|
---|
699 | cout << setprecision(3);
|
---|
700 |
|
---|
701 | Double_t par, err;
|
---|
702 |
|
---|
703 | while (n--)
|
---|
704 | {
|
---|
705 | m.GetParameter(n, par, err);
|
---|
706 | cout << Form(" %2d %6s: ", n, (const char*)fNames[n]);
|
---|
707 | cout << setw(8) << par << " \xb1 " << setw(6) << err << endl;
|
---|
708 | }
|
---|
709 | }
|
---|