00001 #include "otsdaq-components/DAQHardware/OtsUDPHardware.h"
00002 #include "otsdaq-core/MessageFacility/MessageFacility.h"
00003 #include "otsdaq-core/Macros/CoutMacros.h"
00004 #include <iostream>
00005 #include <iomanip>
00006
00007 using namespace ots;
00008
00009
00010
00011
00012 OtsUDPHardware::OtsUDPHardware (std::string boardIPAddress, unsigned int boardPort,
00013 unsigned int version, bool verbose)
00014 :
00015 FrontEndHardwareBase (version)
00016 , OtsUDPBoard_ (boardIPAddress, boardPort)
00017 , verbose_ (verbose)
00018 {
00019 Socket::initialize();
00020
00021
00022
00023
00024
00025
00026
00027
00028 }
00029
00030
00031 OtsUDPHardware::OtsUDPHardware (std::string hostIPAddress, unsigned int hostPort,
00032 std::string OtsUDPHardwareIPAddress, unsigned int OtsUDPHardwarePort,
00033 unsigned int version, bool verbose)
00034 : Socket (hostIPAddress, hostPort)
00035 , FrontEndHardwareBase (version)
00036 , OtsUDPBoard_ (OtsUDPHardwareIPAddress, OtsUDPHardwarePort)
00037 , verbose_ (verbose)
00038 {
00039 Socket::initialize();
00040
00041 __COUT__ << "Socket for hardware is initialized at IP:Port " <<
00042 OtsUDPBoard_.getIPAddress() << ":" << OtsUDPBoard_.getPort() << __E__;
00043
00044
00045
00046
00047
00048
00049
00050 }
00051
00052
00053 OtsUDPHardware::~OtsUDPHardware(void)
00054 {}
00055
00056
00057 void OtsUDPHardware::write(const std::string& sendBuffer)
00058 throw(std::runtime_error)
00059 try
00060 {
00061
00062
00063
00064
00065
00066
00067
00068
00069
00070
00071
00072
00073
00074
00075
00076
00077
00078
00079
00080
00081
00082
00083
00084
00085 if(TransceiverSocket::send(OtsUDPBoard_, sendBuffer, verbose_) < 0)
00086 {
00087 __SS__ << "Write failed to hardware at IP:Port " <<
00088 OtsUDPBoard_.getIPAddress() << ":" << OtsUDPBoard_.getPort() << __E__;
00089 __SS_THROW__;
00090 }
00091 }
00092 catch(std::runtime_error &e)
00093 {
00094 throw;
00095 }
00096 catch(...)
00097 {
00098 __SS__ << "Unrecognized exception caught!" << std::endl;
00099 __SS_THROW__;
00100 }
00101
00102
00103 void OtsUDPHardware::write(const std::vector<std::string>& sendBuffer)
00104 throw(std::runtime_error)
00105 {
00106 for(const auto& it : sendBuffer)
00107 {
00108
00109
00110
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125
00126
00127
00128
00129
00130
00131
00132 write(it);
00133 }
00134 }
00135
00136
00137 void OtsUDPHardware::writeAndAcknowledge(const std::string& buffer,
00138 int timeoutSeconds)
00139 throw(std::runtime_error)
00140 try
00141 {
00142
00143
00144
00145
00146
00147
00148
00149
00150
00151
00152
00153
00154
00155
00156
00157
00158
00159
00160
00161
00162
00163
00164
00165
00166
00167
00168
00169
00170
00171 TransceiverSocket::send(OtsUDPBoard_, buffer, verbose_);
00172
00173
00174 if(timeoutSeconds < 0)
00175 timeoutSeconds = 5;
00176
00177 if(TransceiverSocket::receive(acknowledgment_,timeoutSeconds) < 0)
00178 {
00179 __SS__ << "writeAndAcknowledge failed from hardware at IP:Port " <<
00180 OtsUDPBoard_.getIPAddress() << ":" << OtsUDPBoard_.getPort() <<
00181 ". Timeout period of " << timeoutSeconds << " seconds reached without response." << std::endl;
00182 __COUT_ERR__ << "\n" << ss.str() << std::endl;
00183 __SS_THROW__;
00184 }
00185
00186
00187
00188
00189
00190
00191
00192
00193
00194
00195
00196
00197
00198
00199
00200
00201
00202
00203
00204 if((acknowledgment_[0]>>4))
00205 {
00206 __SS__ << "Error in OTS protocol encountered! " << std::setfill('0') << std::setw(2) << std::hex <<
00207 (((int16_t) acknowledgment_[0]) &0xff) << "-" << std::dec << __E__;
00208 __SS_THROW__;
00209 }
00210
00211 }
00212 catch(std::runtime_error &e)
00213 {
00214 throw;
00215 }
00216 catch(...)
00217 {
00218 __SS__ << "Unrecognized exception caught!" << std::endl;
00219 __COUT_ERR__ << "\n" << ss.str() << std::endl;
00220 __SS_THROW__;
00221 }
00222
00223
00224 void OtsUDPHardware::writeAndAcknowledge(const std::vector<std::string>& buffer,
00225 int timeoutSeconds)
00226 throw(std::runtime_error)
00227 {
00228 for(const auto& it : buffer)
00229 {
00230
00231
00232
00233
00234
00235
00236
00237
00238
00239
00240
00241
00242
00243
00244
00245
00246
00247
00248
00249
00250
00251
00252
00253 writeAndAcknowledge(it);
00254 }
00255 }
00256
00257
00258
00259 void OtsUDPHardware::read(const std::string& sendBuffer, std::string& receiveBuffer, int timeoutSeconds)
00260 throw(std::runtime_error)
00261 try
00262 {
00263 {
00264 int clearedPackets = OtsUDPHardware::clearReadSocket();
00265 if(clearedPackets)
00266 __COUT__ << "Cleared receive socket buffer: " << clearedPackets << " packets cleared." << std::endl;
00267 }
00268
00269 __COUT__ << "Sending" << std::endl;
00270 TransceiverSocket::send(OtsUDPBoard_, sendBuffer, verbose_);
00271
00272 if(timeoutSeconds < 0)
00273 timeoutSeconds = 5;
00274
00275 __COUT__ << "Receiving" << std::endl;
00276 if(TransceiverSocket::receive(receiveBuffer,timeoutSeconds,0 ,verbose_) < 0)
00277 {
00278 __SS__ << "Read failed from hardware at IP : Port " <<
00279 OtsUDPBoard_.getIPAddress() << " : " << OtsUDPBoard_.getPort() <<
00280 ". Timeout period of " << timeoutSeconds << " seconds reached without response." << __E__;
00281 __SS_THROW__;
00282 }
00283
00284
00285
00286
00287
00288
00289
00290
00291
00292
00293
00294
00295
00296
00297 if((receiveBuffer[0]>>5))
00298 {
00299 __SS__ << "Error in OTS protocol encountered! " << std::setfill('0') << std::setw(2) << std::hex <<
00300 (((int16_t) receiveBuffer[0]) &0xff) << "-" << std::dec << __E__;
00301
00302 }
00303
00304 }
00305 catch(std::runtime_error &e)
00306 {
00307 throw;
00308 }
00309 catch(...)
00310 {
00311 __SS__ << "Unrecognized exception caught!" << std::endl;
00312 __SS_THROW__;
00313 }
00314
00315
00316 void OtsUDPHardware::read(const std::vector<std::string>& sendBuffers,
00317 std::vector<std::string>& receiveBuffers,
00318 int timeoutSeconds)
00319 throw(std::runtime_error)
00320 {
00321 receiveBuffers.resize(sendBuffers.size());
00322 auto receiveBufferIterator = receiveBuffers.begin();
00323 for(const auto& sendBuffer : sendBuffers)
00324 read(sendBuffer, *(receiveBufferIterator++));
00325 }
00326
00327
00328 void OtsUDPHardware::read(const std::string& sendBuffer,
00329 uint64_t& receiveQuadWord,
00330 int timeoutSeconds)
00331 throw(std::runtime_error)
00332 {
00333 std::string receiveBuffer;
00334 read(sendBuffer,receiveBuffer);
00335
00336
00337 if(receiveBuffer.length() != 10)
00338 {
00339 __SS__ << "Read uint64_t quad-word failed. Invalid size of received buffer: " <<
00340 receiveBuffer.length() << " != " << 10 << std::endl;
00341 __SS_THROW__;
00342 }
00343
00344
00345
00346
00347
00348
00349 receiveQuadWord = *((uint64_t *)&receiveBuffer[2]);
00350
00351
00352
00353 }
00354
00355
00356 void OtsUDPHardware::read(const std::string& sendBuffer,
00357 std::vector<uint64_t>& receiveQuadWords,
00358 int timeoutSeconds)
00359 throw(std::runtime_error)
00360 {
00361 receiveQuadWords.resize(0);
00362
00363 std::string receiveBuffer;
00364 read(sendBuffer,receiveBuffer);
00365
00366
00367 if((receiveBuffer.length()-2) % 8 != 0)
00368 {
00369 __SS__ << "Read vector of uint64_t quad-word failed. Invalid size of received buffer: (" <<
00370 receiveBuffer.length() << " - 2) % 8 != 0" << std::endl;
00371 __SS_THROW__;
00372 }
00373
00374 for(unsigned int i = 2; i < receiveBuffer.length(); i += 8)
00375 {
00376 receiveQuadWords.push_back(uint64_t());
00377
00378
00379
00380 receiveQuadWords[receiveQuadWords.size()-1] = *((uint64_t *)&receiveBuffer[i]);
00381 }
00382 }
00383
00384
00385 void OtsUDPHardware::read(const std::vector<std::string>& sendBuffers,
00386 std::vector<std::vector<uint64_t> >& receiveQuadWordsVector,
00387 int timeoutSeconds)
00388 throw(std::runtime_error)
00389 {
00390 receiveQuadWordsVector.resize(sendBuffers.size());
00391
00392 std::string receiveBuffer;
00393
00394
00395 for(unsigned int b = 0; b < sendBuffers.size(); ++b)
00396 {
00397 receiveQuadWordsVector[b].resize(0);
00398
00399 read(sendBuffers[b], receiveBuffer);
00400
00401
00402 if((receiveBuffer.length()-2) % 8 != 0)
00403 {
00404 __SS__ << "Read vector of uint64_t quad-word failed. Invalid size of received buffer: (" <<
00405 receiveBuffer.length() << " - 2) % 8 != 0" << std::endl;
00406 __SS_THROW__;
00407 }
00408
00409
00410 for(unsigned int i = 2; i < receiveBuffer.length(); i += 8)
00411 {
00412 receiveQuadWordsVector[b].push_back(uint64_t());
00413 std::copy_n((char *)&receiveBuffer[i],sizeof(uint64_t),
00414 &receiveQuadWordsVector[b][receiveQuadWordsVector[b].size()-1]);
00415 }
00416 }
00417 }
00418
00419
00420
00421
00422
00423
00424
00425
00426 int OtsUDPHardware::clearReadSocket()
00427 {
00428 std::string dummerReceiveBuffer;
00429 int cnt = 0;
00430
00431
00432 try
00433 {
00434 while(TransceiverSocket::receive(dummerReceiveBuffer,
00435 0,
00436 0,
00437 false )>= 0)
00438 ++cnt;
00439 }
00440 catch(...)
00441 {
00442
00443 __COUT__ << "I am crashing while trying to read the socket...strange!" << std::endl;
00444 }
00445 return cnt;
00446 }
00447
00448
00449
00450
00451
00452
00453
00454
00455