source: trunk/FACT++/src/ftmctrl.cc@ 11157

Last change on this file since 11157 was 11148, checked in by tbretz, 13 years ago
Switched to DimDescribedService::Update
File size: 59.7 KB
Line 
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
27namespace ba = boost::asio;
28namespace bs = boost::system;
29
30using namespace std;
31
32// ------------------------------------------------------------------------
33
34class 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
70protected:
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
196private:
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 }
486public:
487
488// static const uint16_t kMaxAddr;
489
490public:
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()-4)
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()-4)
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 SetClockRegister(const uint64_t reg[])
901 {
902 for (int i=0; i<8; i++)
903 {
904 if (reg[i]>0xffffffff)
905 return false;
906
907 fStaticData.fClockConditioner[i] = reg[i];
908 }
909
910 CmdSendStatDat();
911
912 return true;
913 }
914
915 bool EnablePixel(int16_t idx, bool enable)
916 {
917 if (idx<-1 || idx>FTM::StaticData::kMaxPixelIdx)
918 return false;
919
920 if (idx==-1)
921 for (int i=0; i<=FTM::StaticData::kMaxPixelIdx; i++)
922 fStaticData.EnablePixel(i, enable);
923 else
924 fStaticData.EnablePixel(idx, enable);
925
926 CmdSendStatDat();
927
928 return true;
929 }
930
931 bool DisableAllPixelsExcept(uint16_t idx)
932 {
933 if (idx>FTM::StaticData::kMaxPixelIdx)
934 return false;
935
936 for (int i=0; i<=FTM::StaticData::kMaxPixelIdx; i++)
937 fStaticData.EnablePixel(i, i==idx);
938
939 CmdSendStatDat();
940
941 return true;
942 }
943
944 bool DisableAllPatchesExcept(uint16_t idx)
945 {
946 if (idx>FTM::StaticData::kMaxPatchIdx)
947 return false;
948
949 for (int i=0; i<=FTM::StaticData::kMaxPixelIdx; i++)
950 fStaticData.EnablePixel(i, i/9==idx);
951
952 CmdSendStatDat();
953
954 return true;
955 }
956
957 bool TogglePixel(uint16_t idx)
958 {
959 if (idx>FTM::StaticData::kMaxPixelIdx)
960 return false;
961
962 fStaticData.EnablePixel(idx, !fStaticData.Enabled(idx));
963
964 CmdSendStatDat();
965
966 return true;
967 }
968
969 int GetState() const { return IsConnected() ? fState : (int)FTM::kDisconnected; }
970};
971
972//const uint16_t ConnectionFTM::kMaxAddr = 0xfff;
973
974// ------------------------------------------------------------------------
975
976#include "DimDescriptionService.h"
977
978class ConnectionDimFTM : public ConnectionFTM
979{
980private:
981
982 DimDescribedService fDimPassport;
983 DimDescribedService fDimTriggerCounter;
984 DimDescribedService fDimError;
985 DimDescribedService fDimFtuList;
986 DimDescribedService fDimStaticData;
987 DimDescribedService fDimDynamicData;
988 DimDescribedService fDimCounter;
989
990 void UpdateFirstHeader()
991 {
992 ConnectionFTM::UpdateFirstHeader();
993
994 const FTM::DimPassport data(fHeader);
995 fDimPassport.Update(data);
996 }
997
998 void UpdateHeader()
999 {
1000 ConnectionFTM::UpdateHeader();
1001
1002 if (fHeader.fType!=FTM::kDynamicData)
1003 return;
1004
1005 const FTM::DimTriggerCounter data(fHeader);
1006 fDimTriggerCounter.Update(data);
1007 }
1008
1009 void UpdateFtuList()
1010 {
1011 ConnectionFTM::UpdateFtuList();
1012
1013 const FTM::DimFtuList data(fHeader, fFtuList);
1014 fDimFtuList.Update(data);
1015 }
1016
1017 void UpdateStaticData()
1018 {
1019 ConnectionFTM::UpdateStaticData();
1020
1021 const FTM::DimStaticData data(fHeader, fStaticData);
1022 fDimStaticData.Update(data);
1023 }
1024
1025 void UpdateDynamicData()
1026 {
1027 ConnectionFTM::UpdateDynamicData();
1028
1029 const FTM::DimDynamicData data(fHeader, fDynamicData);
1030 fDimDynamicData.Update(data);
1031 }
1032
1033 void UpdateError()
1034 {
1035 ConnectionFTM::UpdateError();
1036
1037 const FTM::DimError data(fHeader, fError);
1038 fDimError.Update(data);
1039 }
1040
1041 void UpdateCounter()
1042 {
1043 ConnectionFTM::UpdateCounter();
1044
1045 const uint32_t counter[6] =
1046 {
1047 fCounter[FTM::kHeader],
1048 fCounter[FTM::kStaticData],
1049 fCounter[FTM::kDynamicData],
1050 fCounter[FTM::kFtuList],
1051 fCounter[FTM::kErrorList],
1052 fCounter[FTM::kRegister],
1053 };
1054
1055 fDimCounter.Update(counter);
1056 }
1057
1058public:
1059 ConnectionDimFTM(ba::io_service& ioservice, MessageImp &imp) :
1060 ConnectionFTM(ioservice, imp),
1061 fDimPassport ("FTM_CONTROL/PASSPORT", "X:1;S:1", ""),
1062 fDimTriggerCounter("FTM_CONTROL/TRIGGER_COUNTER", "X:1;I:1", ""),
1063 fDimError ("FTM_CONTROL/ERROR", "X:1;S:1;S:28", ""),
1064 fDimFtuList ("FTM_CONTROL/FTU_LIST", "X:1;X:1;S:1;C:4;X:40;C:40;C:40", ""),
1065 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;I:8;S:90;S:160;S:40;S:40", ""),
1066 fDimDynamicData ("FTM_CONTROL/DYNAMIC_DATA", "X:1;X:1;F:4;I:160;I:40;S:40;S:40", ""),
1067 fDimCounter ("FTM_CONTROL/COUNTER", "I:6", "")
1068 {
1069 }
1070
1071 // 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
1072};
1073
1074// ------------------------------------------------------------------------
1075
1076template <class T, class S>
1077class StateMachineFTM : public T, public ba::io_service, public ba::io_service::work
1078{
1079 int Wrap(boost::function<void()> f)
1080 {
1081 f();
1082 return T::GetCurrentState();
1083 }
1084
1085 boost::function<int(const EventImp &)> Wrapper(boost::function<void()> func)
1086 {
1087 return boost::bind(&StateMachineFTM::Wrap, this, func);
1088 }
1089
1090private:
1091 S fFTM;
1092
1093 enum states_t
1094 {
1095 kStateDisconnected = FTM::kDisconnected,
1096 kStateConnected = FTM::kConnected,
1097 kStateIdle = FTM::kIdle,
1098 kStateTakingData = FTM::kTakingData,
1099
1100 kCmdTest
1101 };
1102
1103 bool CheckEventSize(size_t has, const char *name, size_t size)
1104 {
1105 if (has==size)
1106 return true;
1107
1108 ostringstream msg;
1109 msg << name << " - Received event has " << has << " bytes, but expected " << size << ".";
1110 T::Fatal(msg);
1111 return false;
1112 }
1113
1114 int SetRegister(const EventImp &evt)
1115 {
1116 if (!CheckEventSize(evt.GetSize(), "SetRegister", 8))
1117 return T::kSM_FatalError;
1118
1119 const uint32_t *dat = evt.Ptr<uint32_t>();
1120
1121 if (dat[1]>uint16_t(-1))
1122 {
1123 ostringstream msg;
1124 msg << hex << "Value " << dat[1] << " out of range.";
1125 T::Error(msg);
1126 return T::GetCurrentState();
1127 }
1128
1129
1130 if (dat[0]>uint16_t(-1) || !fFTM.CmdSetRegister(dat[0], dat[1]))
1131 {
1132 ostringstream msg;
1133 msg << hex << "Address " << dat[0] << " out of range.";
1134 T::Error(msg);
1135 }
1136
1137 return T::GetCurrentState();
1138 }
1139
1140 int GetRegister(const EventImp &evt)
1141 {
1142 if (!CheckEventSize(evt.GetSize(), "GetRegister", 4))
1143 return T::kSM_FatalError;
1144
1145 const unsigned int addr = evt.GetInt();
1146 if (addr>uint16_t(-1) || !fFTM.CmdGetRegister(addr))
1147 {
1148 ostringstream msg;
1149 msg << hex << "Address " << addr << " out of range.";
1150 T::Error(msg);
1151 }
1152
1153 return T::GetCurrentState();
1154 }
1155
1156 int TakeNevents(const EventImp &evt)
1157 {
1158 if (!CheckEventSize(evt.GetSize(), "TakeNevents", 4))
1159 return T::kSM_FatalError;
1160
1161 const unsigned int dat = evt.GetUInt();
1162
1163 /*
1164 if (dat[1]>uint32_t(-1))
1165 {
1166 ostringstream msg;
1167 msg << hex << "Value " << dat[1] << " out of range.";
1168 T::Error(msg);
1169 return T::GetCurrentState();
1170 }*/
1171
1172 fFTM.CmdTakeNevents(dat);
1173
1174 return T::GetCurrentState();
1175 }
1176
1177 int DisableReports(const EventImp &evt)
1178 {
1179 if (!CheckEventSize(evt.GetSize(), "DisableReports", 1))
1180 return T::kSM_FatalError;
1181
1182 fFTM.CmdDisableReports(evt.GetBool());
1183
1184 return T::GetCurrentState();
1185 }
1186
1187 int SetVerbosity(const EventImp &evt)
1188 {
1189 if (!CheckEventSize(evt.GetSize(), "SetVerbosity", 1))
1190 return T::kSM_FatalError;
1191
1192 fFTM.SetVerbose(evt.GetBool());
1193
1194 return T::GetCurrentState();
1195 }
1196
1197 int SetHexOutput(const EventImp &evt)
1198 {
1199 if (!CheckEventSize(evt.GetSize(), "SetHexOutput", 1))
1200 return T::kSM_FatalError;
1201
1202 fFTM.SetHexOutput(evt.GetBool());
1203
1204 return T::GetCurrentState();
1205 }
1206
1207 int SetDynamicOut(const EventImp &evt)
1208 {
1209 if (!CheckEventSize(evt.GetSize(), "SetDynamicOut", 1))
1210 return T::kSM_FatalError;
1211
1212 fFTM.SetDynamicOut(evt.GetBool());
1213
1214 return T::GetCurrentState();
1215 }
1216
1217 int LoadStaticData(const EventImp &evt)
1218 {
1219 if (fFTM.LoadStaticData(evt.GetString()))
1220 return T::GetCurrentState();
1221
1222 ostringstream msg;
1223 msg << "Loading static data from file '" << evt.GetString() << "' failed ";
1224
1225 if (errno)
1226 msg << "(" << strerror(errno) << ")";
1227 else
1228 msg << "(wrong size, expected " << sizeof(FTM::StaticData) << " bytes)";
1229
1230 T::Warn(msg);
1231
1232 return T::GetCurrentState();
1233 }
1234
1235 int SaveStaticData(const EventImp &evt)
1236 {
1237 if (fFTM.SaveStaticData(evt.GetString()))
1238 return T::GetCurrentState();
1239
1240 ostringstream msg;
1241 msg << "Writing static data to file '" << evt.GetString() << "' failed ";
1242 msg << "(" << strerror(errno) << ")";
1243
1244 T::Warn(msg);
1245
1246 return T::GetCurrentState();
1247 }
1248
1249 int SetThreshold(const EventImp &evt)
1250 {
1251 if (!CheckEventSize(evt.GetSize(), "SetThreshold", 8))
1252 return T::kSM_FatalError;
1253
1254 const int32_t *data = evt.Ptr<int32_t>();
1255
1256 if (!fFTM.SetThreshold(data[0], data[1]))
1257 T::Warn("SetThreshold - Maximum allowed patch number 159, valid value range 0-0xffff");
1258
1259 return T::GetCurrentState();
1260 }
1261
1262 int EnableFTU(const EventImp &evt)
1263 {
1264 if (!CheckEventSize(evt.GetSize(), "EnableFTU", 5))
1265 return T::kSM_FatalError;
1266
1267 const int32_t &board = evt.Get<int32_t>();
1268 const int8_t &enable = evt.Get<int8_t>(4);
1269
1270 if (!fFTM.EnableFTU(board, enable))
1271 T::Warn("EnableFTU - Board number must be <40.");
1272
1273 return T::GetCurrentState();
1274 }
1275
1276 int ToggleFTU(const EventImp &evt)
1277 {
1278 if (!CheckEventSize(evt.GetSize(), "ToggleFTU", 4))
1279 return T::kSM_FatalError;
1280
1281 if (!fFTM.ToggleFTU(evt.GetInt()))
1282 T::Warn("ToggleFTU - Allowed range of boards 0-39.");
1283
1284 return T::GetCurrentState();
1285 }
1286
1287 int SetTriggerInterval(const EventImp &evt)
1288 {
1289 if (!CheckEventSize(evt.GetSize(), "SetTriggerInterval", 4))
1290 return T::kSM_FatalError;
1291
1292 if (!fFTM.SetTriggerInterval(evt.GetInt()))
1293 T::Warn("SetTriggerInterval - Value out of range.");
1294
1295 return T::GetCurrentState();
1296 }
1297
1298 int SetTriggerDelay(const EventImp &evt)
1299 {
1300 if (!CheckEventSize(evt.GetSize(), "SetTriggerDelay", 4))
1301 return T::kSM_FatalError;
1302
1303 if (!fFTM.SetTriggerDelay(evt.GetInt()))
1304 T::Warn("SetTriggerDealy - Value out of range.");
1305
1306 return T::GetCurrentState();
1307 }
1308
1309 int SetTimeMarkerDelay(const EventImp &evt)
1310 {
1311 if (!CheckEventSize(evt.GetSize(), "SetTimeMarkerDelay", 4))
1312 return T::kSM_FatalError;
1313
1314 if (!fFTM.SetTimeMarkerDelay(evt.GetInt()))
1315 T::Warn("SetTimeMarkerDelay - Value out of range.");
1316
1317 return T::GetCurrentState();
1318 }
1319
1320 int SetPrescaling(const EventImp &evt)
1321 {
1322 if (!CheckEventSize(evt.GetSize(), "SetPrescaling", 4))
1323 return T::kSM_FatalError;
1324
1325 if (!fFTM.SetPrescaling(evt.GetInt()-1))
1326 T::Warn("SetPrescaling - Value out of range.");
1327
1328 return T::GetCurrentState();
1329 }
1330
1331 int SetTriggerSeq(const EventImp &evt)
1332 {
1333 if (!CheckEventSize(evt.GetSize(), "SetTriggerSeq", 6))
1334 return T::kSM_FatalError;
1335
1336 const uint16_t *data = evt.Ptr<uint16_t>();
1337
1338 if (!fFTM.SetTriggerSeq(data))
1339 T::Warn("SetTriggerSeq - Value out of range.");
1340
1341 return T::GetCurrentState();
1342 }
1343
1344 int SetDeadTime(const EventImp &evt)
1345 {
1346 if (!CheckEventSize(evt.GetSize(), "SetDeadTime", 4))
1347 return T::kSM_FatalError;
1348
1349 if (!fFTM.SetDeadTime(evt.GetInt()))
1350 T::Warn("SetDeadTime - Value out of range.");
1351
1352 return T::GetCurrentState();
1353 }
1354
1355 int SetTriggerMultiplicity(const EventImp &evt)
1356 {
1357 if (!CheckEventSize(evt.GetSize(), "SetTriggerMultiplicity", 2))
1358 return T::kSM_FatalError;
1359
1360 if (!fFTM.SetTriggerMultiplicity(evt.GetUShort()))
1361 T::Warn("SetTriggerMultiplicity - Value out of range.");
1362
1363 return T::GetCurrentState();
1364 }
1365
1366 int SetCalibMultiplicity(const EventImp &evt)
1367 {
1368 if (!CheckEventSize(evt.GetSize(), "SetCalibMultiplicity", 2))
1369 return T::kSM_FatalError;
1370
1371 if (!fFTM.SetCalibMultiplicity(evt.GetUShort()))
1372 T::Warn("SetCalibMultiplicity - Value out of range.");
1373
1374 return T::GetCurrentState();
1375 }
1376
1377 int SetTriggerWindow(const EventImp &evt)
1378 {
1379 if (!CheckEventSize(evt.GetSize(), "SetTriggerWindow", 2))
1380 return T::kSM_FatalError;
1381
1382 if (!fFTM.SetTriggerWindow(evt.GetUShort()))
1383 T::Warn("SetTriggerWindow - Value out of range.");
1384
1385 return T::GetCurrentState();
1386 }
1387
1388 int SetCalibWindow(const EventImp &evt)
1389 {
1390 if (!CheckEventSize(evt.GetSize(), "SetCalibWindow", 2))
1391 return T::kSM_FatalError;
1392
1393 if (!fFTM.SetCalibWindow(evt.GetUShort()))
1394 T::Warn("SetCalibWindow - Value out of range.");
1395
1396 return T::GetCurrentState();
1397 }
1398
1399 int SetClockRegister(const EventImp &evt)
1400 {
1401 if (!CheckEventSize(evt.GetSize(), "SetClockRegister", 8*8))
1402 return T::kSM_FatalError;
1403
1404 const uint64_t *reg = evt.Ptr<uint64_t>();
1405
1406 if (!fFTM.SetClockRegister(reg))
1407 T::Warn("SetClockRegister - Value out of range.");
1408
1409 return T::GetCurrentState();
1410 }
1411
1412 //map<uint32_t, uint32_t> fClockConditionerMap;
1413
1414 int SetClockFrequency(const EventImp &evt)
1415 {
1416 if (!CheckEventSize(evt.GetSize(), "SetClockFrequency", 4))
1417 return T::kSM_FatalError;
1418
1419 const uint32_t freq = evt.GetUInt();
1420
1421 //map<uint32_t,uint32_t>::const_iterator = fClockConditionerMap.find(freq);
1422
1423 static const uint64_t R0hi = 0x00030000;
1424 static const uint64_t R8 = 0x10000908;
1425 static const uint64_t R9 = 0xa0032a09;
1426 static const uint64_t R11 = 0x0082000b;
1427 static const uint64_t R13 = 0x020a000d;
1428 static const uint64_t R14hi = 0x08300000;
1429
1430 static const uint64_t freq0800[8] = { R0hi|0xfe00, 0x00010101, R8, R9, R11, R13, R14hi|0x800e, 0x18017b0f };
1431 static const uint64_t freq1000[8] = { R0hi|0xd000, 0x00010101, R8, R9, R11, R13, R14hi|0x400e, 0x1801450f };
1432 static const uint64_t freq2000[8] = { R0hi|0x8000, 0x00010101, R8, R9, R11, R13, R14hi|0x280e, 0x1400fa0f };
1433 static const uint64_t freq3000[8] = { R0hi|0x9000, 0x00030100, R8, R9, R11, R13, R14hi|0x400e, 0x0602a30f };
1434 static const uint64_t freq4000[8] = { R0hi|0x4000, 0x00010101, R8, R9, R11, R13, R14hi|0x280e, 0x1400fa0f };
1435 static const uint64_t freq5000[8] = { R0hi|0x8000, 0x00030200, R8, R9, R11, R13, R14hi|0x280e, 0x0802710f };
1436
1437 const uint64_t *reg = 0;
1438
1439 switch (freq)
1440 {
1441 case 800: reg = freq0800; break;
1442 case 1000: reg = freq1000; break;
1443 case 2000: reg = freq2000; break;
1444 case 3000: reg = freq3000; break;
1445 case 4000: reg = freq4000; break;
1446 case 5000: reg = freq5000; break;
1447 default:
1448 T::Warn("SetClockFrequency - Frequency not supported.");
1449 return T::GetCurrentState();
1450 }
1451
1452 if (!fFTM.SetClockRegister(reg))
1453 T::Warn("SetClockFrequency - Register values out of range.");
1454
1455 return T::GetCurrentState();
1456 }
1457
1458 int Enable(const EventImp &evt, FTM::StaticData::GeneralSettings type)
1459 {
1460 if (!CheckEventSize(evt.GetSize(), "Enable", 1))
1461 return T::kSM_FatalError;
1462
1463 fFTM.Enable(type, evt.GetBool());
1464
1465 return T::GetCurrentState();
1466 }
1467
1468 int EnablePixel(const EventImp &evt, bool b)
1469 {
1470 if (!CheckEventSize(evt.GetSize(), "EnablePixel", 2))
1471 return T::kSM_FatalError;
1472
1473 if (!fFTM.EnablePixel(evt.GetUShort(), b))
1474 T::Warn("EnablePixel - Value out of range.");
1475
1476 return T::GetCurrentState();
1477 }
1478
1479 int DisableAllPixelsExcept(const EventImp &evt)
1480 {
1481 if (!CheckEventSize(evt.GetSize(), "DisableAllPixelsExcept", 2))
1482 return T::kSM_FatalError;
1483
1484 if (!fFTM.DisableAllPixelsExcept(evt.GetUShort()))
1485 T::Warn("DisableAllPixelsExcept - Value out of range.");
1486
1487 return T::GetCurrentState();
1488 }
1489
1490 int DisableAllPatchesExcept(const EventImp &evt)
1491 {
1492 if (!CheckEventSize(evt.GetSize(), "DisableAllPatchesExcept", 2))
1493 return T::kSM_FatalError;
1494
1495 if (!fFTM.DisableAllPatchesExcept(evt.GetUShort()))
1496 T::Warn("DisableAllPatchesExcept - Value out of range.");
1497
1498 return T::GetCurrentState();
1499 }
1500
1501 int TogglePixel(const EventImp &evt)
1502 {
1503 if (!CheckEventSize(evt.GetSize(), "TogglePixel", 2))
1504 return T::kSM_FatalError;
1505
1506 if (!fFTM.TogglePixel(evt.GetUShort()))
1507 T::Warn("TogglePixel - Value out of range.");
1508
1509 return T::GetCurrentState();
1510 }
1511
1512 int ResetCrate(const EventImp &evt)
1513 {
1514 if (!CheckEventSize(evt.GetSize(), "ResetCrate", 2))
1515 return T::kSM_FatalError;
1516
1517 fFTM.CmdResetCrate(evt.GetUShort());
1518
1519 return T::GetCurrentState();
1520 }
1521
1522 int Disconnect()
1523 {
1524 // Close all connections
1525 fFTM.PostClose(false);
1526
1527 /*
1528 // Now wait until all connection have been closed and
1529 // all pending handlers have been processed
1530 poll();
1531 */
1532
1533 return T::GetCurrentState();
1534 }
1535
1536 int Reconnect(const EventImp &evt)
1537 {
1538 // Close all connections to supress the warning in SetEndpoint
1539 fFTM.PostClose(false);
1540
1541 // Now wait until all connection have been closed and
1542 // all pending handlers have been processed
1543 poll();
1544
1545 if (evt.GetBool())
1546 fFTM.SetEndpoint(evt.GetString());
1547
1548 // Now we can reopen the connection
1549 fFTM.PostClose(true);
1550
1551 return T::GetCurrentState();
1552 }
1553
1554 /*
1555 int Transition(const Event &evt)
1556 {
1557 switch (evt.GetTargetState())
1558 {
1559 case kStateDisconnected:
1560 case kStateConnected:
1561 }
1562
1563 return T::kSM_FatalError;
1564 }*/
1565
1566 int Execute()
1567 {
1568 // Dispatch (execute) at most one handler from the queue. In contrary
1569 // to run_one(), it doesn't wait until a handler is available
1570 // which can be dispatched, so poll_one() might return with 0
1571 // handlers dispatched. The handlers are always dispatched/executed
1572 // synchronously, i.e. within the call to poll_one()
1573 poll_one();
1574
1575 return fFTM.GetState();
1576 }
1577
1578public:
1579 StateMachineFTM(ostream &out=cout) :
1580 T(out, "FTM_CONTROL"), ba::io_service::work(static_cast<ba::io_service&>(*this)),
1581 fFTM(*this, *this)
1582 {
1583 // ba::io_service::work is a kind of keep_alive for the loop.
1584 // It prevents the io_service to go to stopped state, which
1585 // would prevent any consecutive calls to run()
1586 // or poll() to do nothing. reset() could also revoke to the
1587 // previous state but this might introduce some overhead of
1588 // deletion and creation of threads and more.
1589
1590 // State names
1591 AddStateName(kStateDisconnected, "Disconnected",
1592 "FTM board not connected via ethernet.");
1593
1594 AddStateName(kStateConnected, "Connected",
1595 "Ethernet connection to FTM established (no state received yet).");
1596
1597 AddStateName(kStateIdle, "Idle",
1598 "Ethernet connection to FTM established, FTM in idle state.");
1599
1600 AddStateName(kStateTakingData, "TakingData",
1601 "Ethernet connection to FTM established, FTM is in taking data state.");
1602
1603 // FTM Commands
1604 AddEvent("TOGGLE_LED", kStateIdle)
1605 (Wrapper(boost::bind(&ConnectionFTM::CmdToggleLed, &fFTM)))
1606 ("toggle led");
1607
1608 AddEvent("PING", kStateIdle)
1609 (Wrapper(boost::bind(&ConnectionFTM::CmdPing, &fFTM)))
1610 ("send ping");
1611
1612 AddEvent("REQUEST_DYNAMIC_DATA", kStateIdle)
1613 (Wrapper(boost::bind(&ConnectionFTM::CmdReqDynDat, &fFTM)))
1614 ("request transmission of dynamic data block");
1615
1616 AddEvent("REQUEST_STATIC_DATA", kStateIdle)
1617 (Wrapper(boost::bind(&ConnectionFTM::CmdReqStatDat, &fFTM)))
1618 ("request transmission of static data from FTM to memory");
1619
1620 AddEvent("GET_REGISTER", "I", kStateIdle)
1621 (boost::bind(&StateMachineFTM::GetRegister, this, _1))
1622 ("read register from address addr"
1623 "|addr[short]:Address of register");
1624
1625 AddEvent("SET_REGISTER", "I:2", kStateIdle)
1626 (boost::bind(&StateMachineFTM::SetRegister, this, _1))
1627 ("set register to value"
1628 "|addr[short]:Address of register"
1629 "|val[short]:Value to be set");
1630
1631 AddEvent("START_RUN", kStateIdle)
1632 (Wrapper(boost::bind(&ConnectionFTM::CmdStartRun, &fFTM)))
1633 ("start a run (start distributing triggers)");
1634
1635 AddEvent("STOP_RUN", kStateTakingData)
1636 (Wrapper(boost::bind(&ConnectionFTM::CmdStopRun, &fFTM)))
1637 ("stop a run (stop distributing triggers)");
1638
1639 AddEvent("TAKE_N_EVENTS", "I", kStateIdle)
1640 (boost::bind(&StateMachineFTM::TakeNevents, this, _1))
1641 ("take n events (distribute n triggers)|number[int]:Number of events to be taken");
1642
1643 AddEvent("DISABLE_REPORTS", "B", kStateIdle)
1644 (boost::bind(&StateMachineFTM::DisableReports, this, _1))
1645 ("disable sending rate reports"
1646 "|status[bool]:disable or enable that the FTM sends rate reports (yes/no)");
1647
1648 AddEvent("SET_THRESHOLD", "I:2", kStateIdle)
1649 (boost::bind(&StateMachineFTM::SetThreshold, this, _1))
1650 ("Set the comparator threshold"
1651 "|Patch[idx]:Index of the patch (0-159), -1 for all"
1652 "|Threshold[counts]:Threshold to be set in binary counts");
1653
1654 AddEvent("SET_PRESCALING", "I:1", kStateIdle)
1655 (boost::bind(&StateMachineFTM::SetPrescaling, this, _1))
1656 (""
1657 "|[]:");
1658
1659 AddEvent("ENABLE_FTU", "I:1;B:1", kStateIdle)
1660 (boost::bind(&StateMachineFTM::EnableFTU, this, _1))
1661 ("Enable or disable FTU"
1662 "|Board[idx]:Index of the board (0-39), -1 for all"
1663 "|Enable[bool]:Whether FTU should be enabled or disabled (yes/no)");
1664
1665 AddEvent("DISABLE_PIXEL", "S:1", kStateIdle)
1666 (boost::bind(&StateMachineFTM::EnablePixel, this, _1, false))
1667 ("(-1 or all)");
1668
1669 AddEvent("ENABLE_PIXEL", "S:1", kStateIdle)
1670 (boost::bind(&StateMachineFTM::EnablePixel, this, _1, true))
1671 ("(-1 or all)");
1672
1673 AddEvent("DISABLE_ALL_PIXELS_EXCEPT", "S:1", kStateIdle)
1674 (boost::bind(&StateMachineFTM::DisableAllPixelsExcept, this, _1))
1675 ("");
1676
1677 AddEvent("DISABLE_ALL_PATCHES_EXCEPT", "S:1", kStateIdle)
1678 (boost::bind(&StateMachineFTM::DisableAllPatchesExcept, this, _1))
1679 ("");
1680
1681 AddEvent("TOGGLE_PIXEL", "S:1", kStateIdle)
1682 (boost::bind(&StateMachineFTM::TogglePixel, this, _1))
1683 ("");
1684
1685 AddEvent("TOGGLE_FTU", "I:1", kStateIdle)
1686 (boost::bind(&StateMachineFTM::ToggleFTU, this, _1))
1687 ("Toggle status of FTU (this is mainly meant to be used in the GUI)"
1688 "|Board[idx]:Index of the board (0-39)");
1689
1690 AddEvent("SET_TRIGGER_INTERVAL", "I:1", kStateIdle)
1691 (boost::bind(&StateMachineFTM::SetTriggerInterval, this, _1))
1692 ("Sets the trigger interval which is the distance between two consecutive artificial triggers."
1693 "|interval[int]:The applied trigger interval is: interval*4ns+8ns");
1694
1695 AddEvent("SET_TRIGGER_DELAY", "I:1", kStateIdle)
1696 (boost::bind(&StateMachineFTM::SetTriggerDelay, this, _1))
1697 (""
1698 "|delay[int]:The applied trigger delay is: delay*4ns+8ns");
1699
1700 AddEvent("SET_TIME_MARKER_DELAY", "I:1", kStateIdle)
1701 (boost::bind(&StateMachineFTM::SetTimeMarkerDelay, this, _1))
1702 (""
1703 "|delay[int]:The applied time marker delay is: delay*4ns+8ns");
1704
1705 AddEvent("SET_DEAD_TIME", "I:1", kStateIdle)
1706 (boost::bind(&StateMachineFTM::SetDeadTime, this, _1))
1707 (""
1708 "|dead_time[int]:The applied dead time is: dead_time*4ns+8ns");
1709
1710 AddEvent("ENABLE_TRIGGER", "B:1", kStateIdle)
1711 (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kTrigger))
1712 ("Switch on the physics trigger"
1713 "|Enable[bool]:Enable physics trigger (yes/no)");
1714
1715 // FIXME: Switch on/off depending on sequence
1716 AddEvent("ENABLE_EXT1", "B:1", kStateIdle)
1717 (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kExt1))
1718 ("Switch on the triggers through the first external line"
1719 "|Enable[bool]:Enable ext1 trigger (yes/no)");
1720
1721 // FIXME: Switch on/off depending on sequence
1722 AddEvent("ENABLE_EXT2", "B:1", kStateIdle)
1723 (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kExt2))
1724 ("Switch on the triggers through the second external line"
1725 "|Enable[bool]:Enable ext2 trigger (yes/no)");
1726
1727 AddEvent("ENABLE_VETO", "B:1", kStateIdle)
1728 (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kVeto))
1729 ("Enable veto line"
1730 "|Enable[bool]:Enable veto (yes/no)");
1731
1732 AddEvent("ENABLE_CLOCK_CONDITIONER", "B:1", kStateIdle)
1733 (boost::bind(&StateMachineFTM::Enable, this, _1, FTM::StaticData::kClockConditioner))
1734 ("Enable clock conidtioner output in favor of time marker output"
1735 "|Enable[bool]:Enable clock conditioner (yes/no)");
1736
1737 AddEvent("SET_TRIGGER_SEQUENCE", "S:3", kStateIdle)
1738 (boost::bind(&StateMachineFTM::SetTriggerSeq, this, _1))
1739 ("Setup the sequence of artificial triggers produced by the FTM"
1740 "|Ped[short]:number of pedestal triggers in a row"
1741 "|LPext[short]:number of triggers of the external light pulser"
1742 "|LPint[short]:number of triggers of the internal light pulser");
1743
1744 AddEvent("SET_TRIGGER_MULTIPLICITY", "S:1", kStateIdle)
1745 (boost::bind(&StateMachineFTM::SetTriggerMultiplicity, this, _1))
1746 ("Setup the Multiplicity condition for physcis triggers"
1747 "|N[int]:Number of requirered coincident triggers from sum-patches (1-40)");
1748
1749 AddEvent("SET_TRIGGER_WINDOW", "S:1", kStateIdle)
1750 (boost::bind(&StateMachineFTM::SetTriggerWindow, this, _1))
1751 ("");
1752
1753 AddEvent("SET_CALIBRATION_MULTIPLICITY", "S:1", kStateIdle)
1754 (boost::bind(&StateMachineFTM::SetCalibMultiplicity, this, _1))
1755 ("Setup the Multiplicity condition for artificial (calibration) triggers"
1756 "|N[int]:Number of requirered coincident triggers from sum-patches (1-40)");
1757
1758 AddEvent("SET_CALIBRATION_WINDOW", "S:1", kStateIdle)
1759 (boost::bind(&StateMachineFTM::SetCalibWindow, this, _1))
1760 ("");
1761
1762 AddEvent("SET_CLOCK_FREQUENCY", "I:1", kStateIdle)
1763 (boost::bind(&StateMachineFTM::SetClockFrequency, this, _1))
1764 ("");
1765
1766 AddEvent("SET_CLOCK_REGISTER", "X:8", kStateIdle)
1767 (boost::bind(&StateMachineFTM::SetClockRegister, this, _1))
1768 ("");
1769
1770
1771
1772 AddEvent("RESET_CRATE", "S:1", kStateIdle)
1773 (boost::bind(&StateMachineFTM::ResetCrate, this, _1))
1774 ("Reset one of the crates 0-3"
1775 "|crate[short]:Crate number to be reseted (0-3)");
1776
1777 AddEvent("RESET_CAMERA", kStateIdle)
1778 (Wrapper(boost::bind(&ConnectionFTM::CmdResetCamera, &fFTM)))
1779 ("Reset all crates. The commands are sent in the order 0,1,2,3");
1780
1781
1782 // Load/save static data block
1783 T::AddEvent("SAVE", "C", kStateIdle)
1784 (boost::bind(&StateMachineFTM::SaveStaticData, this, _1))
1785 ("Saves the static data (FTM configuration) from memory to a file"
1786 "|filename[string]:Filename (can include a path), .bin is automatically added");
1787
1788 T::AddEvent("LOAD", "C", kStateIdle)
1789 (boost::bind(&StateMachineFTM::LoadStaticData, this, _1))
1790 ("Loads the static data (FTM configuration) from a file into memory and sends it to the FTM"
1791 "|filename[string]:Filename (can include a path), .bin is automatically added");
1792
1793
1794
1795 // Verbosity commands
1796 T::AddEvent("SET_VERBOSE", "B")
1797 (boost::bind(&StateMachineFTM::SetVerbosity, this, _1))
1798 ("set verbosity state"
1799 "|verbosity[bool]:disable or enable verbosity for received data (yes/no), except dynamic data");
1800
1801 T::AddEvent("SET_HEX_OUTPUT", "B")
1802 (boost::bind(&StateMachineFTM::SetHexOutput, this, _1))
1803 ("enable or disable hex output for received data"
1804 "|hexout[bool]:disable or enable hex output for received data (yes/no)");
1805
1806 T::AddEvent("SET_DYNAMIC_OUTPUT", "B")
1807 (boost::bind(&StateMachineFTM::SetDynamicOut, this, _1))
1808 ("enable or disable output for received dynamic data (data is still broadcasted via Dim)"
1809 "|dynout[bool]:disable or enable output for dynamic data (yes/no)");
1810
1811
1812 // Conenction commands
1813 AddEvent("DISCONNECT", kStateConnected, kStateIdle)
1814 (boost::bind(&StateMachineFTM::Disconnect, this))
1815 ("disconnect from ethernet");
1816
1817 AddEvent("RECONNECT", "O", kStateDisconnected, kStateConnected, kStateIdle)
1818 (boost::bind(&StateMachineFTM::Reconnect, this, _1))
1819 ("(Re)connect ethernet connection to FTM, a new address can be given"
1820 "|[host][string]:new ethernet address in the form <host:port>");
1821
1822 fFTM.StartConnect();
1823 }
1824
1825 void SetEndpoint(const string &url)
1826 {
1827 fFTM.SetEndpoint(url);
1828 }
1829
1830 bool SetConfiguration(const Configuration &conf)
1831 {
1832 SetEndpoint(conf.Get<string>("addr"));
1833
1834 fFTM.SetVerbose(!conf.Get<bool>("quiet"));
1835 fFTM.SetHexOutput(conf.Get<bool>("hex-out"));
1836 fFTM.SetDynamicOut(conf.Get<bool>("dynamic-out"));
1837
1838// fFTM.SetDefaultSetup(conf.Get<string>("default-setup"));
1839
1840 return true;
1841 }
1842};
1843
1844// ------------------------------------------------------------------------
1845
1846void RunThread(StateMachineImp *io_service)
1847{
1848 // This is necessary so that the StateMachien Thread can signal the
1849 // Readline to exit
1850 io_service->Run();
1851 Readline::Stop();
1852}
1853
1854/*
1855template<class S, class T>
1856int RunDim(Configuration &conf)
1857{
1858 WindowLog wout;
1859
1860 ReadlineColor::PrintBootMsg(wout, conf.GetName(), false);
1861
1862 if (conf.Has("log"))
1863 if (!wout.OpenLogFile(conf.Get<string>("log")))
1864 wout << kRed << "ERROR - Couldn't open log-file " << conf.Get<string>("log") << ": " << strerror(errno) << endl;
1865
1866 // Start io_service.Run to use the StateMachineImp::Run() loop
1867 // Start io_service.run to only use the commandHandler command detaching
1868 StateMachineFTM<S, T> io_service(wout);
1869 if (!io_service.SetConfiguration(conf))
1870 return -1;
1871
1872 io_service.Run();
1873
1874 return 0;
1875}
1876*/
1877
1878template<class T, class S, class R>
1879int RunShell(Configuration &conf)
1880{
1881 static T shell(conf.GetName().c_str(), conf.Get<int>("console")!=1);
1882
1883 WindowLog &win = shell.GetStreamIn();
1884 WindowLog &wout = shell.GetStreamOut();
1885
1886 if (conf.Has("log"))
1887 if (!wout.OpenLogFile(conf.Get<string>("log")))
1888 win << kRed << "ERROR - Couldn't open log-file " << conf.Get<string>("log") << ": " << strerror(errno) << endl;
1889
1890 StateMachineFTM<S, R> io_service(wout);
1891 if (!io_service.SetConfiguration(conf))
1892 return -1;
1893
1894 shell.SetReceiver(io_service);
1895
1896 boost::thread t(boost::bind(RunThread, &io_service));
1897 // boost::thread t(boost::bind(&StateMachineFTM<S>::Run, &io_service));
1898
1899 if (conf.Has("exec"))
1900 {
1901 const vector<string> v = conf.Get<vector<string>>("exec");
1902 for (vector<string>::const_iterator it=v.begin(); it!=v.end(); it++)
1903 shell.Execute(*it);
1904 }
1905
1906 shell.Run(); // Run the shell
1907 io_service.Stop(); // Signal Loop-thread to stop
1908 // io_service.Close(); // Obsolete, done by the destructor
1909
1910 // Wait until the StateMachine has finished its thread
1911 // before returning and destroying the dim objects which might
1912 // still be in use.
1913 t.join();
1914
1915 return 0;
1916}
1917
1918void SetupConfiguration(Configuration &conf)
1919{
1920 const string n = conf.GetName()+".log";
1921
1922 po::options_description config("Program options");
1923 config.add_options()
1924 ("dns", var<string>("localhost"), "Dim nameserver host name (Overwites DIM_DNS_NODE environment variable)")
1925 ("log,l", var<string>(n), "Write log-file")
1926 ("no-dim,d", po_bool(), "Disable dim services")
1927 ("console,c", var<int>(), "Use console (0=shell, 1=simple buffered, X=simple unbuffered)")
1928 ("exec,e", vars<string>(), "Execute one or more scrips at startup")
1929 ;
1930
1931 po::options_description control("FTM control options");
1932 control.add_options()
1933 ("addr,a", var<string>("localhost:5000"), "Network address of FTM")
1934 ("quiet,q", po_bool(), "Disable printing contents of all received messages (except dynamic data) in clear text.")
1935 ("hex-out", po_bool(), "Enable printing contents of all printed messages also as hex data.")
1936 ("dynamic-out", po_bool(), "Enable printing received dynamic data.")
1937// ("default-setup", var<string>(), "Binary file with static data loaded whenever a connection to the FTM was established.")
1938 ;
1939
1940 conf.AddEnv("dns", "DIM_DNS_NODE");
1941
1942 conf.AddOptions(config);
1943 conf.AddOptions(control);
1944}
1945
1946/*
1947 Extract usage clause(s) [if any] for SYNOPSIS.
1948 Translators: "Usage" and "or" here are patterns (regular expressions) which
1949 are used to match the usage synopsis in program output. An example from cp
1950 (GNU coreutils) which contains both strings:
1951 Usage: cp [OPTION]... [-T] SOURCE DEST
1952 or: cp [OPTION]... SOURCE... DIRECTORY
1953 or: cp [OPTION]... -t DIRECTORY SOURCE...
1954 */
1955void PrintUsage()
1956{
1957 cout <<
1958 "The ftmctrl controls the FTM (FACT Trigger Master) board.\n"
1959 "\n"
1960 "The default is that the program is started without user intercation. "
1961 "All actions are supposed to arrive as DimCommands. Using the -c "
1962 "option, a local shell can be initialized. With h or help a short "
1963 "help message about the usuage can be brought to the screen.\n"
1964 "\n"
1965 "Usage: ftmctrl [-c type] [OPTIONS]\n"
1966 " or: ftmctrl [OPTIONS]\n";
1967 cout << endl;
1968}
1969
1970void PrintHelp()
1971{
1972 /* Additional help text which is printed after the configuration
1973 options goes here */
1974
1975 /*
1976 cout << "bla bla bla" << endl << endl;
1977 cout << endl;
1978 cout << "Environment:" << endl;
1979 cout << "environment" << endl;
1980 cout << endl;
1981 cout << "Examples:" << endl;
1982 cout << "test exam" << endl;
1983 cout << endl;
1984 cout << "Files:" << endl;
1985 cout << "files" << endl;
1986 cout << endl;
1987 */
1988}
1989
1990int main(int argc, const char* argv[])
1991{
1992 Configuration conf(argv[0]);
1993 conf.SetPrintUsage(PrintUsage);
1994 SetupConfiguration(conf);
1995
1996 po::variables_map vm;
1997 try
1998 {
1999 vm = conf.Parse(argc, argv);
2000 }
2001#if BOOST_VERSION > 104000
2002 catch (po::multiple_occurrences &e)
2003 {
2004 cerr << "Program options invalid due to: " << e.what() << " of '" << e.get_option_name() << "'." << endl;
2005 return -1;
2006 }
2007#endif
2008 catch (exception& e)
2009 {
2010 cerr << "Program options invalid due to: " << e.what() << endl;
2011 return -1;
2012 }
2013
2014 if (conf.HasVersion() || conf.HasPrint())
2015 return -1;
2016
2017 if (conf.HasHelp())
2018 {
2019 PrintHelp();
2020 return -1;
2021 }
2022
2023 Dim::Setup(conf.Get<string>("dns"));
2024
2025 //try
2026 {
2027 // No console access at all
2028 if (!conf.Has("console"))
2029 {
2030 if (conf.Get<bool>("no-dim"))
2031 return RunShell<LocalStream, StateMachine, ConnectionFTM>(conf);
2032 else
2033 return RunShell<LocalStream, StateMachineDim, ConnectionDimFTM>(conf);
2034 }
2035 // Cosole access w/ and w/o Dim
2036 if (conf.Get<bool>("no-dim"))
2037 {
2038 if (conf.Get<int>("console")==0)
2039 return RunShell<LocalShell, StateMachine, ConnectionFTM>(conf);
2040 else
2041 return RunShell<LocalConsole, StateMachine, ConnectionFTM>(conf);
2042 }
2043 else
2044 {
2045 if (conf.Get<int>("console")==0)
2046 return RunShell<LocalShell, StateMachineDim, ConnectionDimFTM>(conf);
2047 else
2048 return RunShell<LocalConsole, StateMachineDim, ConnectionDimFTM>(conf);
2049 }
2050 }
2051 /*catch (std::exception& e)
2052 {
2053 cerr << "Exception: " << e.what() << endl;
2054 return -1;
2055 }*/
2056
2057 return 0;
2058}
Note: See TracBrowser for help on using the repository browser.