LocalTrackIf.cxx

 
#include <unistd.h>
#include <fcntl.h>
 
#include "openmrn_features.h"
#ifdef OPENMRN_FEATURE_FD_CAN_DEVICE
 
#define LOGLEVEL INFO
 
#ifdef __FreeRTOS__
#include "freertos/can_ioctl.h"
#else
#include "can_ioctl.h"
#endif
 
#endif // OPENMRN_FEATURE_FD_CAN_DEVICE
 
#include "dcc/LocalTrackIf.hxx"
 
namespace dcc
{
 
LocalTrackIf::LocalTrackIf(Service *service, int pool_size)
    : StateFlow<Buffer<dcc::Packet>, QList<1>>(service)
    , fd_(-1)
    , pool_(sizeof(Buffer<dcc::Packet>), pool_size)
{
}
 
#if defined(OPENMRN_FEATURE_FD_CAN_DEVICE) || defined(GTEST)
StateFlowBase::Action LocalTrackIf::entry()
{
    HASSERT(fd_ >= 0);
    auto *p = message()->data();
    int ret = write(fd_, p, sizeof(*p));
    if (ret < 0) {
        HASSERT(errno == ENOSPC);
        #ifndef GTEST
        ::ioctl(fd_, CAN_IOC_WRITE_ACTIVE, this);
        #endif
        return wait();
    }
    return finish();
}
#endif
 
StateFlowBase::Action LocalTrackIfSelect::entry() {
    HASSERT(fd_ >= 0);
    auto *p = message()->data();
    return write_repeated(&helper_, fd_, p, sizeof(*p), STATE(finish));
}
 
} // namespace dcc