#ifdef SLS_RECEIVER_FUNCTION_LIST /********************************************//** * @file slsReceiverFunctionList.cpp * @short does all the functions for a receiver, set/get parameters, start/stop etc. ***********************************************/ #include "slsReceiverFunctionList.h" #include // SIGINT #include // stat #include // socket(), bind(), listen(), accept(), shut down #include // sock_addr_in, htonl, INADDR_ANY #include // exit() #include //set precision #include //munmap #include #include using namespace std; FILE* slsReceiverFunctionList::sfilefd(NULL); int slsReceiverFunctionList::listening_thread_running(0); slsReceiverFunctionList::slsReceiverFunctionList(detectorType det,bool moenchwithGotthardTest): myDetectorType(det), maxFramesPerFile(MAX_FRAMES_PER_FILE), enableFileWrite(1), fileIndex(0), frameIndexNeeded(0), framesCaught(0), startFrameIndex(-1), frameIndex(0), totalFramesCaught(0), startAcquisitionIndex(-1), acquisitionIndex(0), framesInFile(0), prevframenum(0), status(IDLE), latestData(NULL), udpSocket(NULL), server_port(DEFAULT_UDP_PORTNO), fifo(NULL), shortFrame(-1), bufferSize(GOTTHARD_BUFFER_SIZE), packetsPerFrame(GOTTHARD_PACKETS_PER_FRAME), guiDataReady(0), guiData(NULL), guiFileName(NULL), currframenum(0), nFrameToGui(0), startAcquisitionCallBack(NULL), pStartAcquisition(NULL), acquisitionFinishedCallBack(NULL), pAcquisitionFinished(NULL), rawDataReadyCallBack(NULL), pRawDataReady(NULL), withGotthard(moenchwithGotthardTest), frameIndexMask(GOTTHARD_FRAME_INDEX_MASK), frameIndexOffset(GOTTHARD_FRAME_INDEX_OFFSET) { if(myDetectorType == MOENCH){ maxFramesPerFile = MOENCH_MAX_FRAMES_PER_FILE; bufferSize = MOENCH_BUFFER_SIZE; packetsPerFrame = MOENCH_PACKETS_PER_FRAME; if(!withGotthard){ frameIndexMask = MOENCH_FRAME_INDEX_MASK; frameIndexOffset = MOENCH_FRAME_INDEX_OFFSET; } } strcpy(savefilename,""); strcpy(filePath,""); strcpy(fileName,"run"); guiFileName = new char[MAX_STR_LENGTH]; strcpy(guiFileName,""); eth = new char[MAX_STR_LENGTH]; strcpy(eth,""); latestData = new char[bufferSize]; fifofree = new CircularFifo(); fifo = new CircularFifo(); int aligned_frame_size = GOTTHARD_ALIGNED_FRAME_SIZE; if (det == MOENCH) aligned_frame_size = MOENCH_ALIGNED_FRAME_SIZE; mem0=(char*)malloc(aligned_frame_size*FIFO_SIZE); if (mem0==NULL) { cout<<"++++++++++++++++++++++ COULD NOT ALLOCATE MEMORY!!!!!!!+++++++++++++++++++++" << endl; } buffer=mem0; while (buffer<(mem0+aligned_frame_size*(FIFO_SIZE-1))) { fifofree->push(buffer); buffer+=aligned_frame_size; } if(withGotthard) cout << "Testing MOENCH Receiver with GOTTHARD Detector" << endl; } int slsReceiverFunctionList::setEnableFileWrite(int i){ if(i!=-1) enableFileWrite=i; return enableFileWrite; } void slsReceiverFunctionList::setEthernetInterface(char* c){ strcpy(eth,c); } int slsReceiverFunctionList::getFrameIndex(){ if(startFrameIndex==-1) frameIndex=0; else if(myDetectorType == MOENCH) frameIndex=currframenum - startFrameIndex; else frameIndex=(currframenum - startFrameIndex)/packetsPerFrame; return frameIndex; } int slsReceiverFunctionList::getAcquisitionIndex(){ if(startAcquisitionIndex==-1) acquisitionIndex=0; else if(myDetectorType == MOENCH) acquisitionIndex=currframenum - startAcquisitionIndex; else acquisitionIndex=(currframenum - startAcquisitionIndex)/packetsPerFrame; return acquisitionIndex; } char* slsReceiverFunctionList::setFileName(char c[]){ if(strlen(c)) strcpy(fileName,c); return getFileName(); } char* slsReceiverFunctionList::setFilePath(char c[]){ if(strlen(c)){ //check if filepath exists struct stat st; if(stat(c,&st) == 0) strcpy(filePath,c); else{ strcpy(filePath,""); cout<<"FilePath does not exist:"<=0) fileIndex = i; return getFileIndex(); } void slsReceiverFunctionList::resetTotalFramesCaught(){ startAcquisitionIndex = -1; totalFramesCaught = 0; } int slsReceiverFunctionList::startReceiver(){ #ifdef VERBOSE cout << "Starting Receiver" << endl; #endif cout << endl; int err = 0; if(!listening_thread_running){ #ifdef VERBOSE cout << "Starting new acquisition threadddd ...." << endl; #endif listening_thread_running=1; // creating writing thread err = pthread_create(&writing_thread, NULL,startWritingThread, (void*) this); if(err){ listening_thread_running=0; status = IDLE; cout << "Cant create writing thread. Status:" << status << endl << endl; return FAIL; } #ifdef VERBOSE cout << "Writing thread created successfully." << endl; #endif // creating listenign thread err = 0; err = pthread_create(&listening_thread, NULL,startListeningThread, (void*) this); if(err){ listening_thread_running=0; status = IDLE; //stop writing thread pthread_join(writing_thread,NULL); cout << endl << "Cant create listening thread. Status:" << status << endl << endl; return FAIL; } while(status!=RUNNING); #ifdef VERBOSE cout << "Listening thread created successfully." << endl; #endif cout << "Threads created successfully." << endl; struct sched_param tcp_param, listen_param, write_param; int policy= SCHED_RR; tcp_param.sched_priority = 50; listen_param.sched_priority = 99; write_param.sched_priority = 90; if (pthread_setschedparam(listening_thread, policy, &listen_param) == EPERM) cout << "ERROR: Could not prioritize threads. You need to be super user for that." << endl; if (pthread_setschedparam(writing_thread, policy, &write_param) == EPERM) cout << "ERROR: Could not prioritize threads. You need to be super user for that." << endl; if (pthread_setschedparam(pthread_self(),5 , &tcp_param) == EPERM) cout << "ERROR: Could not prioritize threads. You need to be super user for that." << endl; //pthread_getschedparam(pthread_self(),&policy,&tcp_param); //cout << "current priority of main tcp thread is " << tcp_param.sched_priority << endl; } return OK; } int slsReceiverFunctionList::stopReceiver(){ #ifdef VERBOSE cout << "Stopping Receiver" << endl; #endif if(listening_thread_running){ #ifdef VERBOSE cout << "Stopping new acquisition threadddd ...." << endl; #endif //stop listening thread listening_thread_running=0; udpSocket->ShutDownSocket(); pthread_join(listening_thread,NULL); status = IDLE; //stop writing thread pthread_join(writing_thread,NULL); } cout << "Receiver Stoppped.\nStatus:" << status << endl; return OK; } void* slsReceiverFunctionList::startListeningThread(void* this_pointer){ ((slsReceiverFunctionList*)this_pointer)->startListening(); return this_pointer; } int slsReceiverFunctionList::startListening(){ #ifdef VERYVERBOSE cout << "In startListening()\n"); #endif int rc; startFrameIndex=-1; // A do/while(FALSE) loop is used to make error cleanup easier. The // close() of each of the socket descriptors is only done once at the // very end of the program. do { //creating udp socket if (strchr(eth,'.')!=NULL) strcpy(eth,""); if(!strlen(eth)){ cout<<"warning:eth is empty.listening to all"<getErrorStatus()){ #ifdef VERBOSE std::cout<< "Could not create UDP socket "<< server_port << std::endl; #endif break; } while (listening_thread_running) { status = RUNNING; if (!fifofree->isEmpty()) { fifofree->pop(buffer); //receiver 2 half frames / 1 short frame / 40 moench frames rc = udpSocket->ReceiveDataOnly(buffer,bufferSize); if( rc < 0) cerr << "recvfrom() failed" << endl; //start for each scan if(startFrameIndex==-1){ if(!frameIndexOffset) startFrameIndex = ((int)(*((int*)buffer)))- packetsPerFrame; else startFrameIndex = ((((int)(*((int*)buffer))) & (frameIndexMask)) >> frameIndexOffset)-1; //cout<<"startFrameIndex:"<isFull()) ;//cout<<"**********************FIFO FULLLLLLLL************************"<> frameIndexOffset; fifo->push(buffer); } } } } } while (listening_thread_running); listening_thread_running=0; status = IDLE; //Close down any open socket descriptors udpSocket->Disconnect(); #ifdef VERBOSE cout << "listening_thread_running:" << listening_thread_running << endl; #endif return 0; } void* slsReceiverFunctionList::startWritingThread(void* this_pointer){ ((slsReceiverFunctionList*)this_pointer)->startWriting(); return this_pointer; } int slsReceiverFunctionList::startWriting(){ #ifdef VERYVERBOSE cout << "In startWriting()" <isEmpty())){ //start a new file if ((framesInFile == maxFramesPerFile) || (strlen(savefilename) == 0)){ //create file name if(frameIndexNeeded==-1) sprintf(savefilename, "%s/%s_%d.raw", filePath,fileName,fileIndex); else sprintf(savefilename, "%s/%s_f%012d_%d.raw", filePath,fileName,framesCaught,fileIndex); if(enableFileWrite && cbAction > DO_NOTHING){ if(sfilefd) fclose(sfilefd); if (NULL == (sfilefd = fopen((const char *) (savefilename), "w"))){ cout << "Error: Could not create file " << savefilename << endl; break; } //printing packet losses and file names if(prevframenum == 0) cout << savefilename << endl; else{ cout << savefilename << "\tpacket loss " << fixed << setprecision(4) << ((currframenum-prevframenum-(packetsPerFrame*framesInFile))/(double)(packetsPerFrame*framesInFile))*100.000 << "%\t\t" "framenum " << currframenum << endl; } } if(prevframenum != 0){ prevframenum=currframenum; framesInFile = 0; } } //pop fifo if(!fifo->isEmpty()){ if(fifo->pop(wbuf)){ framesCaught++; totalFramesCaught++; if(!frameIndexOffset) currframenum = (int)(*((int*)wbuf)); else currframenum = (((int)(*((int*)wbuf))) & (frameIndexMask)) >> frameIndexOffset; //cout<<"**************curreframenm:"<push(wbuf); } } else{//cout<<"************************fifo empty**********************************"<