HubDevice.cxx

Go to the documentation of this file.

 
#include "utils/HubDevice.hxx"
#include "nmranet_config.h"
#include <stdlib.h>
 
template <>
const int FdHubPort<CanHubFlow>::ReadThread::kUnit = sizeof(struct can_frame);
template <>
const int FdHubPort<CanHubFlow>::ReadThread::kBufSize = sizeof(
    struct can_frame);
 
template <>
void FdHubPort<CanHubFlow>::ReadThread::init()
{
    // No semaphores used for CAN-bus connection. We have to read as fast as we
    // can or else packet loss will happen.
}
 
template <>
void FdHubPort<CanHubFlow>::ReadThread::send_message(const void *buf, int size)
{
    HASSERT(size == sizeof(struct can_frame));
    auto *b = port()->hub_->alloc();
    b->data()->skipMember_ = &port()->writeFlow_;
    memcpy(b->data()->mutable_frame(), buf, size);
    port()->hub_->send(b, 0);
}
 
template <> const int FdHubPort<HubFlow>::ReadThread::kUnit = 1;
template <> const int FdHubPort<HubFlow>::ReadThread::kBufSize = 64;
 
 
template <>
void FdHubPort<HubFlow>::ReadThread::init()
{
    if (config_gridconnect_port_max_incoming_packets() < 1000000)
    {
        semaphores_ = new SemaphoreNotifiableBlock(
            config_gridconnect_port_max_incoming_packets());
    }
}
 
template <>
void FdHubPort<HubFlow>::ReadThread::send_message(const void *buf, int size)
{
    BarrierNotifiable *done = nullptr;
    if (semaphores_)
    {
        done = semaphores_->acquire();
    }
    auto *b = port()->hub_->alloc();
    if (done)
    {
        b->set_done(done);
    }
    b->data()->skipMember_ = &port()->writeFlow_;
    b->data()->assign((const char *)buf, size);
    port()->hub_->send(b);
}
 
static const char kThreadPrefix[] = "thread_fd_";
 
void FdHubPortBase::fill_thread_name(char *buf, char mode, int fd)
{
    memcpy(buf, kThreadPrefix, sizeof(kThreadPrefix));
    static_assert(
        sizeof(kThreadPrefix) == 11, "size of thread prefix incorrect");
    char *p = buf + sizeof(kThreadPrefix) - 1;
    *p++ = mode;
    *p++ = '_';
    char *q = p;
    int ff = fd;
    do
    {
        ff /= 10;
        q++;
    } while (ff);
    *q = 0;
    q--;
    ff = fd;
    do
    {
        *q = '0' + (ff % 10);
        q--;
        ff /= 10;
    } while (ff);
}