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