mirror of
https://github.com/paulscherrerinstitute/sf_daq_buffer.git
synced 2026-05-08 12:22:03 +02:00
Try to use recvmmsg
This commit is contained in:
@@ -2,6 +2,7 @@
|
|||||||
#include "jungfrau.hpp"
|
#include "jungfrau.hpp"
|
||||||
#include <iostream>
|
#include <iostream>
|
||||||
#include <UdpReceiver.hpp>
|
#include <UdpReceiver.hpp>
|
||||||
|
#include <netinet/in.h>
|
||||||
|
|
||||||
using namespace std;
|
using namespace std;
|
||||||
|
|
||||||
@@ -88,65 +89,84 @@ void UdpRecvModule::receive_thread(
|
|||||||
|
|
||||||
char* frame_buffer = ring_buffer_.reserve(metadata);
|
char* frame_buffer = ring_buffer_.reserve(metadata);
|
||||||
|
|
||||||
jungfrau_packet packet_buffer;
|
auto n_msgs = JUNGFRAU_N_PACKETS_PER_FRAME;
|
||||||
|
jungfrau_packet recv_buffers[n_msgs];
|
||||||
|
iovec recv_buff_ptr[n_msgs];
|
||||||
|
struct mmsghdr msgs[n_msgs];
|
||||||
|
struct sockaddr_in sockFrom[n_msgs];
|
||||||
|
|
||||||
|
for (int i = 0; i < n_msgs; i++) {
|
||||||
|
recv_buff_ptr[i].iov_base = (void*) &(recv_buffers[i]);
|
||||||
|
recv_buff_ptr[i].iov_len = sizeof(jungfrau_packet);
|
||||||
|
|
||||||
|
msgs[i].msg_hdr.msg_iov = &recv_buff_ptr[i];
|
||||||
|
msgs[i].msg_hdr.msg_iovlen = 1;
|
||||||
|
msgs[i].msg_hdr.msg_name = &sockFrom[i];
|
||||||
|
msgs[i].msg_hdr.msg_namelen = sizeof(struct sockaddr_in );
|
||||||
|
}
|
||||||
|
|
||||||
while (is_receiving_.load(memory_order_relaxed)) {
|
while (is_receiving_.load(memory_order_relaxed)) {
|
||||||
|
|
||||||
if (!udp_receiver.receive(
|
auto n_packets = udp_receiver.receive_many(msgs, n_msgs);
|
||||||
&packet_buffer,
|
|
||||||
JUNGFRAU_BYTES_PER_PACKET)) {
|
if (n_packets < 1) {
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
|
|
||||||
auto* frame_metadata = metadata.get();
|
for (int i_packet=0; i_packet<n_packets; i_packet++) {
|
||||||
|
|
||||||
// TODO: Horrible. Breake it down into methods.
|
auto* frame_metadata = metadata.get();
|
||||||
|
jungfrau_packet* packet_buffer = &(recv_buffers[i_packet]);
|
||||||
|
|
||||||
// First packet for this frame.
|
// TODO: Horrible. Breake it down into methods.
|
||||||
if (frame_metadata->pulse_id == 0) {
|
|
||||||
frame_metadata->frame_index = packet_buffer.framenum;
|
|
||||||
frame_metadata->pulse_id = packet_buffer.bunchid;
|
|
||||||
frame_metadata->daq_rec = packet_buffer.debug;
|
|
||||||
// Packet from new frame, while we lost the last packet of
|
|
||||||
// previous frame.
|
|
||||||
} else if (frame_metadata->pulse_id != packet_buffer.bunchid) {
|
|
||||||
ring_buffer_.commit(metadata);
|
|
||||||
|
|
||||||
metadata = make_shared<UdpFrameMetadata>();
|
// First packet for this frame.
|
||||||
metadata->frame_bytes_size = JUNGFRAU_DATA_BYTES_PER_FRAME;
|
if (frame_metadata->pulse_id == 0) {
|
||||||
metadata->pulse_id = 0;
|
frame_metadata->frame_index = packet_buffer->framenum;
|
||||||
metadata->n_recv_packets = 0;
|
frame_metadata->pulse_id = packet_buffer->bunchid;
|
||||||
|
frame_metadata->daq_rec = packet_buffer->debug;
|
||||||
|
// Packet from new frame, while we lost the last packet of
|
||||||
|
// previous frame.
|
||||||
|
|
||||||
frame_buffer = ring_buffer_.reserve(metadata);
|
} else if (frame_metadata->pulse_id != packet_buffer->bunchid) {
|
||||||
memset(frame_buffer, 0, JUNGFRAU_DATA_BYTES_PER_FRAME);
|
ring_buffer_.commit(metadata);
|
||||||
|
|
||||||
frame_metadata->frame_index = packet_buffer.framenum;
|
metadata = make_shared<UdpFrameMetadata>();
|
||||||
frame_metadata->pulse_id = packet_buffer.bunchid;
|
metadata->frame_bytes_size = JUNGFRAU_DATA_BYTES_PER_FRAME;
|
||||||
frame_metadata->daq_rec = packet_buffer.debug;
|
metadata->pulse_id = 0;
|
||||||
}
|
metadata->n_recv_packets = 0;
|
||||||
|
|
||||||
size_t frame_buffer_offset =
|
frame_buffer = ring_buffer_.reserve(metadata);
|
||||||
JUNGFRAU_DATA_BYTES_PER_PACKET * packet_buffer.packetnum;
|
memset(frame_buffer, 0, JUNGFRAU_DATA_BYTES_PER_FRAME);
|
||||||
|
|
||||||
memcpy(
|
frame_metadata->frame_index = packet_buffer->framenum;
|
||||||
(void*) (frame_buffer + frame_buffer_offset),
|
frame_metadata->pulse_id = packet_buffer->bunchid;
|
||||||
packet_buffer.data,
|
frame_metadata->daq_rec = packet_buffer->debug;
|
||||||
JUNGFRAU_DATA_BYTES_PER_PACKET);
|
}
|
||||||
|
|
||||||
frame_metadata->n_recv_packets++;
|
size_t frame_buffer_offset =
|
||||||
|
JUNGFRAU_DATA_BYTES_PER_PACKET * packet_buffer->packetnum;
|
||||||
|
|
||||||
// Frame finished with last packet.
|
memcpy(
|
||||||
if (packet_buffer.packetnum == JUNGFRAU_N_PACKETS_PER_FRAME-1)
|
(void*) (frame_buffer + frame_buffer_offset),
|
||||||
{
|
packet_buffer->data,
|
||||||
ring_buffer_.commit(metadata);
|
JUNGFRAU_DATA_BYTES_PER_PACKET);
|
||||||
|
|
||||||
metadata = make_shared<UdpFrameMetadata>();
|
frame_metadata->n_recv_packets++;
|
||||||
metadata->frame_bytes_size = JUNGFRAU_DATA_BYTES_PER_FRAME;
|
|
||||||
metadata->pulse_id = 0;
|
|
||||||
metadata->n_recv_packets = 0;
|
|
||||||
|
|
||||||
frame_buffer = ring_buffer_.reserve(metadata);
|
// Frame finished with last packet.
|
||||||
memset(frame_buffer, 0, JUNGFRAU_DATA_BYTES_PER_FRAME);
|
if (packet_buffer->packetnum == JUNGFRAU_N_PACKETS_PER_FRAME-1)
|
||||||
|
{
|
||||||
|
ring_buffer_.commit(metadata);
|
||||||
|
|
||||||
|
metadata = make_shared<UdpFrameMetadata>();
|
||||||
|
metadata->frame_bytes_size = JUNGFRAU_DATA_BYTES_PER_FRAME;
|
||||||
|
metadata->pulse_id = 0;
|
||||||
|
metadata->n_recv_packets = 0;
|
||||||
|
|
||||||
|
frame_buffer = ring_buffer_.reserve(metadata);
|
||||||
|
memset(frame_buffer, 0, JUNGFRAU_DATA_BYTES_PER_FRAME);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user