1 | #include <boost/bind.hpp> |
---|
2 | #include <boost/array.hpp> |
---|
3 | #if BOOST_VERSION < 104400 |
---|
4 | #if (__GNUC__ > 4 || (__GNUC__ == 4 && __GNUC_MINOR__ > 4)) |
---|
5 | #undef BOOST_HAS_RVALUE_REFS |
---|
6 | #endif |
---|
7 | #endif |
---|
8 | #include <boost/thread.hpp> |
---|
9 | #include <boost/asio/error.hpp> |
---|
10 | #include <boost/asio/deadline_timer.hpp> |
---|
11 | |
---|
12 | #include "Dim.h" |
---|
13 | #include "Event.h" |
---|
14 | #include "Shell.h" |
---|
15 | #include "StateMachineDim.h" |
---|
16 | #include "Connection.h" |
---|
17 | #include "Configuration.h" |
---|
18 | #include "Console.h" |
---|
19 | #include "Converter.h" |
---|
20 | |
---|
21 | #include "tools.h" |
---|
22 | |
---|
23 | #include "LocalControl.h" |
---|
24 | #include "HeadersFTM.h" |
---|
25 | |
---|
26 | |
---|
27 | namespace ba = boost::asio; |
---|
28 | namespace bs = boost::system; |
---|
29 | |
---|
30 | using namespace std; |
---|
31 | |
---|
32 | // ------------------------------------------------------------------------ |
---|
33 | |
---|
34 | class ConnectionFTM : public Connection |
---|
35 | { |
---|
36 | vector<uint16_t> fBuffer; |
---|
37 | |
---|
38 | bool fHasHeader; |
---|
39 | int fState; |
---|
40 | |
---|
41 | bool fIsVerbose; |
---|
42 | bool fIsDynamicOut; |
---|
43 | bool fIsHexOutput; |
---|
44 | |
---|
45 | // string fDefaultSetup; |
---|
46 | |
---|
47 | // --verbose |
---|
48 | // --hex-out |
---|
49 | // --dynamic-out |
---|
50 | // --load-file |
---|
51 | // --leds |
---|
52 | // --trigger-interval |
---|
53 | // --physcis-coincidence |
---|
54 | // --calib-coincidence |
---|
55 | // --physcis-window |
---|
56 | // --physcis-window |
---|
57 | // --trigger-delay |
---|
58 | // --time-marker-delay |
---|
59 | // --dead-time |
---|
60 | // --clock-conditioner-r0 |
---|
61 | // --clock-conditioner-r1 |
---|
62 | // --clock-conditioner-r8 |
---|
63 | // --clock-conditioner-r9 |
---|
64 | // --clock-conditioner-r11 |
---|
65 | // --clock-conditioner-r13 |
---|
66 | // --clock-conditioner-r14 |
---|
67 | // --clock-conditioner-r15 |
---|
68 | // ... |
---|
69 | |
---|
70 | protected: |
---|
71 | map<uint16_t, int> fCounter; |
---|
72 | |
---|
73 | FTM::Header fHeader; |
---|
74 | FTM::FtuList fFtuList; |
---|
75 | FTM::StaticData fStaticData; |
---|
76 | FTM::DynamicData fDynamicData; |
---|
77 | FTM::Error fError; |
---|
78 | |
---|
79 | virtual void UpdateFirstHeader() |
---|
80 | { |
---|
81 | // FIXME: Message() ? |
---|
82 | Out() << endl << kBold << "First header received:" << endl; |
---|
83 | Out() << fHeader; |
---|
84 | if (fIsHexOutput) |
---|
85 | Out() << Converter::GetHex<uint16_t>(fHeader, 16) << endl; |
---|
86 | } |
---|
87 | |
---|
88 | virtual void UpdateHeader() |
---|
89 | { |
---|
90 | // emit service with trigger counter from header |
---|
91 | if (!fIsVerbose) |
---|
92 | return; |
---|
93 | |
---|
94 | if (fHeader.fType==FTM::kDynamicData && !fIsDynamicOut) |
---|
95 | return; |
---|
96 | |
---|
97 | Out() << endl << kBold << "Header received:" << endl; |
---|
98 | Out() << fHeader; |
---|
99 | if (fIsHexOutput) |
---|
100 | Out() << Converter::GetHex<uint16_t>(fHeader, 16) << endl; |
---|
101 | } |
---|
102 | |
---|
103 | virtual void UpdateFtuList() |
---|
104 | { |
---|
105 | if (!fIsVerbose) |
---|
106 | return; |
---|
107 | |
---|
108 | Out() << endl << kBold << "FtuList received:" << endl; |
---|
109 | Out() << fFtuList; |
---|
110 | if (fIsHexOutput) |
---|
111 | Out() << Converter::GetHex<uint16_t>(fFtuList, 16) << endl; |
---|
112 | } |
---|
113 | |
---|
114 | virtual void UpdateStaticData() |
---|
115 | { |
---|
116 | if (!fIsVerbose) |
---|
117 | return; |
---|
118 | |
---|
119 | Out() << endl << kBold << "Static data received:" << endl; |
---|
120 | Out() << fStaticData; |
---|
121 | if (fIsHexOutput) |
---|
122 | Out() << Converter::GetHex<uint16_t>(fStaticData, 16) << endl; |
---|
123 | } |
---|
124 | |
---|
125 | virtual void UpdateDynamicData() |
---|
126 | { |
---|
127 | if (!fIsDynamicOut) |
---|
128 | return; |
---|
129 | |
---|
130 | Out() << endl << kBold << "Dynamic data received:" << endl; |
---|
131 | Out() << fDynamicData; |
---|
132 | if (fIsHexOutput) |
---|
133 | Out() << Converter::GetHex<uint16_t>(fDynamicData, 16) << endl; |
---|
134 | } |
---|
135 | |
---|
136 | virtual void UpdateError() |
---|
137 | { |
---|
138 | if (!fIsVerbose) |
---|
139 | return; |
---|
140 | |
---|
141 | Out() << endl << kRed << "Error received:" << endl; |
---|
142 | Out() << fError; |
---|
143 | if (fIsHexOutput) |
---|
144 | Out() << Converter::GetHex<uint16_t>(fError, 16) << endl; |
---|
145 | } |
---|
146 | |
---|
147 | virtual void UpdateCounter() |
---|
148 | { |
---|
149 | if (!fIsVerbose) |
---|
150 | return; |
---|
151 | |
---|
152 | if (!fIsDynamicOut) |
---|
153 | return; |
---|
154 | |
---|
155 | Out() << "Received: "; |
---|
156 | Out() << "H=" << fCounter[FTM::kHeader] << " "; |
---|
157 | Out() << "S=" << fCounter[FTM::kStaticData] << " "; |
---|
158 | Out() << "D=" << fCounter[FTM::kDynamicData] << " "; |
---|
159 | Out() << "F=" << fCounter[FTM::kFtuList] << " "; |
---|
160 | Out() << "E=" << fCounter[FTM::kErrorList] << " "; |
---|
161 | Out() << "R=" << fCounter[FTM::kRegister] << endl; |
---|
162 | } |
---|
163 | |
---|
164 | bool CheckConsistency() |
---|
165 | { |
---|
166 | bool warn1 = false; |
---|
167 | if (fStaticData.IsEnabled(FTM::StaticData::kPedestal) != (fStaticData.GetSequencePed() >0) || |
---|
168 | fStaticData.IsEnabled(FTM::StaticData::kLPint) != (fStaticData.GetSequenceLPint()>0) || |
---|
169 | fStaticData.IsEnabled(FTM::StaticData::kLPext) != (fStaticData.GetSequenceLPext()>0)) |
---|
170 | { |
---|
171 | warn1 = true; |
---|
172 | fStaticData.Enable(FTM::StaticData::kPedestal, fStaticData.GetSequencePed()>0); |
---|
173 | fStaticData.Enable(FTM::StaticData::kLPint, fStaticData.GetSequenceLPint()>0); |
---|
174 | fStaticData.Enable(FTM::StaticData::kLPext, fStaticData.GetSequenceLPext()>0); |
---|
175 | } |
---|
176 | |
---|
177 | bool warn2 = false; |
---|
178 | const uint16_t ref = fStaticData[0].fPrescaling; |
---|
179 | for (int i=1; i<40; i++) |
---|
180 | { |
---|
181 | if (fStaticData[i].fPrescaling != ref) |
---|
182 | { |
---|
183 | warn2 = true; |
---|
184 | fStaticData[i].fPrescaling = ref; |
---|
185 | } |
---|
186 | } |
---|
187 | |
---|
188 | if (warn1) |
---|
189 | Warn("GeneralSettings not consistent with trigger sequence."); |
---|
190 | if (warn2) |
---|
191 | Warn("Prescaling not consistent for all boards."); |
---|
192 | |
---|
193 | return !warn1 && !warn2; |
---|
194 | } |
---|
195 | |
---|
196 | private: |
---|
197 | void HandleReceivedData(const bs::error_code& err, size_t bytes_received, int /*type*/) |
---|
198 | { |
---|
199 | // Do not schedule a new read if the connection failed. |
---|
200 | if (bytes_received==0 || err) |
---|
201 | { |
---|
202 | if (err==ba::error::eof) |
---|
203 | Warn("Connection closed by remote host (FTM)."); |
---|
204 | |
---|
205 | // 107: Transport endpoint is not connected (bs::error_code(107, bs::system_category)) |
---|
206 | // 125: Operation canceled |
---|
207 | if (err && err!=ba::error::eof && // Connection closed by remote host |
---|
208 | err!=ba::error::basic_errors::not_connected && // Connection closed by remote host |
---|
209 | err!=ba::error::basic_errors::operation_aborted) // Connection closed by us |
---|
210 | { |
---|
211 | ostringstream str; |
---|
212 | str << "Reading from " << URL() << ": " << err.message() << " (" << err << ")";// << endl; |
---|
213 | Error(str); |
---|
214 | } |
---|
215 | PostClose(err!=ba::error::basic_errors::operation_aborted); |
---|
216 | return; |
---|
217 | } |
---|
218 | |
---|
219 | // If we have not yet received a header we expect one now |
---|
220 | // This could be moved to a HandleReceivedHeader function |
---|
221 | if (!fHasHeader) |
---|
222 | { |
---|
223 | if (bytes_received!=sizeof(FTM::Header)) |
---|
224 | { |
---|
225 | ostringstream str; |
---|
226 | str << "Excepted " << sizeof(FTM::Header) << " bytes (FTM::Header) but received " << bytes_received << "."; |
---|
227 | Error(str); |
---|
228 | PostClose(false); |
---|
229 | return; |
---|
230 | } |
---|
231 | |
---|
232 | fHeader = fBuffer; |
---|
233 | |
---|
234 | // Check the data integrity |
---|
235 | if (fHeader.fDelimiter!=FTM::kDelimiterStart) |
---|
236 | { |
---|
237 | ostringstream str; |
---|
238 | str << "Invalid header received: start delimiter wrong, received "; |
---|
239 | str << hex << fHeader.fDelimiter << ", expected " << FTM::kDelimiterStart << "."; |
---|
240 | Error(str); |
---|
241 | PostClose(false); |
---|
242 | return; |
---|
243 | } |
---|
244 | |
---|
245 | fHasHeader = true; |
---|
246 | |
---|
247 | // Convert FTM state into FtmCtrl state |
---|
248 | switch (fHeader.fState) |
---|
249 | { |
---|
250 | case FTM::kFtmIdle: |
---|
251 | case FTM::kFtmConfig: |
---|
252 | fState = FTM::kIdle; |
---|
253 | break; |
---|
254 | |
---|
255 | case FTM::kFtmCalib: |
---|
256 | case FTM::kFtmRunning: |
---|
257 | fState = FTM::kTakingData; |
---|
258 | break; |
---|
259 | } |
---|
260 | |
---|
261 | if (++fCounter[FTM::kHeader]==1) |
---|
262 | UpdateFirstHeader(); |
---|
263 | |
---|
264 | UpdateCounter(); |
---|
265 | UpdateHeader(); |
---|
266 | |
---|
267 | // Start reading of data |
---|
268 | switch (fHeader.fType) |
---|
269 | { |
---|
270 | case FTM::kStaticData: |
---|
271 | case FTM::kDynamicData: |
---|
272 | case FTM::kFtuList: |
---|
273 | case FTM::kRegister: |
---|
274 | case FTM::kErrorList: |
---|
275 | // This is not very efficient because the space is reallocated |
---|
276 | // maybe we can check if the capacity of the std::vector |
---|
277 | // is ever decreased. If not, everythign is fine. |
---|
278 | fBuffer.resize(fHeader.fDataSize); |
---|
279 | AsyncRead(ba::buffer(fBuffer)); |
---|
280 | AsyncWait(fInTimeout, 50, &Connection::HandleReadTimeout); |
---|
281 | return; |
---|
282 | |
---|
283 | default: |
---|
284 | ostringstream str; |
---|
285 | str << "Unknonw type " << fHeader.fType << " in received header." << endl; |
---|
286 | Error(str); |
---|
287 | PostClose(false); |
---|
288 | return; |
---|
289 | } |
---|
290 | |
---|
291 | return; |
---|
292 | } |
---|
293 | |
---|
294 | // Check the data integrity (check end delimiter) |
---|
295 | if (ntohs(fBuffer.back())!=FTM::kDelimiterEnd) |
---|
296 | { |
---|
297 | ostringstream str; |
---|
298 | str << "Invalid data received: end delimiter wrong, received "; |
---|
299 | str << hex << ntohs(fBuffer.back()) << ", expected " << FTM::kDelimiterEnd << "."; |
---|
300 | Error(str); |
---|
301 | PostClose(false); |
---|
302 | return; |
---|
303 | } |
---|
304 | |
---|
305 | // Remove end delimiter |
---|
306 | fBuffer.pop_back(); |
---|
307 | |
---|
308 | try |
---|
309 | { |
---|
310 | // If we have already received a header this is the data now |
---|
311 | // This could be moved to a HandleReceivedData function |
---|
312 | |
---|
313 | fCounter[fHeader.fType]++; |
---|
314 | UpdateCounter(); |
---|
315 | |
---|
316 | switch (fHeader.fType) |
---|
317 | { |
---|
318 | case FTM::kFtuList: |
---|
319 | fFtuList = fBuffer; |
---|
320 | UpdateFtuList(); |
---|
321 | break; |
---|
322 | |
---|
323 | case FTM::kStaticData: |
---|
324 | fStaticData = fBuffer; |
---|
325 | |
---|
326 | if (fCounter[FTM::kStaticData]==1) |
---|
327 | if (!CheckConsistency()) |
---|
328 | { |
---|
329 | CmdSendStatDat(); |
---|
330 | break; |
---|
331 | } |
---|
332 | |
---|
333 | UpdateStaticData(); |
---|
334 | break; |
---|
335 | |
---|
336 | case FTM::kDynamicData: |
---|
337 | fDynamicData = fBuffer; |
---|
338 | UpdateDynamicData(); |
---|
339 | break; |
---|
340 | |
---|
341 | case FTM::kRegister: |
---|
342 | if (fIsVerbose) |
---|
343 | { |
---|
344 | Out() << endl << kBold << "Register received: " << endl; |
---|
345 | Out() << "Addr: " << ntohs(fBuffer[0]) << endl; |
---|
346 | Out() << "Value: " << ntohs(fBuffer[1]) << endl; |
---|
347 | } |
---|
348 | break; |
---|
349 | |
---|
350 | case FTM::kErrorList: |
---|
351 | fError = fBuffer; |
---|
352 | UpdateError(); |
---|
353 | break; |
---|
354 | |
---|
355 | default: |
---|
356 | ostringstream str; |
---|
357 | str << "Unknonw type " << fHeader.fType << " in header." << endl; |
---|
358 | Error(str); |
---|
359 | PostClose(false); |
---|
360 | return; |
---|
361 | } |
---|
362 | } |
---|
363 | catch (const logic_error &e) |
---|
364 | { |
---|
365 | ostringstream str; |
---|
366 | str << "Exception converting buffer into data structure: " << e.what(); |
---|
367 | Error(str); |
---|
368 | PostClose(false); |
---|
369 | return; |
---|
370 | } |
---|
371 | |
---|
372 | fInTimeout.cancel(); |
---|
373 | |
---|
374 | fHeader.clear(); |
---|
375 | fHasHeader = false; |
---|
376 | fBuffer.resize(sizeof(FTM::Header)/2); |
---|
377 | AsyncRead(ba::buffer(fBuffer)); |
---|
378 | } |
---|
379 | |
---|
380 | // This is called when a connection was established |
---|
381 | void ConnectionEstablished() |
---|
382 | { |
---|
383 | fState = FTM::kConnected; |
---|
384 | fCounter.clear(); |
---|
385 | |
---|
386 | fHeader.clear(); |
---|
387 | fHasHeader = false; |
---|
388 | fBuffer.resize(sizeof(FTM::Header)/2); |
---|
389 | AsyncRead(ba::buffer(fBuffer)); |
---|
390 | |
---|
391 | // if (!fDefaultSetup.empty()) |
---|
392 | // LoadStaticData(fDefaultSetup); |
---|
393 | |
---|
394 | // Get a header and configdata! |
---|
395 | CmdReqStatDat(); |
---|
396 | |
---|
397 | // get the DNA of the FTUs |
---|
398 | CmdPing(); |
---|
399 | } |
---|
400 | |
---|
401 | void HandleReadTimeout(const bs::error_code &error) |
---|
402 | { |
---|
403 | if (error==ba::error::basic_errors::operation_aborted) |
---|
404 | return; |
---|
405 | |
---|
406 | if (error) |
---|
407 | { |
---|
408 | ostringstream str; |
---|
409 | str << "Read timeout of " << URL() << ": " << error.message() << " (" << error << ")";// << endl; |
---|
410 | Error(str); |
---|
411 | |
---|
412 | PostClose(); |
---|
413 | return; |
---|
414 | |
---|
415 | } |
---|
416 | |
---|
417 | if (!is_open()) |
---|
418 | { |
---|
419 | // For example: Here we could schedule a new accept if we |
---|
420 | // would not want to allow two connections at the same time. |
---|
421 | return; |
---|
422 | } |
---|
423 | |
---|
424 | // Check whether the deadline has passed. We compare the deadline |
---|
425 | // against the current time since a new asynchronous operation |
---|
426 | // may have moved the deadline before this actor had a chance |
---|
427 | // to run. |
---|
428 | if (fInTimeout.expires_at() > ba::deadline_timer::traits_type::now()) |
---|
429 | return; |
---|
430 | |
---|
431 | Error("Timeout reading data from "+URL()); |
---|
432 | |
---|
433 | PostClose(); |
---|
434 | } |
---|
435 | |
---|
436 | |
---|
437 | template<size_t N> |
---|
438 | void PostCmd(boost::array<uint16_t, N> dat, uint16_t u1=0, uint16_t u2=0, uint16_t u3=0, uint16_t u4=0) |
---|
439 | { |
---|
440 | boost::array<uint16_t, 5> cmd = {{ '@', u1, u2, u3, u4 }}; |
---|
441 | |
---|
442 | ostringstream msg; |
---|
443 | msg << "Sending command:" << hex; |
---|
444 | msg << " 0x" << setw(4) << setfill('0') << cmd[0]; |
---|
445 | msg << " 0x" << setw(4) << setfill('0') << u1; |
---|
446 | msg << " 0x" << setw(4) << setfill('0') << u2; |
---|
447 | msg << " 0x" << setw(4) << setfill('0') << u3; |
---|
448 | msg << " 0x" << setw(4) << setfill('0') << u4; |
---|
449 | msg << " (+" << dec << dat.size() << " words)"; |
---|
450 | Message(msg); |
---|
451 | |
---|
452 | vector<uint16_t> out(cmd.size()+dat.size()); |
---|
453 | |
---|
454 | transform(cmd.begin(), cmd.end(), out.begin(), htons); |
---|
455 | transform(dat.begin(), dat.end(), out.begin()+cmd.size(), htons); |
---|
456 | |
---|
457 | PostMessage(out); |
---|
458 | } |
---|
459 | |
---|
460 | void PostCmd(vector<uint16_t> dat, uint16_t u1=0, uint16_t u2=0, uint16_t u3=0, uint16_t u4=0) |
---|
461 | { |
---|
462 | boost::array<uint16_t, 5> cmd = {{ '@', u1, u2, u3, u4 }}; |
---|
463 | |
---|
464 | ostringstream msg; |
---|
465 | msg << "Sending command:" << hex; |
---|
466 | msg << " 0x" << setw(4) << setfill('0') << cmd[0]; |
---|
467 | msg << " 0x" << setw(4) << setfill('0') << u1; |
---|
468 | msg << " 0x" << setw(4) << setfill('0') << u2; |
---|
469 | msg << " 0x" << setw(4) << setfill('0') << u3; |
---|
470 | msg << " 0x" << setw(4) << setfill('0') << u4; |
---|
471 | msg << " (+" << dec << dat.size() << " words)"; |
---|
472 | Message(msg); |
---|
473 | |
---|
474 | vector<uint16_t> out(cmd.size()+dat.size()); |
---|
475 | |
---|
476 | transform(cmd.begin(), cmd.end(), out.begin(), htons); |
---|
477 | copy(dat.begin(), dat.end(), out.begin()+cmd.size()); |
---|
478 | |
---|
479 | PostMessage(out); |
---|
480 | } |
---|
481 | |
---|
482 | void PostCmd(uint16_t u1=0, uint16_t u2=0, uint16_t u3=0, uint16_t u4=0) |
---|
483 | { |
---|
484 | PostCmd(boost::array<uint16_t, 0>(), u1, u2, u3, u4); |
---|
485 | } |
---|
486 | public: |
---|
487 | |
---|
488 | // static const uint16_t kMaxAddr; |
---|
489 | |
---|
490 | public: |
---|
491 | ConnectionFTM(ba::io_service& ioservice, MessageImp &imp) : Connection(ioservice, imp()), |
---|
492 | fState(0), fIsVerbose(true), fIsDynamicOut(true), fIsHexOutput(true) |
---|
493 | { |
---|
494 | SetLogStream(&imp); |
---|
495 | } |
---|
496 | |
---|
497 | void CmdToggleLed() |
---|
498 | { |
---|
499 | PostCmd(FTM::kCmdToggleLed); |
---|
500 | } |
---|
501 | |
---|
502 | void CmdPing() |
---|
503 | { |
---|
504 | PostCmd(FTM::kCmdPing); |
---|
505 | } |
---|
506 | |
---|
507 | void CmdReqDynDat() |
---|
508 | { |
---|
509 | PostCmd(FTM::kCmdRead, FTM::kCmdDynamicData); |
---|
510 | } |
---|
511 | |
---|
512 | void CmdReqStatDat() |
---|
513 | { |
---|
514 | PostCmd(FTM::kCmdRead, FTM::kCmdStaticData); |
---|
515 | } |
---|
516 | |
---|
517 | void CmdSendStatDat() |
---|
518 | { |
---|
519 | PostCmd(fStaticData.HtoN(), FTM::kCmdWrite, FTM::kCmdStaticData); |
---|
520 | |
---|
521 | // Request the changed configuration to ensure the |
---|
522 | // change is distributed in the network |
---|
523 | CmdReqStatDat(); |
---|
524 | } |
---|
525 | |
---|
526 | void CmdStartRun() |
---|
527 | { |
---|
528 | PostCmd(FTM::kCmdStartRun, FTM::kStartRun); |
---|
529 | |
---|
530 | // Update state information by requesting a new header |
---|
531 | CmdGetRegister(0); |
---|
532 | } |
---|
533 | |
---|
534 | void CmdStopRun() |
---|
535 | { |
---|
536 | PostCmd(FTM::kCmdStopRun); |
---|
537 | |
---|
538 | // Update state information by requesting a new header |
---|
539 | CmdGetRegister(0); |
---|
540 | } |
---|
541 | |
---|
542 | void CmdTakeNevents(uint32_t n) |
---|
543 | { |
---|
544 | const boost::array<uint16_t, 2> data = {{ uint16_t(n>>16), uint16_t(n&0xffff) }}; |
---|
545 | PostCmd(data, FTM::kCmdStartRun, FTM::kTakeNevents); |
---|
546 | |
---|
547 | // Update state information by requesting a new header |
---|
548 | CmdGetRegister(0); |
---|
549 | } |
---|
550 | |
---|
551 | bool CmdSetRegister(uint16_t addr, uint16_t val) |
---|
552 | { |
---|
553 | if (addr>FTM::StaticData::kMaxAddr) |
---|
554 | return false; |
---|
555 | |
---|
556 | const boost::array<uint16_t, 2> data = {{ addr, val }}; |
---|
557 | PostCmd(data, FTM::kCmdWrite, FTM::kCmdRegister); |
---|
558 | |
---|
559 | // Request the changed configuration to ensure the |
---|
560 | // change is distributed in the network |
---|
561 | CmdReqStatDat(); |
---|
562 | |
---|
563 | return true; |
---|
564 | } |
---|
565 | |
---|
566 | bool CmdGetRegister(uint16_t addr) |
---|
567 | { |
---|
568 | if (addr>FTM::StaticData::kMaxAddr) |
---|
569 | return false; |
---|
570 | |
---|
571 | const boost::array<uint16_t, 1> data = {{ addr }}; |
---|
572 | PostCmd(data, FTM::kCmdRead, FTM::kCmdRegister); |
---|
573 | |
---|
574 | return true; |
---|
575 | } |
---|
576 | |
---|
577 | bool CmdResetCrate(uint16_t addr) |
---|
578 | { |
---|
579 | if (addr>3) |
---|
580 | return false; |
---|
581 | |
---|
582 | PostCmd(FTM::kCmdCrateReset, 1<<addr); |
---|
583 | |
---|
584 | return true; |
---|
585 | } |
---|
586 | |
---|
587 | bool CmdResetCamera() |
---|
588 | { |
---|
589 | PostCmd(FTM::kCmdCrateReset, FTM::kResetCrate0); |
---|
590 | PostCmd(FTM::kCmdCrateReset, FTM::kResetCrate1); |
---|
591 | PostCmd(FTM::kCmdCrateReset, FTM::kResetCrate2); |
---|
592 | PostCmd(FTM::kCmdCrateReset, FTM::kResetCrate3); |
---|
593 | |
---|
594 | return true; |
---|
595 | } |
---|
596 | |
---|
597 | bool CmdDisableReports(bool b) |
---|
598 | { |
---|
599 | PostCmd(FTM::kCmdDisableReports, b ? uint16_t(0) : uint16_t(1)); |
---|
600 | return true; |
---|
601 | } |
---|
602 | |
---|
603 | void SetVerbose(bool b) |
---|
604 | { |
---|
605 | fIsVerbose = b; |
---|
606 | } |
---|
607 | |
---|
608 | void SetHexOutput(bool b) |
---|
609 | { |
---|
610 | fIsHexOutput = b; |
---|
611 | } |
---|
612 | |
---|
613 | void SetDynamicOut(bool b) |
---|
614 | { |
---|
615 | fIsDynamicOut = b; |
---|
616 | } |
---|
617 | /* |
---|
618 | void SetDefaultSetup(const string &file) |
---|
619 | { |
---|
620 | fDefaultSetup = file; |
---|
621 | } |
---|
622 | */ |
---|
623 | bool LoadStaticData(string name) |
---|
624 | { |
---|
625 | if (name.rfind(".bin")!=name.length()-5) |
---|
626 | name += ".bin"; |
---|
627 | |
---|
628 | ifstream fin(name); |
---|
629 | if (!fin) |
---|
630 | return false; |
---|
631 | |
---|
632 | FTM::StaticData data; |
---|
633 | |
---|
634 | fin.read(reinterpret_cast<char*>(&data), sizeof(FTM::StaticData)); |
---|
635 | |
---|
636 | if (fin.gcount()<streamsize(sizeof(FTM::StaticData))) |
---|
637 | return false; |
---|
638 | |
---|
639 | if (fin.fail() || fin.eof()) |
---|
640 | return false; |
---|
641 | |
---|
642 | if (fin.peek()!=-1) |
---|
643 | return false; |
---|
644 | |
---|
645 | fStaticData = data; |
---|
646 | |
---|
647 | CmdSendStatDat(); |
---|
648 | |
---|
649 | return true; |
---|
650 | } |
---|
651 | |
---|
652 | bool SaveStaticData(string name) const |
---|
653 | { |
---|
654 | if (name.rfind(".bin")!=name.length()-5) |
---|
655 | name += ".bin"; |
---|
656 | |
---|
657 | ofstream fout(name); |
---|
658 | if (!fout) |
---|
659 | return false; |
---|
660 | |
---|
661 | fout.write(reinterpret_cast<const char*>(&fStaticData), sizeof(FTM::StaticData)); |
---|
662 | |
---|
663 | return !fout.bad(); |
---|
664 | } |
---|
665 | |
---|
666 | bool SetThreshold(int32_t patch, int32_t value) |
---|
667 | { |
---|
668 | if (patch>159) |
---|
669 | return false; |
---|
670 | |
---|
671 | if (value<0 || value>0xffff) |
---|
672 | return false; |
---|
673 | |
---|
674 | if (patch<0) |
---|
675 | { |
---|
676 | bool ident = true; |
---|
677 | for (int i=0; i<160; i++) |
---|
678 | if (fStaticData[i/4].fDAC[patch%4] != value) |
---|
679 | { |
---|
680 | ident = false; |
---|
681 | break; |
---|
682 | } |
---|
683 | |
---|
684 | if (ident) |
---|
685 | return true; |
---|
686 | |
---|
687 | for (int i=0; i<160; i++) |
---|
688 | fStaticData[i/4].fDAC[i%4] = value; |
---|
689 | } |
---|
690 | else |
---|
691 | { |
---|
692 | if (fStaticData[patch/4].fDAC[patch%4] == value) |
---|
693 | return true; |
---|
694 | |
---|
695 | fStaticData[patch/4].fDAC[patch%4] = value; |
---|
696 | } |
---|
697 | |
---|
698 | // Maybe move to a "COMMIT" command? |
---|
699 | CmdSendStatDat(); |
---|
700 | |
---|
701 | return true; |
---|
702 | } |
---|
703 | |
---|
704 | bool SetPrescaling(uint32_t value) |
---|
705 | { |
---|
706 | if (value>0xffff) |
---|
707 | return false; |
---|
708 | |
---|
709 | bool ident = true; |
---|
710 | for (int i=0; i<40; i++) |
---|
711 | if (fStaticData[i].fPrescaling != value) |
---|
712 | { |
---|
713 | ident = false; |
---|
714 | break; |
---|
715 | } |
---|
716 | |
---|
717 | if (ident) |
---|
718 | return true; |
---|
719 | |
---|
720 | for (int i=0; i<40; i++) |
---|
721 | fStaticData[i].fPrescaling = value; |
---|
722 | |
---|
723 | // Maybe move to a "COMMIT" command? |
---|
724 | CmdSendStatDat(); |
---|
725 | |
---|
726 | return true; |
---|
727 | } |
---|
728 | |
---|
729 | bool EnableFTU(int32_t board, bool enable) |
---|
730 | { |
---|
731 | if (board>39) |
---|
732 | return false; |
---|
733 | |
---|
734 | if (board<0) |
---|
735 | { |
---|
736 | if (enable) |
---|
737 | fStaticData.EnableAllFTU(); |
---|
738 | else |
---|
739 | fStaticData.DisableAllFTU(); |
---|
740 | } |
---|
741 | else |
---|
742 | { |
---|
743 | if (enable) |
---|
744 | fStaticData.EnableFTU(board); |
---|
745 | else |
---|
746 | fStaticData.DisableFTU(board); |
---|
747 | |
---|
748 | } |
---|
749 | |
---|
750 | // Maybe move to a "COMMIT" command? |
---|
751 | CmdSendStatDat(); |
---|
752 | |
---|
753 | return true; |
---|
754 | } |
---|
755 | |
---|
756 | bool ToggleFTU(uint32_t board) |
---|
757 | { |
---|
758 | if (board>39) |
---|
759 | return false; |
---|
760 | |
---|
761 | fStaticData.ToggleFTU(board); |
---|
762 | |
---|
763 | // Maybe move to a "COMMIT" command? |
---|
764 | CmdSendStatDat(); |
---|
765 | |
---|
766 | return true; |
---|
767 | } |
---|
768 | |
---|
769 | bool SetVal(uint16_t *dest, uint32_t val, uint32_t max) |
---|
770 | { |
---|
771 | if (val>max) |
---|
772 | return false; |
---|
773 | |
---|
774 | if (*dest==val) |
---|
775 | return true; |
---|
776 | |
---|
777 | *dest = val; |
---|
778 | |
---|
779 | CmdSendStatDat(); |
---|
780 | |
---|
781 | return true; |
---|
782 | } |
---|
783 | |
---|
784 | bool SetTriggerInterval(uint32_t val) |
---|
785 | { |
---|
786 | return SetVal(&fStaticData.fTriggerInterval, val, |
---|
787 | FTM::StaticData::kMaxTriggerInterval); |
---|
788 | } |
---|
789 | |
---|
790 | bool SetTriggerDelay(uint32_t val) |
---|
791 | { |
---|
792 | return SetVal(&fStaticData.fDelayTrigger, val, |
---|
793 | FTM::StaticData::kMaxDelayTrigger); |
---|
794 | } |
---|
795 | |
---|
796 | bool SetTimeMarkerDelay(uint32_t val) |
---|
797 | { |
---|
798 | return SetVal(&fStaticData.fDelayTimeMarker, val, |
---|
799 | FTM::StaticData::kMaxDelayTimeMarker); |
---|
800 | } |
---|
801 | |
---|
802 | bool SetDeadTime(uint32_t val) |
---|
803 | { |
---|
804 | return SetVal(&fStaticData.fDeadTime, val, |
---|
805 | FTM::StaticData::kMaxDeadTime); |
---|
806 | } |
---|
807 | |
---|
808 | void Enable(FTM::StaticData::GeneralSettings type, bool enable) |
---|
809 | { |
---|
810 | if (fStaticData.IsEnabled(type)!=enable) |
---|
811 | { |
---|
812 | fStaticData.Enable(type, enable); |
---|
813 | CmdSendStatDat(); |
---|
814 | } |
---|
815 | } |
---|
816 | |
---|
817 | bool SetTriggerSeq(const uint16_t d[3]) |
---|
818 | { |
---|
819 | const uint16_t oldset = fStaticData.fGeneralSettings; |
---|
820 | const uint16_t oldseq = fStaticData.fTriggerSequence; |
---|
821 | |
---|
822 | if (d[0]>FTM::StaticData::kMaxSequence || |
---|
823 | d[1]>FTM::StaticData::kMaxSequence || |
---|
824 | d[2]>FTM::StaticData::kMaxSequence) |
---|
825 | return false; |
---|
826 | |
---|
827 | fStaticData.Enable(FTM::StaticData::kPedestal, d[0]>0); |
---|
828 | fStaticData.Enable(FTM::StaticData::kLPext, d[1]>0); |
---|
829 | fStaticData.Enable(FTM::StaticData::kLPint, d[2]>0); |
---|
830 | |
---|
831 | fStaticData.fTriggerSequence = |
---|
832 | (uint16_t(d[0])<<10) | (uint16_t(d[2])<<5) | uint16_t(d[1]); |
---|
833 | |
---|
834 | if (oldseq!=fStaticData.fTriggerSequence || oldset!=fStaticData.fGeneralSettings) |
---|
835 | CmdSendStatDat(); |
---|
836 | |
---|
837 | return true; |
---|
838 | } |
---|
839 | |
---|
840 | bool SetTriggerMultiplicity(uint16_t n) |
---|
841 | { |
---|
842 | if (n==0 || n>FTM::StaticData::kMaxMultiplicity) |
---|
843 | return false; |
---|
844 | |
---|
845 | if (n==fStaticData.fMultiplicityPhysics) |
---|
846 | return true; |
---|
847 | |
---|
848 | fStaticData.fMultiplicityPhysics = n; |
---|
849 | |
---|
850 | CmdSendStatDat(); |
---|
851 | |
---|
852 | return true; |
---|
853 | } |
---|
854 | |
---|
855 | bool SetTriggerWindow(uint16_t win) |
---|
856 | { |
---|
857 | if (win>FTM::StaticData::kMaxWindow) |
---|
858 | return false; |
---|
859 | |
---|
860 | if (win==fStaticData.fWindowPhysics) |
---|
861 | return true; |
---|
862 | |
---|
863 | fStaticData.fWindowPhysics = win; |
---|
864 | |
---|
865 | CmdSendStatDat(); |
---|
866 | |
---|
867 | return true; |
---|
868 | } |
---|
869 | |
---|
870 | bool SetCalibMultiplicity(uint16_t n) |
---|
871 | { |
---|
872 | if (n==0 || n>FTM::StaticData::kMaxMultiplicity) |
---|
873 | return false; |
---|
874 | |
---|
875 | if (n==fStaticData.fMultiplicityCalib) |
---|
876 | return true; |
---|
877 | |
---|
878 | fStaticData.fMultiplicityCalib = n; |
---|
879 | |
---|
880 | CmdSendStatDat(); |
---|
881 | |
---|
882 | return true; |
---|
883 | } |
---|
884 | |
---|
885 | bool SetCalibWindow(uint16_t win) |
---|
886 | { |
---|
887 | if (win>FTM::StaticData::kMaxWindow) |
---|
888 | return false; |
---|
889 | |
---|
890 | if (win==fStaticData.fWindowCalib) |
---|
891 | return true; |
---|
892 | |
---|
893 | fStaticData.fWindowCalib = win; |
---|
894 | |
---|
895 | CmdSendStatDat(); |
---|
896 | |
---|
897 | return true; |
---|
898 | } |
---|
899 | |
---|
900 | bool EnablePixel(uint16_t idx, bool enable) |
---|
901 | { |
---|
902 | if (idx>FTM::StaticData::kMaxPixelIdx) |
---|
903 | return false; |
---|
904 | |
---|
905 | cout << "ENABLE " << idx << " " << enable << endl; |
---|
906 | fStaticData.EnablePixel(idx, enable); |
---|
907 | |
---|
908 | CmdSendStatDat(); |
---|
909 | |
---|
910 | return true; |
---|
911 | } |
---|
912 | |
---|
913 | bool TogglePixel(uint16_t idx) |
---|
914 | { |
---|
915 | if (idx>FTM::StaticData::kMaxPixelIdx) |
---|
916 | return false; |
---|
917 | |
---|
918 | cout << "TOGGLE " << idx << endl; |
---|
919 | |
---|
920 | fStaticData.EnablePixel(idx, !fStaticData.Enabled(idx)); |
---|
921 | |
---|
922 | CmdSendStatDat(); |
---|
923 | |
---|
924 | return true; |
---|
925 | } |
---|
926 | |
---|
927 | int GetState() const { return IsConnected() ? fState : (int)FTM::kDisconnected; } |
---|
928 | }; |
---|
929 | |
---|
930 | //const uint16_t ConnectionFTM::kMaxAddr = 0xfff; |
---|
931 | |
---|
932 | // ------------------------------------------------------------------------ |
---|
933 | |
---|
934 | #include "DimDescriptionService.h" |
---|
935 | |
---|
936 | class ConnectionDimFTM : public ConnectionFTM |
---|
937 | { |
---|
938 | private: |
---|
939 | |
---|
940 | DimDescribedService fDimPassport; |
---|
941 | DimDescribedService fDimTriggerCounter; |
---|
942 | DimDescribedService fDimError; |
---|
943 | DimDescribedService fDimFtuList; |
---|
944 | DimDescribedService fDimStaticData; |
---|
945 | DimDescribedService fDimDynamicData; |
---|
946 | DimDescribedService fDimCounter; |
---|
947 | |
---|
948 | template<class T> |
---|
949 | void Update(DimDescribedService &svc, const T &data) const |
---|
950 | { |
---|
951 | //cout << "Update: " << svc.getName() << " (" << sizeof(T) << ")" << endl; |
---|
952 | svc.setData(const_cast<T*>(&data), sizeof(T)); |
---|
953 | svc.updateService(); |
---|
954 | } |
---|
955 | |
---|
956 | void UpdateFirstHeader() |
---|
957 | { |
---|
958 | ConnectionFTM::UpdateFirstHeader(); |
---|
959 | |
---|
960 | const FTM::DimPassport data(fHeader); |
---|
961 | Update(fDimPassport, data); |
---|
962 | } |
---|
963 | |
---|
964 | void UpdateHeader() |
---|
965 | { |
---|
966 | ConnectionFTM::UpdateHeader(); |
---|
967 | |
---|
968 | if (fHeader.fType!=FTM::kDynamicData) |
---|
969 | return; |
---|
970 | |
---|
971 | const FTM::DimTriggerCounter data(fHeader); |
---|
972 | Update(fDimTriggerCounter, data); |
---|
973 | } |
---|
974 | |
---|
975 | void UpdateFtuList() |
---|
976 | { |
---|
977 | ConnectionFTM::UpdateFtuList(); |
---|
978 | |
---|
979 | const FTM::DimFtuList data(fHeader, fFtuList); |
---|
980 | Update(fDimFtuList, data); |
---|
981 | } |
---|
982 | |
---|
983 | void UpdateStaticData() |
---|
984 | { |
---|
985 | ConnectionFTM::UpdateStaticData(); |
---|
986 | |
---|
987 | const FTM::DimStaticData data(fHeader, fStaticData); |
---|
988 | Update(fDimStaticData, data); |
---|
989 | } |
---|
990 | |
---|
991 | void UpdateDynamicData() |
---|
992 | { |
---|
993 | ConnectionFTM::UpdateDynamicData(); |
---|
994 | |
---|
995 | const FTM::DimDynamicData data(fHeader, fDynamicData); |
---|
996 | Update(fDimDynamicData, data); |
---|
997 | } |
---|
998 | |
---|
999 | void UpdateError() |
---|
1000 | { |
---|
1001 | ConnectionFTM::UpdateError(); |
---|
1002 | |
---|
1003 | const FTM::DimError data(fHeader, fError); |
---|
1004 | Update(fDimError, data); |
---|
1005 | } |
---|
1006 | |
---|
1007 | void UpdateCounter() |
---|
1008 | { |
---|
1009 | ConnectionFTM::UpdateCounter(); |
---|
1010 | |
---|
1011 | const uint32_t counter[6] = |
---|
1012 | { |
---|
1013 | fCounter[FTM::kHeader], |
---|
1014 | fCounter[FTM::kStaticData], |
---|
1015 | fCounter[FTM::kDynamicData], |
---|
1016 | fCounter[FTM::kFtuList], |
---|
1017 | fCounter[FTM::kErrorList], |
---|
1018 | fCounter[FTM::kRegister], |
---|
1019 | }; |
---|
1020 | |
---|
1021 | Update(fDimCounter, counter); |
---|
1022 | } |
---|
1023 | |
---|
1024 | public: |
---|
1025 | ConnectionDimFTM(ba::io_service& ioservice, MessageImp &imp) : |
---|
1026 | ConnectionFTM(ioservice, imp), |
---|
1027 | fDimPassport ("FTM_CONTROL/PASSPORT", "X:1;S:1", ""), |
---|
1028 | fDimTriggerCounter("FTM_CONTROL/TRIGGER_COUNTER", "X:1;I:1", ""), |
---|
1029 | fDimError ("FTM_CONTROL/ERROR", "X:1;S:1;S:28", ""), |
---|
1030 | fDimFtuList ("FTM_CONTROL/FTU_LIST", "X:1;X:1;S:1;C:4;X:40;C:40;C:40", ""), |
---|
1031 | fDimStaticData ("FTM_CONTROL/STATIC_DATA", "X:1;S:1;S:1;X:1;S:1;S:3;S:1;S:1;S:1;S:1;S:1;S:1;I:1;S:8;S:90;S:160;S:40;S:40", ""), |
---|
1032 | fDimDynamicData ("FTM_CONTROL/DYNAMIC_DATA", "X:1;X:1;F:4;I:160;I:40;S:40;S:40", ""), |
---|
1033 | fDimCounter ("FTM_CONTROL/COUNTER", "I:6", "") |
---|
1034 | { |
---|
1035 | } |
---|
1036 | |
---|
1037 | // A B [C] [D] E [F] G H [I] J K [L] M N O P Q R [S] T U V W [X] Y Z |
---|
1038 | }; |
---|
1039 | |
---|
1040 | // ------------------------------------------------------------------------ |
---|
1041 | |
---|
1042 | template <class T, class S> |
---|
1043 | class StateMachineFTM : public T, public ba::io_service, public ba::io_service::work |
---|
1044 | { |
---|
1045 | int Wrap(boost::function<void()> f) |
---|
1046 | { |
---|
1047 | f(); |
---|
1048 | return T::GetCurrentState(); |
---|
1049 | } |
---|
1050 | |
---|
1051 | boost::function<int(const EventImp &)> Wrapper(boost::function<void()> func) |
---|
1052 | { |
---|
1053 | return boost::bind(&StateMachineFTM::Wrap, this, func); |
---|
1054 | } |
---|
1055 | |
---|
1056 | private: |
---|
1057 | S fFTM; |
---|
1058 | |
---|
1059 | enum states_t |
---|
1060 | { |
---|
1061 | kStateDisconnected = FTM::kDisconnected, |
---|
1062 | kStateConnected = FTM::kConnected, |
---|
1063 | kStateIdle = FTM::kIdle, |
---|
1064 | kStateTakingData = FTM::kTakingData, |
---|
1065 | |
---|
1066 | kCmdTest |
---|
1067 | }; |
---|
1068 | |
---|
1069 | bool CheckEventSize(size_t has, const char *name, size_t size) |
---|
1070 | { |
---|
1071 | if (has==size) |
---|
1072 | return true; |
---|
1073 | |
---|
1074 | ostringstream msg; |
---|
1075 | msg << name << " - Received event has " << has << " bytes, but expected " << size << "."; |
---|
1076 | T::Fatal(msg); |
---|
1077 | return false; |
---|
1078 | } |
---|
1079 | |
---|
1080 | int SetRegister(const EventImp &evt) |
---|
1081 | { |
---|
1082 | if (!CheckEventSize(evt.GetSize(), "SetRegister", 8)) |
---|
1083 | return T::kSM_FatalError; |
---|
1084 | |
---|
1085 | const uint32_t *dat = evt.Ptr<uint32_t>(); |
---|
1086 | |
---|
1087 | if (dat[1]>uint16_t(-1)) |
---|
1088 | { |
---|
1089 | ostringstream msg; |
---|
1090 | msg << hex << "Value " << dat[1] << " out of range."; |
---|
1091 | T::Error(msg); |
---|
1092 | return T::GetCurrentState(); |
---|
1093 | } |
---|
1094 | |
---|
1095 | |
---|
1096 | if (dat[0]>uint16_t(-1) || !fFTM.CmdSetRegister(dat[0], dat[1])) |
---|
1097 | { |
---|
1098 | ostringstream msg; |
---|
1099 | msg << hex << "Address " << dat[0] << " out of range."; |
---|
1100 | T::Error(msg); |
---|
1101 | } |
---|
1102 | |
---|
1103 | return T::GetCurrentState(); |
---|
1104 | } |
---|
1105 | |
---|
1106 | int GetRegister(const EventImp &evt) |
---|
1107 | { |
---|
1108 | if (!CheckEventSize(evt.GetSize(), "GetRegister", 4)) |
---|
1109 | return T::kSM_FatalError; |
---|
1110 | |
---|
1111 | const unsigned int addr = evt.GetInt(); |
---|
1112 | if (addr>uint16_t(-1) || !fFTM.CmdGetRegister(addr)) |
---|
1113 | { |
---|
1114 | ostringstream msg; |
---|
1115 | msg << hex << "Address " << addr << " out of range."; |
---|
1116 | T::Error(msg); |
---|
1117 | } |
---|
1118 | |
---|
1119 | return T::GetCurrentState(); |
---|
1120 | } |
---|
1121 | |
---|
1122 | int TakeNevents(const EventImp &evt) |
---|
1123 | { |
---|
1124 | if (!CheckEventSize(evt.GetSize(), "TakeNevents", 4)) |
---|
1125 | return T::kSM_FatalError; |
---|
1126 | |
---|
1127 | const unsigned int dat = evt.GetUInt(); |
---|
1128 | |
---|
1129 | /* |
---|
1130 | if (dat[1]>uint32_t(-1)) |
---|
1131 | { |
---|
1132 | ostringstream msg; |
---|
1133 | msg << hex << "Value " << dat[1] << " out of range."; |
---|
1134 | T::Error(msg); |
---|
1135 | return T::GetCurrentState(); |
---|
1136 | }*/ |
---|
1137 | |
---|
1138 | fFTM.CmdTakeNevents(dat); |
---|
1139 | |
---|
1140 | return T::GetCurrentState(); |
---|
1141 | } |
---|
1142 | |
---|
1143 | int DisableReports(const EventImp &evt) |
---|
1144 | { |
---|
1145 | if (!CheckEventSize(evt.GetSize(), "DisableReports", 1)) |
---|
1146 | return T::kSM_FatalError; |
---|
1147 | |
---|
1148 | fFTM.CmdDisableReports(evt.GetBool()); |
---|
1149 | |
---|
1150 | return T::GetCurrentState(); |
---|
1151 | } |
---|
1152 | |
---|
1153 | int SetVerbosity(const EventImp &evt) |
---|
1154 | { |
---|
1155 | if (!CheckEventSize(evt.GetSize(), "SetVerbosity", 1)) |
---|
1156 | return T::kSM_FatalError; |
---|
1157 | |
---|
1158 | fFTM.SetVerbose(evt.GetBool()); |
---|
1159 | |
---|
1160 | return T::GetCurrentState(); |
---|
1161 | } |
---|
1162 | |
---|
1163 | int SetHexOutput(const EventImp &evt) |
---|
1164 | { |
---|
1165 | if (!CheckEventSize(evt.GetSize(), "SetHexOutput", 1)) |
---|
1166 | return T::kSM_FatalError; |
---|
1167 | |
---|
1168 | fFTM.SetHexOutput(evt.GetBool()); |
---|
1169 | |
---|
1170 | return T::GetCurrentState(); |
---|
1171 | } |
---|
1172 | |
---|
1173 | int SetDynamicOut(const EventImp &evt) |
---|
1174 | { |
---|
1175 | if (!CheckEventSize(evt.GetSize(), "SetDynamicOut", 1)) |
---|
1176 | return T::kSM_FatalError; |
---|
1177 | |
---|
1178 | fFTM.SetDynamicOut(evt.GetBool()); |
---|
1179 | |
---|
1180 | return T::GetCurrentState(); |
---|
1181 | } |
---|
1182 | |
---|
1183 | int LoadStaticData(const EventImp &evt) |
---|
1184 | { |
---|
1185 | if (fFTM.LoadStaticData(evt.GetString())) |
---|
1186 | return T::GetCurrentState(); |
---|
1187 | |
---|
1188 | ostringstream msg; |
---|
1189 | msg << "Loading static data from file '" << evt.GetString() << "' failed "; |
---|
1190 | |
---|
1191 | if (errno) |
---|
1192 | msg << "(" << strerror(errno) << ")"; |
---|
1193 | else |
---|
1194 | msg << "(wrong size, expected " << sizeof(FTM::StaticData) << " bytes)"; |
---|
1195 | |
---|
1196 | T::Warn(msg); |
---|
1197 | |
---|
1198 | return T::GetCurrentState(); |
---|
1199 | } |
---|
1200 | |
---|
1201 | int SaveStaticData(const EventImp &evt) |
---|
1202 | { |
---|
1203 | if (fFTM.SaveStaticData(evt.GetString())) |
---|
1204 | return T::GetCurrentState(); |
---|
1205 | |
---|
1206 | ostringstream msg; |
---|
1207 | msg << "Writing static data to file '" << evt.GetString() << "' failed "; |
---|
1208 | msg << "(" << strerror(errno) << ")"; |
---|
1209 | |
---|
1210 | T::Warn(msg); |
---|
1211 | |
---|
1212 | return T::GetCurrentState(); |
---|
1213 | } |
---|
1214 | |
---|
1215 | int SetThreshold(const EventImp &evt) |
---|
1216 | { |
---|
1217 | if (!CheckEventSize(evt.GetSize(), "SetThreshold", 8)) |
---|
1218 | return T::kSM_FatalError; |
---|
1219 | |
---|
1220 | const int32_t *data = evt.Ptr<int32_t>(); |
---|
1221 | |
---|
1222 | if (!fFTM.SetThreshold(data[0], data[1])) |
---|
1223 | T::Warn("SetThreshold - Maximum allowed patch number 159, valid value range 0-0xffff"); |
---|
1224 | |
---|
1225 | return T::GetCurrentState(); |
---|
1226 | } |
---|
1227 | |
---|
1228 | int EnableFTU(const EventImp &evt) |
---|
1229 | { |
---|
1230 | if (!CheckEventSize(evt.GetSize(), "EnableFTU", 5)) |
---|
1231 | return T::kSM_FatalError; |
---|
1232 | |
---|
1233 | const int32_t &board = evt.Get<int32_t>(); |
---|
1234 | const int8_t &enable = evt.Get<int8_t>(4); |
---|
1235 | |
---|
1236 | if (!fFTM.EnableFTU(board, enable)) |
---|
1237 | T::Warn("EnableFTU - Board number must be <40."); |
---|
1238 | |
---|
1239 | return T::GetCurrentState(); |
---|
1240 | } |
---|
1241 | |
---|
1242 | int ToggleFTU(const EventImp &evt) |
---|
1243 | { |
---|
1244 | if (!CheckEventSize(evt.GetSize(), "ToggleFTU", 4)) |
---|
1245 | return T::kSM_FatalError; |
---|
1246 | |
---|
1247 | if (!fFTM.ToggleFTU(evt.GetInt())) |
---|
1248 | T::Warn("ToggleFTU - Allowed range of boards 0-39."); |
---|
1249 | |
---|
1250 | return T::GetCurrentState(); |
---|
1251 | } |
---|
1252 | |
---|
1253 | int SetTriggerInterval(const EventImp &evt) |
---|
1254 | { |
---|
1255 | if (!CheckEventSize(evt.GetSize(), "SetTriggerInterval", 4)) |
---|
1256 | return T::kSM_FatalError; |
---|
1257 | |
---|
1258 | if (!fFTM.SetTriggerInterval(evt.GetInt())) |
---|
1259 | T::Warn("SetTriggerInterval - Value out of range."); |
---|
1260 | |
---|
1261 | return T::GetCurrentState(); |
---|
1262 | } |
---|
1263 | |
---|
1264 | int SetTriggerDelay(const EventImp &evt) |
---|
1265 | { |
---|
1266 | if (!CheckEventSize(evt.GetSize(), "SetTriggerDelay", 4)) |
---|
1267 | return T::kSM_FatalError; |
---|
1268 | |
---|
1269 | if (!fFTM.SetTriggerDelay(evt.GetInt())) |
---|
1270 | T::Warn("SetTriggerDealy - Value out of range."); |
---|
1271 | |
---|
1272 | return T::GetCurrentState(); |
---|
1273 | } |
---|
1274 | |
---|
1275 | int SetTimeMarkerDelay(const EventImp &evt) |
---|
1276 | { |
---|
1277 | if (!CheckEventSize(evt.GetSize(), "SetTimeMarkerDelay", 4)) |
---|
1278 | return T::kSM_FatalError; |
---|
1279 | |
---|
1280 | if (!fFTM.SetTimeMarkerDelay(evt.GetInt())) |
---|
1281 | T::Warn("SetTimeMarkerDelay - Value out of range."); |
---|
1282 | |
---|
1283 | return T::GetCurrentState(); |
---|
1284 | } |
---|
1285 | |
---|
1286 | int SetPrescaling(const EventImp &evt) |
---|
1287 | { |
---|
1288 | if (!CheckEventSize(evt.GetSize(), "SetPrescaling", 4)) |
---|
1289 | return T::kSM_FatalError; |
---|
1290 | |
---|
1291 | if (!fFTM.SetPrescaling(evt.GetInt()-1)) |
---|
1292 | T::Warn("SetPrescaling - Value out of range."); |
---|
1293 | |
---|
1294 | return T::GetCurrentState(); |
---|
1295 | } |
---|
1296 | |
---|
1297 | int SetTriggerSeq(const EventImp &evt) |
---|
1298 | { |
---|
1299 | if (!CheckEventSize(evt.GetSize(), "SetTriggerSeq", 6)) |
---|
1300 | return T::kSM_FatalError; |
---|
1301 | |
---|
1302 | const uint16_t *data = evt.Ptr<uint16_t>(); |
---|
1303 | |
---|
1304 | if (!fFTM.SetTriggerSeq(data)) |
---|
1305 | T::Warn("SetTriggerSeq - Value out of range."); |
---|
1306 | |
---|
1307 | return T::GetCurrentState(); |
---|
1308 | } |
---|
1309 | |
---|
1310 | int SetDeadTime(const EventImp &evt) |
---|
1311 | { |
---|
1312 | if (!CheckEventSize(evt.GetSize(), "SetDeadTime", 4)) |
---|
1313 | return T::kSM_FatalError; |
---|
1314 | |
---|
1315 | if (!fFTM.SetDeadTime(evt.GetInt())) |
---|
1316 | T::Warn("SetDeadTime - Value out of range."); |
---|
1317 | |
---|
1318 | return T::GetCurrentState(); |
---|
1319 | } |
---|
1320 | |
---|
1321 | int SetTriggerMultiplicity(const EventImp &evt) |
---|
1322 | { |
---|
1323 | if (!CheckEventSize(evt.GetSize(), "SetTriggerMultiplicity", 2)) |
---|
1324 | return T::kSM_FatalError; |
---|
1325 | |
---|
1326 | if (!fFTM.SetTriggerMultiplicity(evt.GetUShort())) |
---|
1327 | T::Warn("SetTriggerMultiplicity - Value out of range."); |
---|
1328 | |
---|
1329 | return T::GetCurrentState(); |
---|
1330 | } |
---|
1331 | |
---|
1332 | int SetCalibMultiplicity(const EventImp &evt) |
---|
1333 | { |
---|
1334 | if (!CheckEventSize(evt.GetSize(), "SetCalibMultiplicity", 2)) |
---|
1335 | return T::kSM_FatalError; |
---|
1336 | |
---|
1337 | if (!fFTM.SetCalibMultiplicity(evt.GetUShort())) |
---|
1338 | T::Warn("SetCalibMultiplicity - Value out of range."); |
---|
1339 | |
---|
1340 | return T::GetCurrentState(); |
---|
1341 | } |
---|
1342 | |
---|
1343 | int SetTriggerWindow(const EventImp &evt) |
---|
1344 | { |
---|
1345 | if (!CheckEventSize(evt.GetSize(), "SetTriggerWindow", 2)) |
---|
1346 | return T::kSM_FatalError; |
---|
1347 | |
---|
1348 | if (!fFTM.SetTriggerWindow(evt.GetUShort())) |
---|
1349 | T::Warn("SetTriggerWindow - Value out of range."); |
---|
1350 | |
---|
1351 | return T::GetCurrentState(); |
---|
1352 | } |
---|
1353 | |
---|
1354 | int SetCalibWindow(const EventImp &evt) |
---|
1355 | { |
---|
1356 | if (!CheckEventSize(evt.GetSize(), "SetCalibWindow", 2)) |
---|
1357 | return T::kSM_FatalError; |
---|
1358 | |
---|
1359 | if (!fFTM.SetCalibWindow(evt.GetUShort())) |
---|
1360 | T::Warn("SetCalibWindow - Value out of range."); |
---|
1361 | |
---|
1362 | return T::GetCurrentState(); |
---|
1363 | } |
---|
1364 | |
---|
1365 | |
---|
1366 | int Enable(const EventImp &evt, FTM::StaticData::GeneralSettings type) |
---|
1367 | { |
---|
1368 | if (!CheckEventSize(evt.GetSize(), "Enable", 1)) |
---|
1369 | return T::kSM_FatalError; |
---|
1370 | |
---|
1371 | fFTM.Enable(type, evt.GetBool()); |
---|
1372 | |
---|
1373 | return T::GetCurrentState(); |
---|
1374 | } |
---|
1375 | |
---|
1376 | int EnablePixel(const EventImp &evt, bool b) |
---|
1377 | { |
---|
1378 | if (!CheckEventSize(evt.GetSize(), "EnablePixel", 2)) |
---|
1379 | return T::kSM_FatalError; |
---|
1380 | |
---|
1381 | fFTM.EnablePixel(evt.GetUShort(), b); |
---|
1382 | |
---|
1383 | return T::GetCurrentState(); |
---|
1384 | } |
---|
1385 | |
---|
1386 | int TogglePixel(const EventImp &evt) |
---|
1387 | { |
---|
1388 | if (!CheckEventSize(evt.GetSize(), "TogglePixel", 2)) |
---|
1389 | return T::kSM_FatalError; |
---|
1390 | |
---|
1391 | fFTM.TogglePixel(evt.GetUShort()); |
---|
1392 | |
---|
1393 | return T::GetCurrentState(); |
---|
1394 | } |
---|
1395 | |
---|
1396 | int ResetCrate(const EventImp &evt) |
---|
1397 | { |
---|
1398 | if (!CheckEventSize(evt.GetSize(), "ResetCrate", 2)) |
---|
1399 | return T::kSM_FatalError; |
---|
1400 | |
---|
1401 | fFTM.CmdResetCrate(evt.GetUShort()); |
---|
1402 | |
---|
1403 | return T::GetCurrentState(); |
---|
1404 | } |
---|
1405 | |
---|
1406 | int Disconnect() |
---|
1407 | { |
---|
1408 | // Close all connections |
---|
1409 | fFTM.PostClose(false); |
---|
1410 | |
---|
1411 | /* |
---|
1412 | // Now wait until all connection have been closed and |
---|
1413 | // all pending handlers have been processed |
---|
1414 | poll(); |
---|
1415 | */ |
---|
1416 | |
---|
1417 | return T::GetCurrentState(); |
---|
1418 | } |
---|
1419 | |
---|
1420 | int Reconnect(const EventImp &evt) |
---|
1421 | { |
---|
1422 | // Close all connections to supress the warning in SetEndpoint |
---|
1423 | fFTM.PostClose(false); |
---|
1424 | |
---|
1425 | // Now wait until all connection have been closed and |
---|
1426 | // all pending handlers have been processed |
---|
1427 | poll(); |
---|
1428 | |
---|
1429 | if (evt.GetBool()) |
---|
1430 | fFTM.SetEndpoint(evt.GetString()); |
---|
1431 | |
---|
1432 | // Now we can reopen the connection |
---|
1433 | fFTM.PostClose(true); |
---|
1434 | |
---|
1435 | return T::GetCurrentState(); |
---|
1436 | } |
---|
1437 | |
---|
1438 | /* |
---|
1439 | int Transition(const Event &evt) |
---|
1440 | { |
---|
1441 | switch (evt.GetTargetState()) |
---|
1442 | { |
---|
1443 | case kStateDisconnected: |
---|
1444 | case kStateConnected: |
---|
1445 | } |
---|
1446 | |
---|
1447 | return T::kSM_FatalError; |
---|
1448 | }*/ |
---|
1449 | |
---|
1450 | int Execute() |
---|
1451 | { |
---|
1452 | // Dispatch (execute) at most one handler from the queue. In contrary |
---|
1453 | // to run_one(), it doesn't wait until a handler is available |
---|
1454 | // which can be dispatched, so poll_one() might return with 0 |
---|
1455 | // handlers dispatched. The handlers are always dispatched/executed |
---|
1456 | // synchronously, i.e. within the call to poll_one() |
---|
1457 | poll_one(); |
---|
1458 | |
---|
1459 | return fFTM.GetState(); |
---|
1460 | } |
---|
1461 | |
---|
1462 | public: |
---|
1463 | StateMachineFTM(ostream &out=cout) : |
---|
1464 | T(out, "FTM_CONTROL"), ba::io_service::work(static_cast<ba::io_service&>(*this)), |
---|
1465 | fFTM(*this, *this) |
---|
1466 | { |
---|
1467 | // ba::io_service::work is a kind of keep_alive for the loop. |
---|
1468 | // It prevents the io_service to go to stopped state, which |
---|
1469 | // would prevent any consecutive calls to run() |
---|
1470 | // or poll() to do nothing. reset() could also revoke to the |
---|
1471 | // previous state but this might introduce some overhead of |
---|
1472 | // deletion and creation of threads and more. |
---|
1473 | |
---|
1474 | // State names |
---|
1475 | AddStateName(kStateDisconnected, "Disconnected", |
---|
1476 | "FTM board not connected via ethernet."); |
---|
1477 | |
---|
1478 | AddStateName(kStateConnected, "Connected", |
---|
1479 | "Ethernet connection to FTM established (no state received yet)."); |
---|
1480 | |
---|
1481 | AddStateName(kStateIdle, "Idle", |
---|
1482 | "Ethernet connection to FTM established, FTM in idle state."); |
---|
1483 | |
---|
1484 | AddStateName(kStateTakingData, "TakingData", |
---|
1485 | "Ethernet connection to FTM established, FTM is in taking data state."); |
---|
1486 | |
---|
1487 | // FTM Commands |
---|
1488 | AddEvent("TOGGLE_LED", kStateIdle) |
---|
1489 | (Wrapper(boost::bind(&ConnectionFTM::CmdToggleLed, &fFTM))) |
---|
1490 | ("toggle led"); |
---|
1491 | |
---|
1492 | AddEvent("PING", kStateIdle) |
---|
1493 | (Wrapper(boost::bind(&ConnectionFTM::CmdPing, &fFTM))) |
---|
1494 | ("send ping"); |
---|
1495 | |
---|
1496 | AddEvent("REQUEST_DYNAMIC_DATA", kStateIdle) |
---|
1497 | (Wrapper(boost::bind(&ConnectionFTM::CmdReqDynDat, &fFTM))) |
---|
1498 | ("request transmission of dynamic data block"); |
---|
1499 | |
---|
1500 | AddEvent("REQUEST_STATIC_DATA", kStateIdle) |
---|
1501 | (Wrapper(boost::bind(&ConnectionFTM::CmdReqStatDat, &fFTM))) |
---|
1502 | ("request transmission of static data from FTM to memory"); |
---|
1503 | |
---|
1504 | AddEvent("GET_REGISTER", "I", kStateIdle) |
---|
1505 | (boost::bind(&StateMachineFTM::GetRegister, this, _1)) |
---|
1506 | ("read register from address addr" |
---|
1507 | "|addr[short]:Address of register"); |
---|
1508 | |
---|
1509 | AddEvent("SET_REGISTER", "I:2", kStateIdle) |
---|
1510 | (boost::bind(&StateMachineFTM::SetRegister, this, _1)) |
---|
1511 | ("set register to value" |
---|
1512 | "|addr[short]:Address of register" |
---|
1513 | "|val[short]:Value to be set"); |
---|
1514 | |
---|
1515 | AddEvent("START_RUN", kStateIdle) |
---|
1516 | (Wrapper(boost::bind(&ConnectionFTM::CmdStartRun, &fFTM))) |
---|
1517 | ("start a run (start distributing triggers)"); |
---|
1518 | |
---|
1519 | AddEvent("STOP_RUN", kStateTakingData) |
---|
1520 | (Wrapper(boost::bind(&ConnectionFTM::CmdStopRun, &fFTM))) |
---|
1521 | ("stop a run (stop distributing triggers)"); |
---|
1522 | |
---|
1523 | AddEvent("TAKE_N_EVENTS", "I", kStateIdle) |
---|
1524 | (boost::bind(&StateMachineFTM::TakeNevents, this, _1)) |
---|
1525 | ("take n events (distribute n triggers)|number[int]:Number of events to be taken"); |
---|
1526 | |
---|
1527 | AddEvent("DISABLE_REPORTS", "B", kStateIdle) |
---|
1528 | (boost::bind(&StateMachineFTM::DisableReports, this, _1)) |
---|
1529 | ("disable sending rate reports" |
---|
1530 | "|status[bool]:disable or enable that the FTM sends rate reports (yes/no)"); |
---|
1531 | |
---|
1532 | AddEvent("SET_THRESHOLD", "I:2", kStateIdle) |
---|
1533 | (boost::bind(&StateMachineFTM::SetThreshold, this, _1)) |
---|
1534 | ("Set the comparator threshold" |
---|
1535 | "|Patch[idx]:Index of the patch (0-159), -1 for all" |
---|
1536 | "|Threshold[counts]:Threshold to be set in binary counts"); |
---|
1537 | |
---|
1538 | AddEvent("SET_PRESCALING", "I:1", kStateIdle) |
---|
1539 | (boost::bind(&StateMachineFTM::SetPrescaling, this, _1)) |
---|
1540 | ("" |
---|
1541 | "|[]:"); |
---|
1542 | |
---|
1543 | AddEvent("ENABLE_FTU", "I:1;B:1", kStateIdle) |
---|
1544 | (boost::bind(&StateMachineFTM::EnableFTU, this, _1)) |
---|
1545 | ("Enable or disable FTU" |
---|
1546 | "|Board[idx]:Index of the board (0-39), -1 for all" |
---|
1547 | "|Enable[bool]:Whether FTU should be enabled or disabled (yes/no)"); |
---|
1548 | |
---|
1549 | AddEvent("DISABLE_PIXEL", "S:1", kStateIdle) |
---|
1550 | (boost::bind(&StateMachineFTM::EnablePixel, this, _1, false)) |
---|
1551 | (""); |
---|
1552 | |
---|
1553 | AddEvent("ENABLE_PIXEL", "S:1", kStateIdle) |
---|
1554 | (boost::bind(&StateMachineFTM::EnablePixel, this, _1, true)) |
---|
1555 | (""); |
---|
1556 | |
---|
1557 | AddEvent("TOGGLE_PIXEL", "S:1", kStateIdle) |
---|
1558 | (boost::bind(&StateMachineFTM::TogglePixel, this, _1)) |
---|
1559 | (""); |
---|
1560 | |
---|
1561 | AddEvent("TOGGLE_FTU", "I:1", kStateIdle) |
---|
1562 | (boost::bind(&StateMachineFTM::ToggleFTU, this, _1)) |
---|
1563 | ("Toggle status of FTU (this is mainly meant to be used in the GUI)" |
---|
1564 | "|Board[idx]:Index of the board (0-39)"); |
---|
1565 | |
---|
1566 | AddEvent("SET_TRIGGER_INTERVAL", "I:1", kStateIdle) |
---|
1567 | (boost::bind(&StateMachineFTM::SetTriggerInterval, this, _1)) |
---|
1568 | ("Sets the trigger interval which is the distance between two consecutive artificial triggers." |
---|
1569 | "|interval[int]:The applied trigger interval is: interval*4ns+8ns"); |
---|
1570 | |
---|
1571 | AddEvent("SET_TRIGGER_DELAY", "I:1", kStateIdle) |
---|
1572 | (boost::bind(&StateMachineFTM::SetTriggerDelay, this, _1)) |
---|
1573 | ("" |
---|
1574 | "|delay[int]:The applied trigger delay is: delay*4ns+8ns"); |
---|
1575 | |
---|
1576 | AddEvent("SET_TIME_MARKER_DELAY", "I:1", kStateIdle) |
---|
1577 | (boost::bind(&StateMachineFTM::SetTimeMarkerDelay, this, _1)) |
---|
1578 | ("" |
---|
1579 | "|delay[int]:The applied time marker delay is: delay*4ns+8ns"); |
---|
1580 | |
---|
1581 | AddEvent("SET_DEAD_TIME", "I:1", kStateIdle) |
---|
1582 | (boost::bind(&StateMachineFTM::SetDeadTime, this, _1)) |
---|
1583 | ("" |
---|
1584 | "|dead_time[int]:The applied dead time is: dead_time*4ns+8ns"); |
---|
1585 | |
---|
1586 | AddEvent("ENABLE_TRIGGER", "B:1", kStateIdle) |
---|
1587 | (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kTrigger)) |
---|
1588 | ("Switch on the physics trigger" |
---|
1589 | "|Enable[bool]:Enable physics trigger (yes/no)"); |
---|
1590 | |
---|
1591 | // FIXME: Switch on/off depending on sequence |
---|
1592 | AddEvent("ENABLE_EXT1", "B:1", kStateIdle) |
---|
1593 | (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kExt1)) |
---|
1594 | ("Switch on the triggers through the first external line" |
---|
1595 | "|Enable[bool]:Enable ext1 trigger (yes/no)"); |
---|
1596 | |
---|
1597 | // FIXME: Switch on/off depending on sequence |
---|
1598 | AddEvent("ENABLE_EXT2", "B:1", kStateIdle) |
---|
1599 | (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kExt2)) |
---|
1600 | ("Switch on the triggers through the second external line" |
---|
1601 | "|Enable[bool]:Enable ext2 trigger (yes/no)"); |
---|
1602 | |
---|
1603 | AddEvent("ENABLE_VETO", "B:1", kStateIdle) |
---|
1604 | (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kVeto)) |
---|
1605 | ("Enable veto line" |
---|
1606 | "|Enable[bool]:Enable veto (yes/no)"); |
---|
1607 | |
---|
1608 | AddEvent("ENABLE_CLOCK_CONDITIONER", "B:1", kStateIdle) |
---|
1609 | (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kClockConditioner)) |
---|
1610 | ("Enable clock conidtioner output in favor of time marker output" |
---|
1611 | "|Enable[bool]:Enable clock conditioner (yes/no)"); |
---|
1612 | |
---|
1613 | AddEvent("SET_TRIGGER_SEQUENCE", "S:3", kStateIdle) |
---|
1614 | (boost::bind(&StateMachineFTM::SetTriggerSeq, this, _1)) |
---|
1615 | ("Setup the sequence of artificial triggers produced by the FTM" |
---|
1616 | "|Ped[short]:number of pedestal triggers in a row" |
---|
1617 | "|LPext[short]:number of triggers of the external light pulser" |
---|
1618 | "|LPint[short]:number of triggers of the internal light pulser"); |
---|
1619 | |
---|
1620 | AddEvent("SET_TRIGGER_MULTIPLICITY", "S:1", kStateIdle) |
---|
1621 | (boost::bind(&StateMachineFTM::SetTriggerMultiplicity, this, _1)) |
---|
1622 | ("Setup the Multiplicity condition for physcis triggers" |
---|
1623 | "|N[int]:Number of requirered coincident triggers from sum-patches (1-40)"); |
---|
1624 | |
---|
1625 | AddEvent("SET_TRIGGER_WINDOW", "S:1", kStateIdle) |
---|
1626 | (boost::bind(&StateMachineFTM::SetTriggerWindow, this, _1)) |
---|
1627 | (""); |
---|
1628 | |
---|
1629 | AddEvent("SET_CALIBRATION_MULTIPLICITY", "S:1", kStateIdle) |
---|
1630 | (boost::bind(&StateMachineFTM::SetCalibMultiplicity, this, _1)) |
---|
1631 | ("Setup the Multiplicity condition for artificial (calibration) triggers" |
---|
1632 | "|N[int]:Number of requirered coincident triggers from sum-patches (1-40)"); |
---|
1633 | |
---|
1634 | AddEvent("SET_CALIBRATION_WINDOW", "S:1", kStateIdle) |
---|
1635 | (boost::bind(&StateMachineFTM::SetCalibWindow, this, _1)) |
---|
1636 | (""); |
---|
1637 | |
---|
1638 | AddEvent("RESET_CRATE", "S:1", kStateIdle) |
---|
1639 | (boost::bind(&StateMachineFTM::ResetCrate, this, _1)) |
---|
1640 | ("Reset one of the crates 0-3" |
---|
1641 | "|crate[short]:Crate number to be reseted (0-3)"); |
---|
1642 | |
---|
1643 | AddEvent("RESET_CAMERA", kStateIdle) |
---|
1644 | (Wrapper(boost::bind(&ConnectionFTM::CmdResetCamera, &fFTM))) |
---|
1645 | ("Reset all crates. The commands are sent in the order 0,1,2,3"); |
---|
1646 | |
---|
1647 | |
---|
1648 | // Load/save static data block |
---|
1649 | T::AddEvent("SAVE", "C", kStateIdle) |
---|
1650 | (boost::bind(&StateMachineFTM::SaveStaticData, this, _1)) |
---|
1651 | ("Saves the static data (FTM configuration) from memory to a file" |
---|
1652 | "|filename[string]:Filename (can include a path), .bin is automatically added"); |
---|
1653 | |
---|
1654 | T::AddEvent("LOAD", "C", kStateIdle) |
---|
1655 | (boost::bind(&StateMachineFTM::LoadStaticData, this, _1)) |
---|
1656 | ("Loads the static data (FTM configuration) from a file into memory and sends it to the FTM" |
---|
1657 | "|filename[string]:Filename (can include a path), .bin is automatically added"); |
---|
1658 | |
---|
1659 | |
---|
1660 | |
---|
1661 | // Verbosity commands |
---|
1662 | T::AddEvent("SET_VERBOSE", "B") |
---|
1663 | (boost::bind(&StateMachineFTM::SetVerbosity, this, _1)) |
---|
1664 | ("set verbosity state" |
---|
1665 | "|verbosity[bool]:disable or enable verbosity for received data (yes/no), except dynamic data"); |
---|
1666 | |
---|
1667 | T::AddEvent("SET_HEX_OUTPUT", "B") |
---|
1668 | (boost::bind(&StateMachineFTM::SetHexOutput, this, _1)) |
---|
1669 | ("enable or disable hex output for received data" |
---|
1670 | "|hexout[bool]:disable or enable hex output for received data (yes/no)"); |
---|
1671 | |
---|
1672 | T::AddEvent("SET_DYNAMIC_OUTPUT", "B") |
---|
1673 | (boost::bind(&StateMachineFTM::SetDynamicOut, this, _1)) |
---|
1674 | ("enable or disable output for received dynamic data (data is still broadcasted via Dim)" |
---|
1675 | "|dynout[bool]:disable or enable output for dynamic data (yes/no)"); |
---|
1676 | |
---|
1677 | |
---|
1678 | // Conenction commands |
---|
1679 | AddEvent("DISCONNECT", kStateConnected, kStateIdle) |
---|
1680 | (boost::bind(&StateMachineFTM::Disconnect, this)) |
---|
1681 | ("disconnect from ethernet"); |
---|
1682 | |
---|
1683 | AddEvent("RECONNECT", "O", kStateDisconnected, kStateConnected, kStateIdle) |
---|
1684 | (boost::bind(&StateMachineFTM::Reconnect, this, _1)) |
---|
1685 | ("(Re)connect ethernet connection to FTM, a new address can be given" |
---|
1686 | "|[host][string]:new ethernet address in the form <host:port>"); |
---|
1687 | |
---|
1688 | fFTM.StartConnect(); |
---|
1689 | } |
---|
1690 | |
---|
1691 | void SetEndpoint(const string &url) |
---|
1692 | { |
---|
1693 | fFTM.SetEndpoint(url); |
---|
1694 | } |
---|
1695 | |
---|
1696 | bool SetConfiguration(const Configuration &conf) |
---|
1697 | { |
---|
1698 | SetEndpoint(conf.Get<string>("addr")); |
---|
1699 | |
---|
1700 | fFTM.SetVerbose(!conf.Get<bool>("quiet")); |
---|
1701 | fFTM.SetHexOutput(conf.Get<bool>("hex-out")); |
---|
1702 | fFTM.SetDynamicOut(conf.Get<bool>("dynamic-out")); |
---|
1703 | |
---|
1704 | // fFTM.SetDefaultSetup(conf.Get<string>("default-setup")); |
---|
1705 | |
---|
1706 | return true; |
---|
1707 | } |
---|
1708 | }; |
---|
1709 | |
---|
1710 | // ------------------------------------------------------------------------ |
---|
1711 | |
---|
1712 | void RunThread(StateMachineImp *io_service) |
---|
1713 | { |
---|
1714 | // This is necessary so that the StateMachien Thread can signal the |
---|
1715 | // Readline to exit |
---|
1716 | io_service->Run(); |
---|
1717 | Readline::Stop(); |
---|
1718 | } |
---|
1719 | |
---|
1720 | template<class S, class T> |
---|
1721 | int RunDim(Configuration &conf) |
---|
1722 | { |
---|
1723 | WindowLog wout; |
---|
1724 | |
---|
1725 | /* |
---|
1726 | static Test shell(conf.GetName().c_str(), conf.Get<int>("console")!=1); |
---|
1727 | |
---|
1728 | WindowLog &win = shell.GetStreamIn(); |
---|
1729 | WindowLog &wout = shell.GetStreamOut(); |
---|
1730 | */ |
---|
1731 | |
---|
1732 | if (conf.Has("log")) |
---|
1733 | if (!wout.OpenLogFile(conf.Get<string>("log"))) |
---|
1734 | wout << kRed << "ERROR - Couldn't open log-file " << conf.Get<string>("log") << ": " << strerror(errno) << endl; |
---|
1735 | |
---|
1736 | // Start io_service.Run to use the StateMachineImp::Run() loop |
---|
1737 | // Start io_service.run to only use the commandHandler command detaching |
---|
1738 | StateMachineFTM<S, T> io_service(wout); |
---|
1739 | if (!io_service.SetConfiguration(conf)) |
---|
1740 | return -1; |
---|
1741 | |
---|
1742 | io_service.Run(); |
---|
1743 | |
---|
1744 | /* |
---|
1745 | shell.SetReceiver(io_service); |
---|
1746 | |
---|
1747 | boost::thread t(boost::bind(RunThread, &io_service)); |
---|
1748 | // boost::thread t(boost::bind(&StateMachineFTM<S>::Run, &io_service)); |
---|
1749 | |
---|
1750 | shell.Run(); // Run the shell |
---|
1751 | io_service.Stop(); // Signal Loop-thread to stop |
---|
1752 | // io_service.Close(); // Obsolete, done by the destructor |
---|
1753 | |
---|
1754 | // Wait until the StateMachine has finished its thread |
---|
1755 | // before returning and destroying the dim objects which might |
---|
1756 | // still be in use. |
---|
1757 | t.join(); |
---|
1758 | */ |
---|
1759 | |
---|
1760 | return 0; |
---|
1761 | } |
---|
1762 | |
---|
1763 | template<class T, class S, class R> |
---|
1764 | int RunShell(Configuration &conf) |
---|
1765 | { |
---|
1766 | static T shell(conf.GetName().c_str(), conf.Get<int>("console")!=1); |
---|
1767 | |
---|
1768 | WindowLog &win = shell.GetStreamIn(); |
---|
1769 | WindowLog &wout = shell.GetStreamOut(); |
---|
1770 | |
---|
1771 | if (conf.Has("log")) |
---|
1772 | if (!wout.OpenLogFile(conf.Get<string>("log"))) |
---|
1773 | win << kRed << "ERROR - Couldn't open log-file " << conf.Get<string>("log") << ": " << strerror(errno) << endl; |
---|
1774 | |
---|
1775 | StateMachineFTM<S, R> io_service(wout); |
---|
1776 | if (!io_service.SetConfiguration(conf)) |
---|
1777 | return -1; |
---|
1778 | |
---|
1779 | shell.SetReceiver(io_service); |
---|
1780 | |
---|
1781 | boost::thread t(boost::bind(RunThread, &io_service)); |
---|
1782 | // boost::thread t(boost::bind(&StateMachineFTM<S>::Run, &io_service)); |
---|
1783 | |
---|
1784 | shell.Run(); // Run the shell |
---|
1785 | io_service.Stop(); // Signal Loop-thread to stop |
---|
1786 | // io_service.Close(); // Obsolete, done by the destructor |
---|
1787 | |
---|
1788 | // Wait until the StateMachine has finished its thread |
---|
1789 | // before returning and destroying the dim objects which might |
---|
1790 | // still be in use. |
---|
1791 | t.join(); |
---|
1792 | |
---|
1793 | return 0; |
---|
1794 | } |
---|
1795 | |
---|
1796 | void SetupConfiguration(Configuration &conf) |
---|
1797 | { |
---|
1798 | const string n = conf.GetName()+".log"; |
---|
1799 | |
---|
1800 | po::options_description config("Program options"); |
---|
1801 | config.add_options() |
---|
1802 | ("dns", var<string>("localhost"), "Dim nameserver host name (Overwites DIM_DNS_NODE environment variable)") |
---|
1803 | ("log,l", var<string>(n), "Write log-file") |
---|
1804 | ("no-dim,d", po_bool(), "Disable dim services") |
---|
1805 | ("console,c", var<int>(), "Use console (0=shell, 1=simple buffered, X=simple unbuffered)") |
---|
1806 | ; |
---|
1807 | |
---|
1808 | po::options_description control("FTM control options"); |
---|
1809 | control.add_options() |
---|
1810 | ("addr,a", var<string>("localhost:5000"), "Network address of FTM") |
---|
1811 | ("quiet,q", po_bool(), "Disable printing contents of all received messages (except dynamic data) in clear text.") |
---|
1812 | ("hex-out", po_bool(), "Enable printing contents of all printed messages also as hex data.") |
---|
1813 | ("dynamic-out", po_bool(), "Enable printing received dynamic data.") |
---|
1814 | // ("default-setup", var<string>(), "Binary file with static data loaded whenever a connection to the FTM was established.") |
---|
1815 | ; |
---|
1816 | |
---|
1817 | conf.AddEnv("dns", "DIM_DNS_NODE"); |
---|
1818 | |
---|
1819 | conf.AddOptions(config); |
---|
1820 | conf.AddOptions(control); |
---|
1821 | } |
---|
1822 | |
---|
1823 | /* |
---|
1824 | Extract usage clause(s) [if any] for SYNOPSIS. |
---|
1825 | Translators: "Usage" and "or" here are patterns (regular expressions) which |
---|
1826 | are used to match the usage synopsis in program output. An example from cp |
---|
1827 | (GNU coreutils) which contains both strings: |
---|
1828 | Usage: cp [OPTION]... [-T] SOURCE DEST |
---|
1829 | or: cp [OPTION]... SOURCE... DIRECTORY |
---|
1830 | or: cp [OPTION]... -t DIRECTORY SOURCE... |
---|
1831 | */ |
---|
1832 | void PrintUsage() |
---|
1833 | { |
---|
1834 | cout << |
---|
1835 | "The ftmctrl controls the FTM (FACT Trigger Master) board.\n" |
---|
1836 | "\n" |
---|
1837 | "The default is that the program is started without user intercation. " |
---|
1838 | "All actions are supposed to arrive as DimCommands. Using the -c " |
---|
1839 | "option, a local shell can be initialized. With h or help a short " |
---|
1840 | "help message about the usuage can be brought to the screen.\n" |
---|
1841 | "\n" |
---|
1842 | "Usage: ftmctrl [-c type] [OPTIONS]\n" |
---|
1843 | " or: ftmctrl [OPTIONS]\n"; |
---|
1844 | cout << endl; |
---|
1845 | } |
---|
1846 | |
---|
1847 | void PrintHelp() |
---|
1848 | { |
---|
1849 | /* Additional help text which is printed after the configuration |
---|
1850 | options goes here */ |
---|
1851 | |
---|
1852 | /* |
---|
1853 | cout << "bla bla bla" << endl << endl; |
---|
1854 | cout << endl; |
---|
1855 | cout << "Environment:" << endl; |
---|
1856 | cout << "environment" << endl; |
---|
1857 | cout << endl; |
---|
1858 | cout << "Examples:" << endl; |
---|
1859 | cout << "test exam" << endl; |
---|
1860 | cout << endl; |
---|
1861 | cout << "Files:" << endl; |
---|
1862 | cout << "files" << endl; |
---|
1863 | cout << endl; |
---|
1864 | */ |
---|
1865 | } |
---|
1866 | |
---|
1867 | int main(int argc, const char* argv[]) |
---|
1868 | { |
---|
1869 | Configuration conf(argv[0]); |
---|
1870 | conf.SetPrintUsage(PrintUsage); |
---|
1871 | SetupConfiguration(conf); |
---|
1872 | |
---|
1873 | po::variables_map vm; |
---|
1874 | try |
---|
1875 | { |
---|
1876 | vm = conf.Parse(argc, argv); |
---|
1877 | } |
---|
1878 | #if BOOST_VERSION > 104000 |
---|
1879 | catch (po::multiple_occurrences &e) |
---|
1880 | { |
---|
1881 | cerr << "Program options invalid due to: " << e.what() << " of '" << e.get_option_name() << "'." << endl; |
---|
1882 | return -1; |
---|
1883 | } |
---|
1884 | #endif |
---|
1885 | catch (exception& e) |
---|
1886 | { |
---|
1887 | cerr << "Program options invalid due to: " << e.what() << endl; |
---|
1888 | return -1; |
---|
1889 | } |
---|
1890 | |
---|
1891 | if (conf.HasVersion() || conf.HasPrint()) |
---|
1892 | return -1; |
---|
1893 | |
---|
1894 | if (conf.HasHelp()) |
---|
1895 | { |
---|
1896 | PrintHelp(); |
---|
1897 | return -1; |
---|
1898 | } |
---|
1899 | |
---|
1900 | Dim::Setup(conf.Get<string>("dns")); |
---|
1901 | |
---|
1902 | //try |
---|
1903 | { |
---|
1904 | // No console access at all |
---|
1905 | if (!conf.Has("console")) |
---|
1906 | { |
---|
1907 | if (conf.Get<bool>("no-dim")) |
---|
1908 | return RunDim<StateMachine, ConnectionFTM>(conf); |
---|
1909 | else |
---|
1910 | return RunDim<StateMachineDim, ConnectionDimFTM>(conf); |
---|
1911 | } |
---|
1912 | // Cosole access w/ and w/o Dim |
---|
1913 | if (conf.Get<bool>("no-dim")) |
---|
1914 | { |
---|
1915 | if (conf.Get<int>("console")==0) |
---|
1916 | return RunShell<LocalShell, StateMachine, ConnectionFTM>(conf); |
---|
1917 | else |
---|
1918 | return RunShell<LocalConsole, StateMachine, ConnectionFTM>(conf); |
---|
1919 | } |
---|
1920 | else |
---|
1921 | { |
---|
1922 | if (conf.Get<int>("console")==0) |
---|
1923 | return RunShell<LocalShell, StateMachineDim, ConnectionDimFTM>(conf); |
---|
1924 | else |
---|
1925 | return RunShell<LocalConsole, StateMachineDim, ConnectionDimFTM>(conf); |
---|
1926 | } |
---|
1927 | } |
---|
1928 | /*catch (std::exception& e) |
---|
1929 | { |
---|
1930 | cerr << "Exception: " << e.what() << endl; |
---|
1931 | return -1; |
---|
1932 | }*/ |
---|
1933 | |
---|
1934 | return 0; |
---|
1935 | } |
---|