source: trunk/FACT++/src/ratescan.cc@ 12686

Last change on this file since 12686 was 12654, checked in by tbretz, 13 years ago
Changing the step size didn't work with the previous implementation.
File size: 18.6 KB
Line 
1#include <valarray>
2
3#include "Dim.h"
4#include "Event.h"
5#include "Shell.h"
6#include "StateMachineDim.h"
7#include "Connection.h"
8#include "Configuration.h"
9#include "Console.h"
10#include "Converter.h"
11#include "DimServiceInfoList.h"
12//#include "PixelMap.h"
13
14#include "tools.h"
15
16#include "LocalControl.h"
17
18#include "HeadersFTM.h"
19
20namespace ba = boost::asio;
21namespace bs = boost::system;
22namespace dummy = ba::placeholders;
23
24using namespace std;
25
26// ------------------------------------------------------------------------
27
28#include "DimDescriptionService.h"
29
30// ------------------------------------------------------------------------
31
32class StateMachineRateScan : public StateMachineDim, public DimInfoHandler
33{
34 /*
35 int Wrap(boost::function<void()> f)
36 {
37 f();
38 return T::GetCurrentState();
39 }
40
41 boost::function<int(const EventImp &)> Wrapper(boost::function<void()> func)
42 {
43 return bind(&StateMachineMCP::Wrap, this, func);
44 }*/
45
46private:
47 enum states_t
48 {
49 kStateDimNetworkNA = 1,
50 kStateDisconnected,
51 kStateConnecting,
52 kStateConnected,
53 kStateInProgress,
54 };
55
56// PixelMap fMap;
57
58 DimServiceInfoList fNetwork;
59
60 pair<Time, int> fStatusDim;
61 pair<Time, int> fStatusFTM;
62
63 DimStampedInfo fDim;
64 DimStampedInfo fFTM;
65 DimStampedInfo fRates;
66
67 DimDescribedService fDimData;
68 DimDescribedService fDimProc;
69
70 int fSeconds;
71 int fSecondsMax;
72
73 int fThreshold;
74 int fThresholdMin;
75 int fThresholdMax;
76 int fThresholdStep;
77
78 double fRate;
79 double fRateBoard[40];
80 double fRatePatch[160];
81
82 double fOnTime;
83
84 uint64_t fStartTime;
85
86 float fResolution;
87
88 enum reference_t
89 {
90 kCamera,
91 kBoard,
92 kPatch
93 };
94
95 reference_t fReference;
96 uint16_t fReferenceIdx;
97
98 string fCommand;
99
100 void UpdateProc()
101 {
102 const array<uint32_t,3> v = {{ fThresholdMin, fThresholdMax, fThresholdStep }};
103 fDimProc.Update(v);
104 }
105
106 pair<Time, int> GetNewState(DimStampedInfo &info) const
107 {
108 const bool disconnected = info.getSize()==0;
109
110 // Make sure getTimestamp is called _before_ getTimestampMillisecs
111 const int tsec = info.getTimestamp();
112 const int tms = info.getTimestampMillisecs();
113
114 return make_pair(Time(tsec, tms*1000),
115 disconnected ? -2 : info.getQuality());
116 }
117
118 bool CheckEventSize(size_t has, const char *name, size_t size)
119 {
120 if (has==size)
121 return true;
122
123 if (has==0)
124 return false;
125
126 ostringstream msg;
127 msg << name << " - Received event has " << has << " bytes, but expected " << size << ".";
128 Fatal(msg);
129 return false;
130 }
131
132 void infoHandler()
133 {
134 DimInfo *curr = getInfo(); // get current DimInfo address
135 if (!curr)
136 return;
137
138 if (curr==&fFTM)
139 {
140 fStatusFTM = GetNewState(fFTM);
141 return;
142 }
143
144 if (curr==&fDim)
145 {
146 fStatusDim = GetNewState(fDim);
147 fStatusDim.second = curr->getSize()==4 ? curr->getInt() : 0;
148 return;
149 }
150
151 if (curr==&fRates)
152 {
153 if (!CheckEventSize(curr->getSize(), "infoHandler[DimTriggerRates]", sizeof(FTM::DimTriggerRates)))
154 return;
155
156 if (fThreshold<0/* || fStatusFTM.second!=FTM::kTakingData*/)
157 return;
158
159 const FTM::DimTriggerRates &sdata = *static_cast<FTM::DimTriggerRates*>(curr->getData());
160
161 if (++fSeconds<0)
162 return;
163
164 if (fSeconds==0)
165 {
166 fRate = 0;
167
168 memset(fRateBoard, 0, 40*sizeof(double));
169 memset(fRatePatch, 0, 160*sizeof(double));
170
171 fOnTime = 0;
172 return;
173 }
174
175 if (sdata.fTriggerRate==0)
176 {
177 Message("Rate scan stopped due zero trigger rate.");
178 fThreshold = -1;
179 return;
180 }
181
182 fRate += sdata.fTriggerRate;
183 for (int i=0; i<40; i++)
184 fRateBoard[i] += sdata.fBoardRate[i];
185 for (int i=0; i<160; i++)
186 fRatePatch[i] += sdata.fPatchRate[i];
187
188 double reference = fRate;
189 if (fReference==kBoard)
190 reference = fRateBoard[fReferenceIdx];
191 if (fReference==kPatch)
192 reference = fRatePatch[fReferenceIdx];
193
194 fOnTime += sdata.fOnTime;
195
196 reference *= sdata.fElapsedTime;
197
198 if ((reference==0 || sqrt(reference)>fResolution*reference) && fSeconds<fSecondsMax)
199 {
200 ostringstream out;
201 out << "Triggers so far: " << reference;
202 if (reference>0)
203 out << " (" << sqrt(reference)/reference << ")";
204 Info(out);
205
206 return;
207 }
208
209 const double time = sdata.fElapsedTime*fSeconds;
210 const uint32_t th = fThreshold;
211
212 float data[2+3+1+40+160];
213 memcpy(data, &fStartTime, 8);
214 memcpy(data+2, &th, 4);
215 data[3] = time; // total elapsed time
216 data[4] = fOnTime/time; // relative on time
217 data[5] = fRate/fSeconds;
218 for (int i=0; i<40; i++)
219 data[i+6] = fRateBoard[i]/fSeconds;
220 for (int i=0; i<160; i++)
221 data[i+46] = fRatePatch[i]/fSeconds;
222
223 ostringstream sout1, sout2, sout3;
224
225 sout1 << th << " " << data[5];
226 for (int i=0; i<200; i++)
227 sout2 << " " << data[i+6];
228 sout3 << " " << data[3] << " " << data[4];
229
230 Info(sout1.str());
231
232 ofstream fout("ratescan.txt", ios::app);
233 fout << sout1.str() << sout2.str() << sout3.str() << endl;
234
235 fDimData.setQuality(fCommand=="FTM_CONTROL/SET_THRESHOLD");
236 fDimData.setData(data, 204*sizeof(float));
237 fDimData.Update();
238
239 fThreshold += fThresholdStep;
240
241 if (fSeconds>=fSecondsMax)
242 {
243 Message("Rate scan stopped due to timeout.");
244 fThreshold=-1;
245 return;
246 }
247
248 if (fThreshold>fThresholdMax)
249 {
250 Message("Rate scan finished.");
251 fThreshold = -1;
252 return;
253 }
254
255 fSeconds = -2; // FIXME: In principle one missed report is enough
256
257 const int32_t cmd[2] = { -1, fThreshold };
258 DimClient::sendCommandNB(fCommand.c_str(), (void*)cmd, 8);
259 }
260 }
261
262 void PrintState(const pair<Time,int> &state, const char *server)
263 {
264 const State rc = fNetwork.GetState(server, state.second);
265
266 Out() << state.first.GetAsStr("%H:%M:%S.%f").substr(0, 12) << " - ";
267 Out() << kBold << server << ": ";
268 Out() << rc.name << "[" << rc.index << "]";
269 Out() << kReset << " - " << kBlue << rc.comment << endl;
270 }
271
272 int Print()
273 {
274 Out() << fStatusDim.first.GetAsStr("%H:%M:%S.%f").substr(0, 12) << " - ";
275 Out() << kBold << "DIM_DNS: ";
276 if (fStatusDim.second==0)
277 Out() << "Offline" << endl;
278 else
279 Out() << "V" << fStatusDim.second/100 << 'r' << fStatusDim.second%100 << endl;
280
281 PrintState(fStatusFTM, "FTM_CONTROL");
282
283 return GetCurrentState();
284 }
285
286 int StartRateScan(const EventImp &evt, const string &command)
287 {
288 if (!CheckEventSize(evt.GetSize(), "StartRateScan", 12))
289 return kSM_FatalError;
290
291 fCommand = "FTM_CONTROL/"+command;
292
293 fThresholdMin = evt.Get<uint32_t>();
294 fThresholdMax = evt.Get<uint32_t>(4);
295 fThresholdStep = evt.Get<uint32_t>(8);
296
297 UpdateProc();
298
299 const Time now;
300 fStartTime = trunc(now.UnixTime());
301
302 ofstream fout("ratescan.txt", ios::app);
303 fout << "# ----- " << now << " (" << fStartTime << ") -----\n";
304 fout << "# Command: " << fCommand << '\n';
305 fout << "# Reference: ";
306 switch (fReference)
307 {
308 case kCamera: fout << "Camera"; break;
309 case kBoard: fout << "Board #" << fReferenceIdx; break;
310 case kPatch: fout << "Patch #" << fReferenceIdx; break;
311 }
312 fout << '\n';
313 fout << "# -----" << endl;
314
315 Dim::SendCommand("FAD_CONTROL/SET_FILE_FORMAT", uint16_t(0));
316
317 const int32_t data[2] = { -1, fThresholdMin };
318
319 //Message("Starting Trigger (FTM)");
320 //Dim::SendCommand("FTM_CONTROL/SET_PRESCALING", int32_t(20));
321 Dim::SendCommand(fCommand, data);
322 //Dim::SendCommand("FTM_CONTROL/STOP_TRIGGER");
323
324 fThreshold = fThresholdMin;
325 fSeconds = -2;
326
327 ostringstream msg;
328 msg << "Rate scan " << now << "(" << fStartTime << ") from " << fThresholdMin << " to ";
329 msg << fThresholdMax << " in steps of " << fThresholdStep;
330 msg << " started.";
331 Message(msg);
332
333 return GetCurrentState();
334 }
335
336 int StopRateScan()
337 {
338 fThreshold = -1;
339 Message("Rate scan manually stopped.");
340
341 //if (fStatusFTM.second==FTM::kTakingData)
342 {
343 //Message("Stopping FTM");
344 //Dim::SendCommand("FTM_CONTROL/STOP_TRIGGER");
345 }
346
347 return GetCurrentState();
348 }
349
350 int SetReferenceCamera()
351 {
352 fReference = kCamera;
353
354 return GetCurrentState();
355 }
356
357 int SetReferenceBoard(const EventImp &evt)
358 {
359 if (!CheckEventSize(evt.GetSize(), "SetReferenceBoard", 4))
360 return kSM_FatalError;
361
362 if (evt.GetUInt()>39)
363 {
364 Error("SetReferenceBoard - Board index out of range [0;39]");
365 return GetCurrentState();
366 }
367
368 fReference = kBoard;
369 fReferenceIdx = evt.GetUInt();
370
371 return GetCurrentState();
372 }
373
374 int SetReferencePatch(const EventImp &evt)
375 {
376 if (!CheckEventSize(evt.GetSize(), "SetReferencePatch", 4))
377 return kSM_FatalError;
378
379 if (evt.GetUInt()>159)
380 {
381 Error("SetReferencePatch - Patch index out of range [0;159]");
382 return GetCurrentState();
383 }
384
385 fReference = kPatch;
386 fReferenceIdx = evt.GetUInt();
387
388 return GetCurrentState();
389 }
390
391 int ChangeStepSize(const EventImp &evt)
392 {
393 if (!CheckEventSize(evt.GetSize(), "ChangeStepSize", 4))
394 return kSM_FatalError;
395
396 fThresholdStep = evt.Get<uint32_t>();
397
398 UpdateProc();
399
400 return GetCurrentState();
401 }
402
403 int ChangeMaximum(const EventImp &evt)
404 {
405 if (!CheckEventSize(evt.GetSize(), "ChangeMaximum", 4))
406 return kSM_FatalError;
407
408 fThresholdMax = evt.Get<uint32_t>();
409
410 return GetCurrentState();
411 }
412
413 int Execute()
414 {
415 // Dispatch (execute) at most one handler from the queue. In contrary
416 // to run_one(), it doesn't wait until a handler is available
417 // which can be dispatched, so poll_one() might return with 0
418 // handlers dispatched. The handlers are always dispatched/executed
419 // synchronously, i.e. within the call to poll_one()
420 //poll_one();
421
422 if (fStatusDim.second==0)
423 return kStateDimNetworkNA;
424
425 // All subsystems are not connected
426 if (fStatusFTM.second<FTM::kConnected)
427 return kStateDisconnected;
428
429 // At least one subsystem is not connected
430 // if (fStatusFTM.second>=FTM::kConnected)
431 return fThreshold<0 ? kStateConnected : kStateInProgress;
432 }
433
434public:
435 StateMachineRateScan(ostream &out=cout) : StateMachineDim(out, "RATE_SCAN"),
436 fStatusDim(make_pair(Time(), -2)),
437 fStatusFTM(make_pair(Time(), -2)),
438 fDim("DIS_DNS/VERSION_NUMBER", (void*)NULL, 0, this),
439 fFTM("FTM_CONTROL/STATE", (void*)NULL, 0, this),
440 fRates("FTM_CONTROL/TRIGGER_RATES", (void*)NULL, 0, this),
441 fDimData("RATE_SCAN/DATA", "X:1;I:1;F:1;F:1;F:1;F:40;F:160", ""),
442 fDimProc("RATE_SCAN/PROCESS_DATA", "I:1;I:1;I:1",
443 "Rate scan process data"
444 "|min[DAC]:Value at which scan was started"
445 "|max[DAC]:Value at which scan will end"
446 "|step[DAC]:Step size for scan"),
447 fThreshold(-1), fReference(kCamera), fReferenceIdx(0)
448 {
449 // ba::io_service::work is a kind of keep_alive for the loop.
450 // It prevents the io_service to go to stopped state, which
451 // would prevent any consecutive calls to run()
452 // or poll() to do nothing. reset() could also revoke to the
453 // previous state but this might introduce some overhead of
454 // deletion and creation of threads and more.
455
456 // State names
457 AddStateName(kStateDimNetworkNA, "DimNetworkNotAvailable",
458 "The Dim DNS is not reachable.");
459
460 AddStateName(kStateDisconnected, "Disconnected",
461 "The Dim DNS is reachable, but the required subsystems are not available.");
462
463 AddStateName(kStateConnected, "Connected",
464 "All needed subsystems are connected to their hardware, no action is performed.");
465
466 AddStateName(kStateInProgress, "InProgress",
467 "Rate scan in progress.");
468
469 AddEvent("START_THRESHOLD_SCAN", "I:3", kStateConnected)
470 (bind(&StateMachineRateScan::StartRateScan, this, placeholders::_1, "SET_THRESHOLD"))
471 ("Start rate scan for the threshold in the defined range"
472 "|min[int]:Start value in DAC counts"
473 "|max[int]:Limiting value in DAC counts"
474 "|step[int]:Single step in DAC counts");
475
476 AddEvent("START_N_OUT_OF_4_SCAN", "I:3", kStateConnected)
477 (bind(&StateMachineRateScan::StartRateScan, this, placeholders::_1, "SET_N_OUT_OF_4"))
478 ("Start rate scan for N-out-of-4 in the defined range"
479 "|min[int]:Start value in DAC counts"
480 "|max[int]:Limiting value in DAC counts"
481 "|step[int]:Single step in DAC counts");
482
483 AddEvent("CHANGE_STEP_SIZE", "I:1", kStateInProgress)
484 (bind(&StateMachineRateScan::ChangeStepSize, this, placeholders::_1))
485 ("Change the step size during a ratescan in progress"
486 "|step[int]:Single step in DAC counts");
487
488 AddEvent("CHANGE_MAXIMUM", "I:1", kStateInProgress)
489 (bind(&StateMachineRateScan::ChangeMaximum, this, placeholders::_1))
490 ("Change the maximum limit during a ratescan in progress"
491 "|max[int]:Limiting value in DAC counts");
492
493 AddEvent("STOP", kStateInProgress)
494 (bind(&StateMachineRateScan::StopRateScan, this))
495 ("Stop a ratescan in progress");
496
497 AddEvent("SET_REFERENCE_CAMERA", kStateDimNetworkNA, kStateDisconnected, kStateConnected)
498 (bind(&StateMachineRateScan::SetReferenceCamera, this))
499 ("Use the camera trigger rate as reference for the reolution");
500 AddEvent("SET_REFERENCE_BOARD", "I:1", kStateDimNetworkNA, kStateDisconnected, kStateConnected)
501 (bind(&StateMachineRateScan::SetReferenceBoard, this, placeholders::_1))
502 ("Use the given board trigger-rate as reference for the reolution"
503 "|board[idx]:Index of the board (4*crate+board)");
504 AddEvent("SET_REFERENCE_PATCH", "I:1", kStateDimNetworkNA, kStateDisconnected, kStateConnected)
505 (bind(&StateMachineRateScan::SetReferenceBoard, this, placeholders::_1))
506 ("Use the given patch trigger-rate as reference for the reolution"
507 "|patch[idx]:Index of the patch (360*crate+36*board+patch)" );
508
509 AddEvent("PRINT")
510 (bind(&StateMachineRateScan::Print, this))
511 ("");
512 }
513
514 int EvalOptions(Configuration &conf)
515 {
516 fSecondsMax = conf.Get<uint16_t>("max-wait");
517 fResolution = conf.Get<double>("resolution");
518
519 return -1;
520 }
521};
522
523// ------------------------------------------------------------------------
524
525#include "Main.h"
526
527template<class T>
528int RunShell(Configuration &conf)
529{
530 return Main::execute<T, StateMachineRateScan>(conf);
531}
532
533void SetupConfiguration(Configuration &conf)
534{
535 po::options_description control("Rate scan options");
536 control.add_options()
537 ("max-wait", var<uint16_t>(150), "The maximum number of seconds to wait to get the anticipated resolution for a point.")
538 ("resolution", var<double>(0.05) , "The minimum resolution required for a single data point.")
539 ;
540
541 conf.AddOptions(control);
542}
543
544/*
545 Extract usage clause(s) [if any] for SYNOPSIS.
546 Translators: "Usage" and "or" here are patterns (regular expressions) which
547 are used to match the usage synopsis in program output. An example from cp
548 (GNU coreutils) which contains both strings:
549 Usage: cp [OPTION]... [-T] SOURCE DEST
550 or: cp [OPTION]... SOURCE... DIRECTORY
551 or: cp [OPTION]... -t DIRECTORY SOURCE...
552 */
553void PrintUsage()
554{
555 cout <<
556 "The ratescan program is a tool for automation of rate scans.\n"
557 "\n"
558 "Usage: ratescan [-c type] [OPTIONS]\n"
559 " or: ratescan [OPTIONS]\n";
560 cout << endl;
561}
562
563void PrintHelp()
564{
565 Main::PrintHelp<StateMachineRateScan>();
566
567 /* Additional help text which is printed after the configuration
568 options goes here */
569
570 /*
571 cout << "bla bla bla" << endl << endl;
572 cout << endl;
573 cout << "Environment:" << endl;
574 cout << "environment" << endl;
575 cout << endl;
576 cout << "Examples:" << endl;
577 cout << "test exam" << endl;
578 cout << endl;
579 cout << "Files:" << endl;
580 cout << "files" << endl;
581 cout << endl;
582 */
583}
584
585int main(int argc, const char* argv[])
586{
587 Configuration conf(argv[0]);
588 conf.SetPrintUsage(PrintUsage);
589 Main::SetupConfiguration(conf);
590 SetupConfiguration(conf);
591
592 if (!conf.DoParse(argc, argv, PrintHelp))
593 return -1;
594
595 //try
596 {
597 // No console access at all
598 if (!conf.Has("console"))
599 {
600// if (conf.Get<bool>("no-dim"))
601// return RunShell<LocalStream, StateMachine, ConnectionFSC>(conf);
602// else
603 return RunShell<LocalStream>(conf);
604 }
605 // Cosole access w/ and w/o Dim
606/* if (conf.Get<bool>("no-dim"))
607 {
608 if (conf.Get<int>("console")==0)
609 return RunShell<LocalShell, StateMachine, ConnectionFSC>(conf);
610 else
611 return RunShell<LocalConsole, StateMachine, ConnectionFSC>(conf);
612 }
613 else
614*/ {
615 if (conf.Get<int>("console")==0)
616 return RunShell<LocalShell>(conf);
617 else
618 return RunShell<LocalConsole>(conf);
619 }
620 }
621 /*catch (std::exception& e)
622 {
623 cerr << "Exception: " << e.what() << endl;
624 return -1;
625 }*/
626
627 return 0;
628}
Note: See TracBrowser for help on using the repository browser.