1 | #include "MCaos.h"
|
---|
2 |
|
---|
3 | #include <iostream>
|
---|
4 | #include <iomanip>
|
---|
5 |
|
---|
6 | #include <TSystem.h>
|
---|
7 | #include <TFile.h>
|
---|
8 | #include <TTree.h>
|
---|
9 | #include <TH1.h>
|
---|
10 | #include <TH2.h>
|
---|
11 | #include <TGraph.h>
|
---|
12 | #include <TCanvas.h>
|
---|
13 |
|
---|
14 | #include "Led.h"
|
---|
15 | #include "Ring.h"
|
---|
16 | #include "Rings.h"
|
---|
17 | #include "FilterLed.h"
|
---|
18 |
|
---|
19 | #include "coord.h"
|
---|
20 | #include "base/timer.h"
|
---|
21 |
|
---|
22 | void MCaos::ReadResources(const char *name="leds.txt")
|
---|
23 | {
|
---|
24 | ifstream fin(name);
|
---|
25 | if (!fin)
|
---|
26 | {
|
---|
27 | cout << "ERROR - Cannot open " << name << endl;
|
---|
28 | return;
|
---|
29 | }
|
---|
30 |
|
---|
31 | fPositions.Clear();
|
---|
32 |
|
---|
33 | cout << " Reading " << name << ":" << endl;
|
---|
34 | cout << "------------------------------" << endl;
|
---|
35 |
|
---|
36 | while (1)
|
---|
37 | {
|
---|
38 | Double_t px, py, ox, oy;
|
---|
39 | fin >> px >> py >> ox >> oy;
|
---|
40 | if (!fin)
|
---|
41 | break;
|
---|
42 |
|
---|
43 | cout << " Led #" << fPositions.GetEntriesFast() << ": ";
|
---|
44 | cout << setw(3) << px << " ";
|
---|
45 | cout << setw(3) << py << " (";
|
---|
46 | cout << setw(3) << ox << ", ";
|
---|
47 | cout << setw(3) << oy << ")" << endl;
|
---|
48 | AddPosition(px, py, ox, oy);
|
---|
49 | }
|
---|
50 | cout << "Found " << fPositions.GetEntriesFast() << " leds." << endl;
|
---|
51 | }
|
---|
52 |
|
---|
53 | void MCaos::OpenFile()
|
---|
54 | {
|
---|
55 | int i=0;
|
---|
56 | char name[100];
|
---|
57 | while (1)
|
---|
58 | {
|
---|
59 | sprintf(name, "data/data%03d.root", i++);
|
---|
60 | if (gSystem->AccessPathName(name, kFileExists))
|
---|
61 | break;
|
---|
62 | }
|
---|
63 |
|
---|
64 | if (fFile)
|
---|
65 | delete fFile;
|
---|
66 |
|
---|
67 | fFile = new TFile(name, "RECREATE");
|
---|
68 |
|
---|
69 | if (!fFile->IsOpen())
|
---|
70 | {
|
---|
71 | delete fFile;
|
---|
72 | fFile = NULL;
|
---|
73 |
|
---|
74 | cout << "Error: Cannot open file '" << name << "'" << endl;
|
---|
75 | }
|
---|
76 |
|
---|
77 | TTree *tree = new TTree("Data", "Real CaOs Data");
|
---|
78 |
|
---|
79 | fLeds = new Leds;
|
---|
80 | fEvtTime = 0;
|
---|
81 |
|
---|
82 | tree->Branch("Leds", "TClonesArray", &fLeds);
|
---|
83 | tree->Branch("ZenithDist.", &fZenithDist, "fZenithDist/D");
|
---|
84 | tree->Branch("Azimuth.", &fAzimuth, "fAzimuth/D");
|
---|
85 | tree->Branch("EvtTime.", &fEvtTime, "fEvtTime/D");
|
---|
86 |
|
---|
87 | cout << "Root file '" << name << "' open." << endl;
|
---|
88 | }
|
---|
89 |
|
---|
90 | void MCaos::CloseFile()
|
---|
91 | {
|
---|
92 | if (!fFile)
|
---|
93 | return;
|
---|
94 |
|
---|
95 | const TString name = fFile->GetName();
|
---|
96 | const Double_t n = ((TTree*)fFile->Get("Data"))->GetEntries();
|
---|
97 |
|
---|
98 | fFile->Write();
|
---|
99 | delete fFile;
|
---|
100 | fFile = NULL;
|
---|
101 |
|
---|
102 | cout << "Root file closed (n=" << n << ")" << endl;
|
---|
103 |
|
---|
104 | if (n<1)
|
---|
105 | {
|
---|
106 | gSystem->Unlink(name);
|
---|
107 | cout << "Root file deleted - no entries." << endl;
|
---|
108 | }
|
---|
109 | }
|
---|
110 |
|
---|
111 | void MCaos::InitHistograms()
|
---|
112 | {
|
---|
113 | if (fHistpr)
|
---|
114 | return;
|
---|
115 |
|
---|
116 | Rings r;
|
---|
117 | r.CalcRings(fPositions);
|
---|
118 |
|
---|
119 | const Ring &c = r.GetCenter();
|
---|
120 |
|
---|
121 | Double_t xmin = c.GetX()-50;
|
---|
122 | Double_t xmax = c.GetX()+50;
|
---|
123 |
|
---|
124 | Double_t ymin = c.GetY()-50;
|
---|
125 | Double_t ymax = c.GetY()+50;
|
---|
126 |
|
---|
127 | Double_t rmin = c.GetR()-50;
|
---|
128 | Double_t rmax = c.GetR()+50;
|
---|
129 |
|
---|
130 | Int_t xbin = 1001;
|
---|
131 | Int_t ybin = 1001;
|
---|
132 | Int_t rbin = 1001;
|
---|
133 |
|
---|
134 | const Int_t sz = 50;
|
---|
135 | fHistled = new TH2F*[fPositions.GetEntriesFast()];
|
---|
136 | fHistw = new TH1F*[fPositions.GetEntriesFast()];
|
---|
137 | for (int i=0; i<fPositions.GetEntriesFast(); i++)
|
---|
138 | {
|
---|
139 | TString name = "LED";
|
---|
140 | TString title = "LED #";
|
---|
141 |
|
---|
142 | name += i;
|
---|
143 | title += i;
|
---|
144 |
|
---|
145 | const Led &p = fPositions(i);
|
---|
146 | fHistled[i] = new TH2F(name, title,
|
---|
147 | 20*sz+1, p.GetX()-sz, p.GetX()+sz,
|
---|
148 | 20*sz+1, p.GetY()-sz, p.GetY()+sz);
|
---|
149 | fHistled[i]->SetXTitle("x [pix]");
|
---|
150 | fHistled[i]->SetYTitle("counts");
|
---|
151 |
|
---|
152 | name = "Angle";
|
---|
153 | title = "Angle of the Led #";
|
---|
154 |
|
---|
155 | name += i;
|
---|
156 | title += i;
|
---|
157 |
|
---|
158 | fHistw[i] = new TH1F;
|
---|
159 | fHistw[i]->SetNameTitle(name, title);
|
---|
160 | fHistw[i]->SetBins(721, -180.5, 180.5);
|
---|
161 | fHistw[i]->SetXTitle("\\Phi [deg]");
|
---|
162 | fHistw[i]->SetYTitle("counts");
|
---|
163 | }
|
---|
164 |
|
---|
165 | fHistallw = new TH1F;
|
---|
166 | fHistallw->SetNameTitle("allw","Rotation angel");
|
---|
167 | fHistallw->SetBins(26, -25, 25);
|
---|
168 | fHistallw->SetXTitle("\\Phi [arcmin]");
|
---|
169 | fHistallw->SetYTitle("counts");
|
---|
170 |
|
---|
171 | fHistprxpry = new TH2F;
|
---|
172 | fHistprxpry->SetNameTitle("prx und pry","x- and y-coordniate of the ring-center");
|
---|
173 | fHistprxpry->SetBins(xbin, xmin, xmax, ybin, ymin, ymax);
|
---|
174 | fHistprxpry->SetXTitle("x [mm]");
|
---|
175 | fHistprxpry->SetYTitle("y [mm]");
|
---|
176 | fHistprxpry->SetZTitle("counts");
|
---|
177 |
|
---|
178 | fGraphprx = new TGraph;
|
---|
179 | fGraphprx->SetTitle("time-developement of the x-coordinate of the ring-center");
|
---|
180 |
|
---|
181 | fGraphpry = new TGraph;
|
---|
182 | fGraphpry->SetTitle("time-developement of the y-coordinate of the ring-center");
|
---|
183 |
|
---|
184 | fGraphw = new TGraph*[fPositions.GetEntriesFast()];
|
---|
185 | for (int i=0; i<fPositions.GetEntriesFast(); i++)
|
---|
186 | {
|
---|
187 | TString title = "Time-developement of the angle ";
|
---|
188 | title += i;
|
---|
189 |
|
---|
190 | fGraphw[i] = new TGraph;
|
---|
191 | fGraphw[i]->SetTitle(title);
|
---|
192 | }
|
---|
193 |
|
---|
194 | fHistpr = new TH1F("pr","Radius of the ring", rbin, rmin, rmax);
|
---|
195 | fHistpr->SetXTitle("r [pix]");
|
---|
196 | fHistpr->SetYTitle("counts");
|
---|
197 | }
|
---|
198 |
|
---|
199 | void MCaos::DeleteHistograms()
|
---|
200 | {
|
---|
201 | TH1F *dummy = fHistpr;
|
---|
202 | fHistpr=NULL;
|
---|
203 |
|
---|
204 | if (!dummy)
|
---|
205 | return;
|
---|
206 |
|
---|
207 | delete dummy;
|
---|
208 | delete fHistprxpry;
|
---|
209 | delete fHistallw;
|
---|
210 | delete fGraphprx;
|
---|
211 | delete fGraphpry;
|
---|
212 |
|
---|
213 | for (int i=0; i<6; i++)
|
---|
214 | {
|
---|
215 | delete fHistled[i];
|
---|
216 | delete fHistw[i];
|
---|
217 | delete fGraphw[i];
|
---|
218 | }
|
---|
219 | delete fHistled;
|
---|
220 | delete fHistw;
|
---|
221 | }
|
---|
222 |
|
---|
223 | void MCaos::ShowHistograms()
|
---|
224 | {
|
---|
225 | if (!fHistpr || fHistpr->GetEntries()<1)
|
---|
226 | return;
|
---|
227 |
|
---|
228 | TH1 *h;
|
---|
229 |
|
---|
230 | TCanvas *c = new TCanvas("cring", "Center of the ring", 800, 800);
|
---|
231 | c->Divide(2,2);
|
---|
232 | c->cd(1);
|
---|
233 | h = (TH1*)fHistprxpry->ProfileX();
|
---|
234 | h->Fit("gaus");
|
---|
235 | h->Draw();
|
---|
236 | h->SetBit(kCanDelete);
|
---|
237 | c->cd(2);
|
---|
238 | h = (TH1*)fHistprxpry->ProfileY();
|
---|
239 | h->Fit("gaus");
|
---|
240 | h->Draw();
|
---|
241 | h->SetBit(kCanDelete);
|
---|
242 | c->cd(3);
|
---|
243 | fHistpr->Fit("gaus");
|
---|
244 | fHistpr->DrawCopy();
|
---|
245 | c->cd(4);
|
---|
246 | fHistprxpry->DrawCopy(/*"surf2"*/);
|
---|
247 | c->Update();
|
---|
248 |
|
---|
249 | const Int_t n1 = (Int_t)(sqrt(fPositions.GetEntriesFast())+1.0);
|
---|
250 | const Int_t n2 = (Int_t)(sqrt(fPositions.GetEntriesFast())+0.5);
|
---|
251 |
|
---|
252 | TCanvas *c1 = new TCanvas("cpos", "Led Positions", 800, 600);
|
---|
253 | TCanvas *c2 = new TCanvas("cangle", "Angles of the Leds", 800, 600);
|
---|
254 | c1->Divide(n1, n2);
|
---|
255 | c2->Divide(n1, n2);
|
---|
256 | for (int i=0; i<fPositions.GetEntriesFast(); i++)
|
---|
257 | {
|
---|
258 | c1->cd(i+1);
|
---|
259 | fHistled[i]->DrawCopy();
|
---|
260 | c2->cd(i+1);
|
---|
261 | fHistw[i]->DrawCopy();
|
---|
262 | }
|
---|
263 | c1->Update();
|
---|
264 | c2->Update();
|
---|
265 |
|
---|
266 | c = new TCanvas("ctime", "timedevelopement of center", 800, 800);
|
---|
267 | c->Divide(1,2);
|
---|
268 | c->cd(1);
|
---|
269 | h = fGraphprx->GetHistogram();
|
---|
270 | h->SetXTitle("time [s]");
|
---|
271 | h->SetYTitle("x [pix]");
|
---|
272 | h->DrawCopy();
|
---|
273 | //fGraphprx->DrawClone("LP*")->SetBit(kCanDelete);
|
---|
274 | c->cd(2);
|
---|
275 | h = fGraphpry->GetHistogram();
|
---|
276 | h->SetXTitle("time [s]");
|
---|
277 | h->SetYTitle("y [pix]");
|
---|
278 | h->DrawCopy();
|
---|
279 | //fGraphpry->DrawClone("LP*")->SetBit(kCanDelete);
|
---|
280 | c->Modified();
|
---|
281 | c->Update();
|
---|
282 |
|
---|
283 | /* --------------------------------------------------------
|
---|
284 | * CALCULATE OFFSETS!
|
---|
285 | * --------------------------------------------------------
|
---|
286 | Rings r;
|
---|
287 | r.CalcRings(fPositions);
|
---|
288 |
|
---|
289 | const Ring &c = r.GetCenter();
|
---|
290 | */
|
---|
291 | }
|
---|
292 |
|
---|
293 | void MCaos::ResetHistograms()
|
---|
294 | {
|
---|
295 | if (!fHistpr)
|
---|
296 | return;
|
---|
297 |
|
---|
298 | fHistpr->Reset();
|
---|
299 | fHistprxpry->Reset();
|
---|
300 | fHistallw->Reset();
|
---|
301 | for (int i=0; i<6; i++)
|
---|
302 | {
|
---|
303 | fHistled[i]->Reset();
|
---|
304 | fHistw[i]->Reset();
|
---|
305 | }
|
---|
306 | }
|
---|
307 |
|
---|
308 | void MCaos::Run(byte *img, bool printl, bool printr, const ZdAz &pos, const Timer &t)
|
---|
309 | {
|
---|
310 | Leds &leds = *fLeds;
|
---|
311 | leds.Clear();
|
---|
312 |
|
---|
313 | // img width height radius sigma
|
---|
314 | FilterLed f(img, 768, 576, 50, 3.0);
|
---|
315 |
|
---|
316 | Int_t first=0;
|
---|
317 | for (int i=0; i<fPositions.GetEntriesFast(); i++)
|
---|
318 | {
|
---|
319 | // Try to find Led in this area
|
---|
320 | const Led &l0 = fPositions(i);
|
---|
321 | f.Execute(leds, l0.GetX(), l0.GetY());
|
---|
322 |
|
---|
323 | // Loop over newly found Leds
|
---|
324 | for (int j=first; j<leds.GetEntries(); j++)
|
---|
325 | {
|
---|
326 | Led &l1 = leds(j);
|
---|
327 |
|
---|
328 | // Add Offset to Led
|
---|
329 | l1.AddOffset(l0.GetDx(), l0.GetDy());
|
---|
330 |
|
---|
331 | // Mark Led in image (FIXME: Move to MStarguider)
|
---|
332 | f.MarkPoint(l1.GetX(), l1.GetY(), l1.GetMag());
|
---|
333 |
|
---|
334 | // Fill values into Histogram
|
---|
335 | if (!fHistpr)
|
---|
336 | continue;
|
---|
337 |
|
---|
338 | fHistled[i]->Fill(l1.GetX(), l1.GetY());
|
---|
339 | fHistw[i]->Fill(l1.GetPhi());
|
---|
340 | }
|
---|
341 | first = leds.GetEntries();
|
---|
342 | }
|
---|
343 |
|
---|
344 | Rings rings;
|
---|
345 | rings.CalcRings(leds, 266, 272);
|
---|
346 |
|
---|
347 | const Ring ¢er = rings.GetCenter();
|
---|
348 |
|
---|
349 | f.DrawCircle(center, 0x80);
|
---|
350 | f.DrawCircle(center, 5.0, 0x80);
|
---|
351 | f.DrawCircle(center, 115.0, 0x80);
|
---|
352 | f.DrawCircle(center, 190.0, 0x80);
|
---|
353 | // f.MarkPoint(center.GetX(), center.GetY(), 0xa0);
|
---|
354 |
|
---|
355 | // FIXME!
|
---|
356 | static const Timer t0(t);
|
---|
357 | fEvtTime = (double)t-(double)t0;
|
---|
358 |
|
---|
359 | if (fHistpr)
|
---|
360 | {
|
---|
361 | fHistpr->Fill(center.GetR());
|
---|
362 | fHistprxpry->Fill(center.GetX(), center.GetY());
|
---|
363 | fGraphprx->SetPoint(fGraphprx->GetN(), fEvtTime, center.GetX());
|
---|
364 | fGraphpry->SetPoint(fGraphpry->GetN(), fEvtTime, center.GetY());
|
---|
365 | }
|
---|
366 |
|
---|
367 | if (printl)
|
---|
368 | leds.Print();
|
---|
369 | if (printr)
|
---|
370 | rings.Print();
|
---|
371 |
|
---|
372 | if (fFile && leds.GetEntries()>0)
|
---|
373 | {
|
---|
374 | fZenithDist = pos.Zd(); //fCosy ? fCosy->GetPointingPos().Zd() : 0
|
---|
375 | fAzimuth = pos.Az(); //fCosy ? fCosy->GetPointingPos().Az() : 0;
|
---|
376 |
|
---|
377 | TTree *t = (TTree*)fFile->Get("Data");
|
---|
378 | t->Fill();
|
---|
379 | }
|
---|
380 |
|
---|
381 | /*
|
---|
382 | if (fCaosAnalyse->IsEntryEnabled(IDM_kStopAnalyse))
|
---|
383 | {
|
---|
384 | const Ring ¢er = rings.GetCenter();
|
---|
385 |
|
---|
386 | Double_t phi[6] =
|
---|
387 | {
|
---|
388 | -124.727,
|
---|
389 | -61.0495,
|
---|
390 | -16.7907,
|
---|
391 | 49.3119,
|
---|
392 | 139.086
|
---|
393 | };
|
---|
394 |
|
---|
395 | Double_t sum = 0;
|
---|
396 | for (int i=0; i<6 && leds.At(i); i++)
|
---|
397 | {
|
---|
398 | const Double_t w = (leds(i).GetPhi()-phi[i])*60;
|
---|
399 |
|
---|
400 | sum += w;
|
---|
401 |
|
---|
402 | fHistw[i]->Fill(w);
|
---|
403 | fHistv[i]->Fill(leds(i).GetPhi());
|
---|
404 | fGraphw[i]->SetPoint(fGraphw[i]->GetN(), fEvtTime, w);
|
---|
405 | }
|
---|
406 | fHistallw->Fill(sum/5);
|
---|
407 | }
|
---|
408 | */
|
---|
409 | }
|
---|
410 |
|
---|