Speed up the creation pof the CalPads (Marian)
[u/mrichter/AliRoot.git] / HLT / RCU / AliHLTAltroChannelSelectorComponent.cxx
CommitLineData
3e6ec852 1// $Id$
2
13398559 3//**************************************************************************
4//* This file is property of and copyright by the ALICE HLT Project *
5//* ALICE Experiment at CERN, All rights reserved. *
6//* *
7//* Primary Authors: Matthias Richter <Matthias.Richter@ift.uib.no> *
8//* for The ALICE HLT Project. *
9//* *
10//* Permission to use, copy, modify and distribute this software and its *
11//* documentation strictly for non-commercial purposes is hereby granted *
12//* without fee, provided that the above copyright notice appears in all *
13//* copies and that both the copyright notice and this permission notice *
14//* appear in the supporting documentation. The authors make no claims *
15//* about the suitability of this software for any purpose. It is *
16//* provided "as is" without express or implied warranty. *
17//**************************************************************************
3e6ec852 18
19/** @file AliHLTAltroChannelSelectorComponent.cxx
20 @author Matthias Richter
21 @date
13398559 22 @brief A filter/selective readout component for Altro data.
23*/
3e6ec852 24
25// see header file for class documentation
26// or
27// refer to README to build package
28// or
29// visit http://web.ift.uib.no/~kjeks/doc/alice-hlt
30
e1440dab 31#include <cassert>
3e6ec852 32#include "AliHLTAltroChannelSelectorComponent.h"
4ca5858d 33#include "AliAltroDecoder.h"
34#include "AliAltroData.h"
3e6ec852 35
36/** ROOT macro for the implementation of ROOT specific class methods */
37ClassImp(AliHLTAltroChannelSelectorComponent)
38
39AliHLTAltroChannelSelectorComponent::AliHLTAltroChannelSelectorComponent()
40 :
e1440dab 41 AliHLTProcessor(),
4ca5858d 42 fSkipCorrupted(false),
43 fTalkative(false)
3e6ec852 44{
45 // see header file for class documentation
46 // or
47 // refer to README to build package
48 // or
49 // visit http://web.ift.uib.no/~kjeks/doc/alice-hlt
50}
51
52AliHLTAltroChannelSelectorComponent::~AliHLTAltroChannelSelectorComponent()
53{
54 // see header file for class documentation
55}
56
57const char* AliHLTAltroChannelSelectorComponent::GetComponentID()
58{
59 // see header file for class documentation
60 return "AltroChannelSelector";
61}
62
63void AliHLTAltroChannelSelectorComponent::GetInputDataTypes(AliHLTComponentDataTypeList& list)
64{
65 // see header file for class documentation
66 list.clear();
67 list.push_back(kAliHLTDataTypeDDLRaw|kAliHLTDataOriginTPC);
64defa03 68 list.push_back(kAliHLTDataTypeHwAddr16);
3e6ec852 69}
70
71AliHLTComponentDataType AliHLTAltroChannelSelectorComponent::GetOutputDataType()
72{
73 // see header file for class documentation
74 return kAliHLTDataTypeDDLRaw|kAliHLTDataOriginTPC;
75}
76
77void AliHLTAltroChannelSelectorComponent::GetOutputDataSize(unsigned long& constBase, double& inputMultiplier)
78{
79 // see header file for class documentation
80 constBase=0;
81 inputMultiplier=1.0;
82}
83
84AliHLTComponent* AliHLTAltroChannelSelectorComponent::Spawn()
85{
86 // see header file for class documentation
87 return new AliHLTAltroChannelSelectorComponent;
88}
89
90int AliHLTAltroChannelSelectorComponent::DoInit(int argc, const char** argv)
91{
92 // see header file for class documentation
93 int iResult=0;
94 TString argument="";
e1440dab 95 bool bMissingParam=0;
3e6ec852 96 for (int i=0; i<argc && iResult>=0; i++) {
97 argument=argv[i];
98 if (argument.IsNull()) continue;
99
4ca5858d 100 // -skip-corrupted
101 if (argument.CompareTo("-skip-corrupted")==0) {
102 fSkipCorrupted=true;
103
104 // -talkative
105 } else if (argument.CompareTo("-talkative")==0) {
106 fTalkative=true;
3e6ec852 107 } else {
4ca5858d 108 HLTError("unknown argument %s", argument.Data());
3e6ec852 109 iResult=-EINVAL;
110 }
111 }
112
e1440dab 113 if (bMissingParam) {
114 HLTError("missing parameter for argument %s", argument.Data());
115 iResult=-EINVAL;
116 }
117
3e6ec852 118 return iResult;
119}
120
121int AliHLTAltroChannelSelectorComponent::DoDeinit()
122{
123 // see header file for class documentation
124 return 0;
125}
126
127int AliHLTAltroChannelSelectorComponent::DoEvent(const AliHLTComponentEventData& evtData,
128 const AliHLTComponentBlockData* blocks,
129 AliHLTComponentTriggerData& /*trigData*/,
130 AliHLTUInt8_t* outputPtr,
131 AliHLTUInt32_t& size,
132 AliHLTComponentBlockDataList& outputBlocks )
133{
134 // see header file for class documentation
135 int iResult=0;
4ca5858d 136 const int cdhSize=32;
3e6ec852 137
8d682af4 138 if (!IsDataEvent()) {
139 size=0;
140 return 0;
141 }
142
e1440dab 143 // process the DLL input
144 int blockno=0;
1d337632 145 const AliHLTComponentBlockData* pDesc=NULL;
146
4ca5858d 147 AliAltroDecoder* decoder=NULL;
148 for (pDesc=GetFirstInputBlock(kAliHLTDataTypeDDLRaw); pDesc!=NULL; pDesc=GetNextInputBlock(), blockno++) {
149 iResult=0;
359ba057 150 if (pDesc->fSize<=32) {
151 continue;
152 }
e1440dab 153
154 // search for the active pad information
64defa03 155 AliHLTUInt16_t* pActiveHwAddressArray=NULL;
156 int iArraySize=0;
e1440dab 157 for (int i=0; i<(int)evtData.fBlockCnt; i++ ) {
64defa03 158 // search for selection data of hw address type
4ca5858d 159 // which matches the data specification of the block
160 if (blocks[i].fDataType==kAliHLTDataTypeHwAddr16 && blocks[i].fSpecification==pDesc->fSpecification) {
161 pActiveHwAddressArray=reinterpret_cast<AliHLTUInt16_t*>(blocks[i].fPtr);
162 iArraySize=blocks[i].fSize/sizeof(AliHLTUInt16_t);
163 break;
e1440dab 164 }
165 }
4ca5858d 166 if (pActiveHwAddressArray==NULL) {
167 HLTWarning("no block of type %s for specification 0x%08x available, data block unchanged",
64defa03 168 DataType2Text(kAliHLTDataTypeHwAddr16).c_str(),
1d337632 169 pDesc->fSpecification);
4ca5858d 170 iResult=-EFAULT;
171 }
172
173 if (decoder) delete decoder;
174 decoder=new AliAltroDecoder;
175 if (decoder->SetMemory(reinterpret_cast<UChar_t*>(pDesc->fPtr), pDesc->fSize)<0) {
176 HLTWarning("corrupted data block: initialization of decoder failed for block: %s specification %#x size %d",
177 DataType2Text(pDesc->fDataType).c_str(), pDesc->fSpecification, pDesc->fSize);
178 iResult=-EFAULT;
179 } else {
180 if (decoder->Decode()) {
181 HLTDebug("init decoder %p size %d", pDesc->fPtr,pDesc->fSize);
182 } else {
183 HLTWarning("corrupted data block: decoding failed for raw data block: %s specification %#x size %d",
184 DataType2Text(pDesc->fDataType).c_str(), pDesc->fSpecification, pDesc->fSize);
185 iResult=-EFAULT;
186 }
187 }
188
8d682af4 189 unsigned int rcuTrailerLength=0;
190 if (iResult>=0 &&
191 ((rcuTrailerLength=decoder->GetRCUTrailerSize())==0 ||
192 rcuTrailerLength>pDesc->fSize-cdhSize)) {
193 if (rcuTrailerLength>0) {
194 HLTWarning("corrupted data block: RCU trailer length exceeds buffer size");
195 } else {
196 HLTWarning("corrupted data block: RCU trailer of zero length");
197 }
4ca5858d 198 iResult=-EFAULT;
199 }
200
201 if (iResult<0) {
8d682af4 202 // TODO: here the trigger has to come into play. It is up to
203 // policy if a corrupted data block should be kept (original
204 // DDL) or discarded. In any case, the block is not going to
205 // be part of HLTOUT
206 HLTWarning("skipping corrupted data block for event %lu, data block %s 0x%08x", evtData.fEventID,
207 DataType2Text(pDesc->fDataType).c_str(), pDesc->fSpecification);
3dcae0cc 208 iResult=0;
e1440dab 209 continue;
210 }
211
1d337632 212 int iSelected=0;
213 int iTotal=0;
4ca5858d 214 int iCorrupted=0;
e1440dab 215 AliHLTUInt32_t iOutputSize=0;
4ca5858d 216 AliHLTUInt32_t iNofAltro40=0;
e1440dab 217 AliHLTUInt32_t iCapacity=size;
4ca5858d 218 AliAltroData channel;
8d682af4 219
220 // first add the RCU trailer
221 AliHLTUInt8_t* pSrc=reinterpret_cast<AliHLTUInt8_t*>(pDesc->fPtr);
222 pSrc+=pDesc->fSize-rcuTrailerLength;
223 if ((iResult=CopyBlockToEnd(outputPtr, iCapacity, iOutputSize, pSrc, rcuTrailerLength))>=0) {
224 assert(iResult==(int)rcuTrailerLength);
225 iOutputSize+=rcuTrailerLength;
226 } else {
227 HLTError("failed to write RCU trailer of length %d for block %d, too little space in output buffer?", rcuTrailerLength, blockno);
228 iResult=-ENOSPC;
229 break;
230 }
231
4ca5858d 232 while (decoder->NextChannel(&channel) && iResult>=0) {
1d337632 233 iTotal++;
64defa03 234
4ca5858d 235 int hwAddress=channel.GetHadd();
e1440dab 236 int active=0;
4ca5858d 237 for (active=0; active<iArraySize; active++) {
238 if (pActiveHwAddressArray[active]==(AliHLTUInt16_t)hwAddress) {
239 break;
e1440dab 240 }
241 }
64defa03 242 if (active>=iArraySize) {
4ca5858d 243 HLTDebug("ALTRO block %#x (%d) discarded (inactive)", hwAddress, hwAddress);
e1440dab 244 continue;
245 }
246
4ca5858d 247 // no of 10 bit words is without the fill words to fill complete 40 bit words
248 // in addition, align to complete 40 bit words (the '+3')
249 // also, the 5 bytes of the Altro trailer must be added to get the full size
250 int channelSize=((channel.GetDataSize()+3)/4)*5;
8d682af4 251 if (channelSize==0) {
252 if (fTalkative) HLTWarning("skipping zero length channel (hw address %d)", hwAddress);
253 iCorrupted++;
254 continue;
255 }
4ca5858d 256 channelSize+=5;
257 HLTDebug("ALTRO block hwAddress 0x%08x (%d) selected (active), size %d", hwAddress, hwAddress, channelSize);
4ca5858d 258
259 if ((iResult=decoder->CopyBackward(outputPtr, iCapacity-iOutputSize))>=0) {
260 if (channelSize == iResult) {
261 if (channelSize%5 == 0) {
262 iNofAltro40+=channelSize/5;
263 iOutputSize+=channelSize;
e1440dab 264 } else {
8d682af4 265 if (fTalkative) HLTWarning("corrupted ALTRO channel: incomplete 40 bit word (channel hw address %d)", hwAddress);
4ca5858d 266 iCorrupted++;
267 continue;
e1440dab 268 }
4ca5858d 269 } else {
8d682af4 270 if (fTalkative) HLTWarning("internal error: failed to copy full channel: %d out of %d bytes (hw address %d)", iResult, channelSize, hwAddress);
4ca5858d 271 iCorrupted++;
272 continue;
e1440dab 273 }
e1440dab 274 } else {
8d682af4 275 if (fTalkative) HLTError("failed to write ALTRO channel of length %d for block %d (hw address %d)", channelSize, blockno, hwAddress);
4ca5858d 276 // corrupted channel, but keep going
277 iCorrupted++;
278 iResult=0;
279 continue;
e1440dab 280 }
4ca5858d 281 iSelected++;
e1440dab 282 }
283 if (iResult>=0) {
284 // write the common data header
1d337632 285 if ((iResult=CopyBlockToEnd(outputPtr, iCapacity, iOutputSize, pDesc->fPtr, cdhSize))>=0) {
e1440dab 286 assert(iResult==cdhSize);
287 iOutputSize+=cdhSize;
288
289 // set new length of the data block
4ca5858d 290 AliHLTUInt32_t* pCdhSize=reinterpret_cast<AliHLTUInt32_t*>(outputPtr+iCapacity-iOutputSize);
e1440dab 291 *pCdhSize=iOutputSize;
292
4ca5858d 293 // set number of Altro words
294 AliHLTUInt32_t* pNofAltro40=reinterpret_cast<AliHLTUInt32_t*>(outputPtr+iCapacity-rcuTrailerLength);
295 *pNofAltro40=iNofAltro40;
296
e1440dab 297 // insert block descriptor
298 AliHLTComponentBlockData bd;
299 FillBlockData(bd);
300 bd.fOffset=iCapacity-iOutputSize;
301 bd.fSize=iOutputSize;
1d337632 302 bd.fDataType=pDesc->fDataType;
303 bd.fSpecification=pDesc->fSpecification;
e1440dab 304 outputBlocks.push_back(bd);
305 iCapacity-=iOutputSize;
306 } else {
307 HLTError("failed to write CDH of length %d for block %d", cdhSize, blockno);
308 break;
309 }
310 }
359ba057 311 if (fTalkative) HLTImportant("data block %d (0x%08x): selected %d out of %d ALTRO channel(s), %d corrupted channels skipped", blockno, pDesc->fSpecification, iSelected, iTotal, iCorrupted);
3e6ec852 312 }
4ca5858d 313 if (decoder) delete decoder;
3e6ec852 314
e1440dab 315 if (iResult<0) {
316 outputBlocks.clear();
3e6ec852 317 }
318
359ba057 319 // all data blocks need to be moved to the beginning of the
320 // buffer because PubSub is not able to handle data blocks entirely
321 // at the end of the buffer. The problem is that the component always
322 // indicates to use the full size of the buffer
323 if (outputBlocks.size()>0) {
324 int offset=outputBlocks.back().fOffset;
325 size-=offset;
326 memmove(outputPtr, outputPtr+offset, size);
327 for (AliHLTComponentBlockDataList::iterator block=outputBlocks.begin();
328 block!=outputBlocks.end();
329 block++) {
330 block->fOffset-=offset;
331 }
332 }
e1440dab 333
334 return iResult;
335}
336
337int AliHLTAltroChannelSelectorComponent::CopyBlockToEnd(AliHLTUInt8_t* pTgt, unsigned capacity, unsigned position, void* pSrc, unsigned size)
338{
339 int iResult=0;
340 if (pTgt==NULL || pSrc==NULL) return -EINVAL;
341 if (capacity-position<size) return -ENOSPC;
342
343 memcpy(pTgt+(capacity-position-size), pSrc, size);
344 iResult=size;
345
3e6ec852 346 return iResult;
347}