|
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
|
#include <memory>
#include "EventFilter/EcalDigiToRaw/interface/SRBlockFormatter.h"
using namespace std;
SRBlockFormatter::SRBlockFormatter(Config const& iC, Params const& iP) : BlockFormatter(iC, iP) {}
void SRBlockFormatter::DigiToRaw(int dccid, int dcc_channel, int flag, FEDRawData& rawdata) {
if (debug_)
cout << "enter in SRBlockFormatter::DigiToRaw " << endl;
if (debug_)
print(rawdata);
auto const bx = bx_;
auto const lv1 = lv1_;
int Nrows_SRP = 5; // Both for Barrel and EndCap (without the header row)
int SRid = (dccid - 1) / 3 + 1;
// int Number_SRP_Flags = 68;
int SRP_index;
int icode = 1000 * dccid + SRid;
if (debug_)
cout << "size of header_ map is " << header_.size() << endl;
std::map<int, int>::const_iterator it_header = header_.find(icode);
if (it_header != header_.end()) {
SRP_index = rawdata.size() / 8 - Nrows_SRP;
if (debug_)
cout << "This SRid is already there." << endl;
} else {
if (debug_)
cout << "New SR Block added on Raw data " << endl;
header_[icode] = 1;
SRP_index = rawdata.size() / 8;
rawdata.resize(rawdata.size() + 8 + 8 * Nrows_SRP); // 1 line for SRP header, 5 lines of data
unsigned char* ppData = rawdata.data();
ppData[8 * SRP_index] = SRid & 0xFF;
ppData[8 * SRP_index + 2] = bx & 0xFF;
ppData[8 * SRP_index + 3] = (bx & 0xF00) >> 8;
ppData[8 * SRP_index + 3] |= 0x80;
ppData[8 * SRP_index + 4] = lv1 & 0xFF;
ppData[8 * SRP_index + 5] = (lv1 & 0xF00) >> 8;
// ppData[8*SRP_index+6] = Number_SRP_Flags;
ppData[8 * SRP_index + 6] = 0;
ppData[8 * SRP_index + 7] = 0x80;
SRP_index++;
if (debug_)
cout << "Added headers and empty lines : " << endl;
if (debug_)
print(rawdata);
// -- put the B011 and B100 already, since for Endcap there can be empty
// -- lines in the TCC and the SRP blocks
unsigned char* Data = rawdata.data();
for (int iline = SRP_index; iline < SRP_index + Nrows_SRP; iline++) {
Data[8 * iline + 7] |= 0x80;
Data[8 * iline + 3] |= 0x80;
}
}
unsigned char* pData = rawdata.data();
// -- Now the TCC Block :
int nflags = pData[8 * (SRP_index - 1) + 6] & 0x7F;
nflags++;
pData[8 * (SRP_index - 1) + 6] = nflags & 0x7F;
int jTT = (dcc_channel - 1);
int irow = jTT / 16;
int ival = jTT % 4;
int kval = (jTT % 16) / 4;
SRP_index += irow;
if (debug_)
cout << "Now add SC to SRBlock " << dec << dcc_channel << " irow ival " << dec << irow << " " << dec << ival
<< endl;
if (debug_)
cout << "new data will be added at line " << dec << SRP_index << endl;
unsigned char* buff = &pData[8 * SRP_index];
Word64* pw = reinterpret_cast<Word64*>(const_cast<unsigned char*>(buff));
int nbits = kval * 16 + 3 * ival;
Word64 wflag = (Word64)((short int)flag & 0x7) << nbits;
*pw |= wflag;
Word64 b1 = (Word64)((Word64)0x80 << 56);
*pw |= b1;
Word64 b2 = (Word64)((Word64)0x80 << 24);
*pw |= b2;
if (debug_)
print(rawdata);
}
|