mirror of
https://github.com/slsdetectorgroup/slsDetectorPackage.git
synced 2025-04-23 15:00:02 +02:00
299 lines
11 KiB
C++
299 lines
11 KiB
C++
/* Creates the slsMultiReceiver for running multiple receivers form a single
|
|
* binary */
|
|
#include "sls/Receiver.h"
|
|
#include "sls/container_utils.h"
|
|
#include "sls/logger.h"
|
|
#include "sls/sls_detector_defs.h"
|
|
|
|
#include <csignal> //SIGINT
|
|
#include <cstring>
|
|
#include <iostream>
|
|
#include <semaphore.h>
|
|
#include <sys/syscall.h>
|
|
#include <sys/wait.h> //wait
|
|
#include <unistd.h>
|
|
|
|
/** Define Colors to print data call back in different colors for different
|
|
* recievers */
|
|
#define PRINT_IN_COLOR(c, f, ...) \
|
|
printf("\033[%dm" f RESET, 30 + c + 1, ##__VA_ARGS__)
|
|
|
|
sem_t semaphore;
|
|
|
|
/**
|
|
* Control+C Interrupt Handler
|
|
* to let all the processes know to exit properly
|
|
*/
|
|
void sigInterruptHandler(int p) { sem_post(&semaphore); }
|
|
|
|
/**
|
|
* prints usage of this example program
|
|
*/
|
|
void printHelp() {
|
|
cprintf(
|
|
RESET,
|
|
"Usage:\n"
|
|
"./slsMultiReceiver(detReceiver) [start_tcp_port] "
|
|
"[num_receivers] [optional: 1 for call back (print frame header for "
|
|
"debugging), 0 for none (default)]\n\n");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
/**
|
|
* Start Acquisition Call back
|
|
* slsReceiver writes data if file write enabled.
|
|
* Users get data to write using call back if registerCallBackRawDataReady is
|
|
* registered.
|
|
* @param filepath file path
|
|
* @param filename file name
|
|
* @param fileindex file index
|
|
* @param datasize data size in bytes
|
|
* @param p pointer to object
|
|
* \returns ignored
|
|
*/
|
|
int StartAcq(std::string filepath, std::string filename, uint64_t fileindex,
|
|
uint32_t datasize, void *p) {
|
|
LOG(logINFOBLUE) << "#### StartAcq: filepath:" << filepath
|
|
<< " filename:" << filename << " fileindex:" << fileindex
|
|
<< " datasize:" << datasize << " ####";
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* Acquisition Finished Call back
|
|
* @param frames Number of frames caught
|
|
* @param p pointer to object
|
|
*/
|
|
void AcquisitionFinished(uint64_t frames, void *p) {
|
|
LOG(logINFOBLUE) << "#### AcquisitionFinished: frames:" << frames
|
|
<< " ####";
|
|
}
|
|
|
|
/**
|
|
* Get Receiver Data Call back
|
|
* Prints in different colors(for each receiver process) the different headers
|
|
* for each image call back.
|
|
* @param metadata sls_receiver_header metadata
|
|
* @param datapointer pointer to data
|
|
* @param datasize data size in bytes.
|
|
* @param p pointer to object
|
|
*/
|
|
void GetData(char *metadata, char *datapointer, uint32_t datasize, void *p) {
|
|
slsDetectorDefs::sls_receiver_header *header =
|
|
(slsDetectorDefs::sls_receiver_header *)metadata;
|
|
slsDetectorDefs::sls_detector_header detectorHeader = header->detHeader;
|
|
|
|
PRINT_IN_COLOR(
|
|
detectorHeader.modId ? detectorHeader.modId : detectorHeader.row,
|
|
"#### %d GetData: ####\n"
|
|
"frameNumber: %lu\t\texpLength: %u\t\tpacketNumber: %u\t\tbunchId: %lu"
|
|
"\t\ttimestamp: %lu\t\tmodId: %u\t\t"
|
|
"row: %u\t\tcolumn: %u\t\treserved: %u\t\tdebug: %u"
|
|
"\t\troundRNumber: %u\t\tdetType: %u\t\tversion: %u"
|
|
//"\t\tpacketsMask:%s"
|
|
"\t\tfirstbytedata: 0x%x\t\tdatsize: %u\n\n",
|
|
detectorHeader.row, (long unsigned int)detectorHeader.frameNumber,
|
|
detectorHeader.expLength, detectorHeader.packetNumber,
|
|
(long unsigned int)detectorHeader.bunchId,
|
|
(long unsigned int)detectorHeader.timestamp, detectorHeader.modId,
|
|
detectorHeader.row, detectorHeader.column, detectorHeader.reserved,
|
|
detectorHeader.debug, detectorHeader.roundRNumber,
|
|
detectorHeader.detType, detectorHeader.version,
|
|
// header->packetsMask.to_string().c_str(),
|
|
((uint8_t)(*((uint8_t *)(datapointer)))), datasize);
|
|
}
|
|
|
|
/**
|
|
* Get Receiver Data Call back (modified)
|
|
* Prints in different colors(for each receiver process) the different headers
|
|
* for each image call back.
|
|
* @param metadata sls_receiver_header metadata
|
|
* @param datapointer pointer to data
|
|
* @param revDatasize new data size in bytes after the callback.
|
|
* This will be the size written/streamed. (only smaller value is allowed).
|
|
* @param p pointer to object
|
|
*/
|
|
void GetData(char *metadata, char *datapointer, uint32_t &revDatasize,
|
|
void *p) {
|
|
slsDetectorDefs::sls_receiver_header *header =
|
|
(slsDetectorDefs::sls_receiver_header *)metadata;
|
|
slsDetectorDefs::sls_detector_header detectorHeader = header->detHeader;
|
|
|
|
PRINT_IN_COLOR(
|
|
detectorHeader.modId ? detectorHeader.modId : detectorHeader.row,
|
|
"#### %d GetData: ####\n"
|
|
"frameNumber: %llu\t\texpLength: %u\t\tpacketNumber: %u\t\tbunchId: "
|
|
"%llu"
|
|
"\t\ttimestamp: %llu\t\tmodId: %u\t\t"
|
|
"row: %u\t\tcolumn: %u\t\treserved: %u\t\tdebug: %u"
|
|
"\t\troundRNumber: %u\t\tdetType: %u\t\tversion: %u"
|
|
//"\t\tpacketsMask:%s"
|
|
"\t\tfirstbytedata: 0x%x\t\tdatsize: %u\n\n",
|
|
detectorHeader.row, (long long unsigned int)detectorHeader.frameNumber,
|
|
detectorHeader.expLength, detectorHeader.packetNumber,
|
|
(long long unsigned int)detectorHeader.bunchId,
|
|
(long long unsigned int)detectorHeader.timestamp, detectorHeader.modId,
|
|
detectorHeader.row, detectorHeader.column, detectorHeader.reserved,
|
|
detectorHeader.debug, detectorHeader.roundRNumber,
|
|
detectorHeader.detType, detectorHeader.version,
|
|
// header->packetsMask.to_string().c_str(),
|
|
((uint8_t)(*((uint8_t *)(datapointer)))), revDatasize);
|
|
|
|
// if data is modified, eg ROI and size is reduced
|
|
revDatasize = 26000;
|
|
}
|
|
|
|
/**
|
|
* Example of main program using the Receiver class
|
|
*
|
|
* - Defines in file for:
|
|
* - Default Number of receivers is 1
|
|
* - Default Start TCP port is 1954
|
|
*/
|
|
int main(int argc, char *argv[]) {
|
|
|
|
/** - set default values */
|
|
int numReceivers = 1;
|
|
int startTCPPort = 1954;
|
|
int withCallback = 0;
|
|
sem_init(&semaphore, 1, 0);
|
|
|
|
/** - get number of receivers and start tcp port from command line
|
|
* arguments */
|
|
if (argc != 3 && argc != 4)
|
|
printHelp();
|
|
if ((argc == 3) && ((!sscanf(argv[1], "%d", &startTCPPort)) ||
|
|
(!sscanf(argv[2], "%d", &numReceivers))))
|
|
printHelp();
|
|
if ((argc == 4) && ((!sscanf(argv[1], "%d", &startTCPPort)) ||
|
|
(!sscanf(argv[2], "%d", &numReceivers)) ||
|
|
(!sscanf(argv[3], "%d", &withCallback))))
|
|
printHelp();
|
|
|
|
cprintf(BLUE, "Parent Process Created [ Tid: %ld ]\n",
|
|
(long)syscall(SYS_gettid));
|
|
cprintf(RESET, "Number of Receivers: %d\n", numReceivers);
|
|
cprintf(RESET, "Start TCP Port: %d\n", startTCPPort);
|
|
cprintf(RESET, "Callback Enable: %d\n", withCallback);
|
|
|
|
/** - Catch signal SIGINT to close files and call destructors properly */
|
|
struct sigaction sa;
|
|
sa.sa_flags = 0; // no flags
|
|
sa.sa_handler = sigInterruptHandler; // handler function
|
|
sigemptyset(&sa.sa_mask); // dont block additional signals during invocation
|
|
// of handler
|
|
if (sigaction(SIGINT, &sa, nullptr) == -1) {
|
|
cprintf(RED, "Could not set handler function for SIGINT\n");
|
|
}
|
|
|
|
/** - Ignore SIG_PIPE, prevents global signal handler, handle locally,
|
|
instead of a server crashing due to client crash when writing, it just
|
|
gives error */
|
|
struct sigaction asa;
|
|
asa.sa_flags = 0; // no flags
|
|
asa.sa_handler = SIG_IGN; // handler function
|
|
sigemptyset(&asa.sa_mask); // dont block additional signals during
|
|
// invocation of handler
|
|
if (sigaction(SIGPIPE, &asa, nullptr) == -1) {
|
|
cprintf(RED, "Could not set handler function for SIGPIPE\n");
|
|
}
|
|
|
|
/** - loop over number of receivers */
|
|
for (int i = 0; i < numReceivers; ++i) {
|
|
|
|
/** - fork process to create child process */
|
|
pid_t pid = fork();
|
|
|
|
/** - if fork failed, raise SIGINT and properly destroy all child
|
|
* processes */
|
|
if (pid < 0) {
|
|
cprintf(RED, "fork() failed. Killing all the receiver objects\n");
|
|
raise(SIGINT);
|
|
}
|
|
|
|
/** - if child process */
|
|
else if (pid == 0) {
|
|
cprintf(BLUE, "Child process %d [ Tid: %ld ]\n", i,
|
|
(long)syscall(SYS_gettid));
|
|
|
|
std::unique_ptr<sls::Receiver> receiver = nullptr;
|
|
try {
|
|
receiver = sls::make_unique<sls::Receiver>(startTCPPort + i);
|
|
} catch (...) {
|
|
LOG(logINFOBLUE)
|
|
<< "Exiting Child Process [ Tid: " << syscall(SYS_gettid)
|
|
<< " ]";
|
|
throw;
|
|
}
|
|
/** - register callbacks. remember to set file write enable to 0
|
|
(using the client) if we should not write files and you will write data
|
|
using the callbacks */
|
|
if (withCallback) {
|
|
|
|
/** - Call back for start acquisition */
|
|
cprintf(BLUE, "Registering StartAcq()\n");
|
|
receiver->registerCallBackStartAcquisition(StartAcq, nullptr);
|
|
|
|
/** - Call back for acquisition finished */
|
|
cprintf(BLUE, "Registering AcquisitionFinished()\n");
|
|
receiver->registerCallBackAcquisitionFinished(
|
|
AcquisitionFinished, nullptr);
|
|
|
|
/* - Call back for raw data */
|
|
cprintf(BLUE, "Registering GetData() \n");
|
|
if (withCallback == 1)
|
|
receiver->registerCallBackRawDataReady(GetData, nullptr);
|
|
else if (withCallback == 2)
|
|
receiver->registerCallBackRawDataModifyReady(GetData,
|
|
nullptr);
|
|
}
|
|
|
|
/** - as long as no Ctrl+C */
|
|
sem_wait(&semaphore);
|
|
sem_destroy(&semaphore);
|
|
cprintf(BLUE, "Exiting Child Process [ Tid: %ld ]\n",
|
|
(long)syscall(SYS_gettid));
|
|
exit(EXIT_SUCCESS);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/** - Parent process ignores SIGINT (exits only when all child process
|
|
* exits) */
|
|
sa.sa_flags = 0; // no flags
|
|
sa.sa_handler = SIG_IGN; // handler function
|
|
sigemptyset(&sa.sa_mask); // dont block additional signals during invocation
|
|
// of handler
|
|
if (sigaction(SIGINT, &sa, nullptr) == -1) {
|
|
cprintf(RED, "Could not set handler function for SIGINT\n");
|
|
}
|
|
|
|
/** - Print Ready and Instructions how to exit */
|
|
std::cout << "Ready ... \n";
|
|
cprintf(RESET, "\n[ Press \'Ctrl+c\' to exit ]\n");
|
|
|
|
/** - Parent process waits for all child processes to exit */
|
|
for (;;) {
|
|
pid_t childPid = waitpid(-1, nullptr, 0);
|
|
|
|
// no child closed
|
|
if (childPid == -1) {
|
|
if (errno == ECHILD) {
|
|
cprintf(GREEN, "All Child Processes have been closed\n");
|
|
break;
|
|
} else {
|
|
cprintf(RED, "Unexpected error from waitpid(): (%s)\n",
|
|
strerror(errno));
|
|
break;
|
|
}
|
|
}
|
|
|
|
// child closed
|
|
cprintf(BLUE, "Exiting Child Process [ Tid: %ld ]\n",
|
|
(long int)childPid);
|
|
}
|
|
|
|
std::cout << "Goodbye!\n";
|
|
return 0;
|
|
}
|