Prbs.cpp

Go to the documentation of this file.

 
#include "rogue/Directives.h"
 
#include "rogue/utilities/Prbs.h"
 
#include <inttypes.h>
#include <stdarg.h>
#include <sys/time.h>
#include <unistd.h>
 
#include <cstdio>
#include <cstring>
#include <memory>
 
#include "rogue/GeneralError.h"
#include "rogue/GilRelease.h"
#include "rogue/Logging.h"
#include "rogue/interfaces/stream/Buffer.h"
#include "rogue/interfaces/stream/Frame.h"
#include "rogue/interfaces/stream/FrameIterator.h"
#include "rogue/interfaces/stream/FrameLock.h"
#include "rogue/interfaces/stream/Master.h"
#include "rogue/interfaces/stream/Slave.h"
 
namespace ris = rogue::interfaces::stream;
namespace ru  = rogue::utilities;
 
#ifndef NO_PYTHON
    #include <boost/python.hpp>
namespace bp = boost::python;
#endif
 
ru::PrbsPtr ru::Prbs::create() {
    ru::PrbsPtr p = std::make_shared<ru::Prbs>();
    return (p);
}
 
ru::Prbs::Prbs() {
    txThread_   = NULL;
    rxSeq_      = 0;
    rxErrCount_ = 0;
    rxCount_    = 0;
    rxBytes_    = 0;
    rxEnable_   = true;
    txSeq_      = 0;
    txSize_     = 0;
    txErrCount_ = 0;
    txCount_    = 0;
    txBytes_    = 0;
    checkPl_    = true;
    genPl_      = true;
    rxLog_      = rogue::Logging::create("prbs.rx");
    txLog_      = rogue::Logging::create("prbs.tx");
    txPeriod_   = 0;
 
    // Init width = 32
    width_     = 32;
    byteWidth_ = 4;
    minSize_   = 12;
    sendCount_ = false;
 
    // Init 4 taps
    tapCnt_  = 4;
    taps_    = reinterpret_cast<uint8_t*>(malloc(sizeof(uint8_t) * tapCnt_));
    taps_[0] = 1;
    taps_[1] = 2;
    taps_[2] = 6;
    taps_[3] = 31;
 
    gettimeofday(&lastRxTime_, NULL);
    gettimeofday(&lastTxTime_, NULL);
 
    lastRxCount_ = 0;
    lastRxBytes_ = 0;
    rxRate_      = 0.0;
    rxBw_        = 0.0;
 
    lastTxCount_ = 0;
    lastTxBytes_ = 0;
    txRate_      = 0.0;
    txBw_        = 0.0;
}
 
ru::Prbs::~Prbs() {
    free(taps_);
}
 
double ru::Prbs::updateTime(struct timeval* last) {
    struct timeval cmp;
    struct timeval now;
    struct timeval per;
    double ret;
 
    cmp.tv_sec  = 1;
    cmp.tv_usec = 0;
 
    gettimeofday(&now, NULL);
 
    timersub(&now, last, &per);
 
    if (timercmp(&per, &cmp, >)) {
        ret = static_cast<float>(per.tv_sec) + static_cast<float>(per.tv_usec) / 1e6;
        gettimeofday(last, NULL);
    } else {
        ret = 0.0;
    }
    return ret;
}
 
void ru::Prbs::setWidth(uint32_t width) {
    if ((width > (MaxBytes * 8)) || (width % 32) != 0) throw(rogue::GeneralError("Prbs::setWidth", "Invalid width."));
 
    rogue::GilRelease noGil;
    std::lock_guard<std::mutex> lockT(pMtx_);
 
    width_     = width;
    byteWidth_ = width / 8;
    minSize_   = byteWidth_ * 3;
}
 
void ru::Prbs::setTaps(uint32_t tapCnt, uint8_t* taps) {
    uint32_t i;
 
    std::lock_guard<std::mutex> lockT(pMtx_);
 
    free(taps_);
    tapCnt_ = tapCnt;
    taps_   = reinterpret_cast<uint8_t*>(malloc(sizeof(uint8_t) * tapCnt));
 
    for (i = 0; i < tapCnt_; i++) taps_[i] = taps[i];
}
 
#ifndef NO_PYTHON
 
void ru::Prbs::setTapsPy(boost::python::object p) {
    Py_buffer pyBuf;
 
    if (PyObject_GetBuffer(p.ptr(), &pyBuf, PyBUF_SIMPLE) < 0)
        throw(rogue::GeneralError("Prbs::setTapsPy", "Python Buffer Error"));
 
    setTaps(pyBuf.len, reinterpret_cast<uint8_t*>(pyBuf.buf));
    PyBuffer_Release(&pyBuf);
}
 
#endif
 
void ru::Prbs::sendCount(bool state) {
    rogue::GilRelease noGil;
    std::lock_guard<std::mutex> lockT(pMtx_);
 
    sendCount_ = state;
}
 
void ru::Prbs::flfsr(uint8_t* data) {
    uint32_t iByte;
    uint32_t iBit;
    uint32_t x;
    bool msbOut;
    bool lsbIn = false;
 
    for (x = 0; x < tapCnt_; x++) {
        iByte = taps_[x] / 8;
        iBit  = taps_[x] % 8;
        lsbIn ^= ((data[iByte] >> iBit) & 0x1);
    }
 
    for (x = 0; x < byteWidth_; x++) {
        msbOut = data[x] & 0x80;
        data[x] <<= 1;
        data[x] |= lsbIn;
        lsbIn = msbOut;
    }
}
 
void ru::Prbs::runThread() {
    txLog_->logThreadId();
 
    while (threadEn_) {
        genFrame(txSize_);
        if ( txPeriod_ > 0 ) usleep(txPeriod_);
    }
}
 
void ru::Prbs::enable(uint32_t size) {
    // Verify size first
    if (((size % byteWidth_) != 0) || size < minSize_) throw rogue::GeneralError("Prbs::enable", "Invalid frame size");
 
    if (txThread_ == NULL) {
        txSize_   = size;
        threadEn_ = true;
        txThread_ = new std::thread(&Prbs::runThread, this);
 
        // Set a thread name
#ifndef __MACH__
        pthread_setname_np(txThread_->native_handle(), "PrbsTx");
#endif
    }
}
 
void ru::Prbs::disable() {
    if (txThread_ != NULL) {
        rogue::GilRelease noGil;
        threadEn_ = false;
        txThread_->join();
        delete txThread_;
        txThread_ = NULL;
    }
}
 
bool ru::Prbs::getRxEnable() {
    return rxEnable_;
}
 
void ru::Prbs::setRxEnable(bool en) {
    rogue::GilRelease noGil;
    pMtx_.lock();
    rxEnable_ = en;
    pMtx_.unlock();
}
 
uint32_t ru::Prbs::getRxErrors() {
    return (rxErrCount_);
}
 
uint32_t ru::Prbs::getRxCount() {
    return (rxCount_);
}
 
uint64_t ru::Prbs::getRxBytes() {
    return (rxBytes_);
}
 
uint32_t ru::Prbs::getTxErrors() {
    return (txErrCount_);
}
 
uint32_t ru::Prbs::getTxCount() {
    return (txCount_);
}
 
double ru::Prbs::getRxRate() {
    return rxRate_;
}
 
double ru::Prbs::getRxBw() {
    return rxBw_;
}
 
double ru::Prbs::getTxRate() {
    return txRate_;
}
 
uint32_t ru::Prbs::getTxPeriod() {
    return txPeriod_;
}
 
void ru::Prbs::setTxPeriod(uint32_t value) {
    txPeriod_ = value;
}
 
double ru::Prbs::getTxBw() {
    return txBw_;
}
 
uint64_t ru::Prbs::getTxBytes() {
    return (txBytes_);
}
 
void ru::Prbs::checkPayload(bool state) {
    checkPl_ = state;
}
 
void ru::Prbs::genPayload(bool state) {
    genPl_ = state;
}
 
// Counters should really be locked!
void ru::Prbs::resetCount() {
    pMtx_.lock();
    txErrCount_ = 0;
    txCount_    = 0;
    txBytes_    = 0;
    rxErrCount_ = 0;
    rxCount_    = 0;
    rxBytes_    = 0;
    pMtx_.unlock();
}
 
void ru::Prbs::genFrame(uint32_t size) {
    ris::FrameIterator frIter;
    ris::FrameIterator frEnd;
    uint32_t frSeq[MaxBytes / 4];
    uint32_t frSize[MaxBytes / 4];
    uint32_t wCount[MaxBytes / 4];
    uint8_t data[MaxBytes];
    double per;
    ris::FramePtr fr;
 
    rogue::GilRelease noGil;
    std::lock_guard<std::mutex> lock(pMtx_);
 
    // Verify size first
    if (((size % byteWidth_) != 0) || size < minSize_)
        throw rogue::GeneralError("Prbs::genFrame", "Invalid frame size");
 
    // Setup size
    memset(frSize, 0, MaxBytes);
    frSize[0] = (size / byteWidth_) - 1;
 
    // Setup sequence
    memset(frSeq, 0, MaxBytes);
    frSeq[0] = txSeq_;
 
    // Setup counter
    memset(wCount, 0, MaxBytes);
 
    // Get frame
    fr = reqFrame(size, true);
    fr->setPayload(size);
 
    frIter = fr->begin();
    frEnd  = frIter + size;
 
    // First word is sequence
    ris::toFrame(frIter, byteWidth_, frSeq);
    ++wCount[0];
 
    // Second word is size
    ris::toFrame(frIter, byteWidth_, frSize);
    ++wCount[0];
 
    if (genPl_) {
        // Init data
        std::memcpy(data, frSeq, byteWidth_);
 
        // Generate payload
        while (frIter != frEnd) {
            if (sendCount_) {
                ris::toFrame(frIter, byteWidth_, wCount);
            } else {
                flfsr(data);
                ris::toFrame(frIter, byteWidth_, data);
            }
            ++wCount[0];
        }
    }
 
    sendFrame(fr);
 
    // Update counters
    txSeq_++;
    txCount_++;
    txBytes_ += size;
 
    if ((per = updateTime(&lastTxTime_)) > 0.0) {
        txRate_      = static_cast<double>(txCount_ - lastTxCount_) / per;
        txBw_        = static_cast<double>(txBytes_ - lastTxBytes_) / per;
        lastTxCount_ = txCount_;
        lastTxBytes_ = txBytes_;
    }
}
 
void ru::Prbs::acceptFrame(ris::FramePtr frame) {
    ris::FrameIterator frIter;
    ris::FrameIterator frEnd;
    uint32_t frSeq[MaxBytes / 4];
    uint32_t frSize[MaxBytes / 4];
    uint32_t expSeq;
    uint32_t expSize;
    uint32_t size;
    uint32_t pos;
    uint32_t x;
    uint8_t expData[MaxBytes];
    double per;
    char debugA[10000];
    char debugB[1000];
 
    rogue::GilRelease noGil;
 
    while (!rxEnable_) usleep(10000);
 
    ris::FrameLockPtr fLock = frame->lock();
    std::lock_guard<std::mutex> lock(pMtx_);
 
    size   = frame->getPayload();
    frIter = frame->begin();
    frEnd  = frame->end();
 
    // Check for frame errors
    if (frame->getError()) {
        rxLog_->warning("Frame error field is set: 0x%" PRIx8, frame->getError());
        rxErrCount_++;
        return;
    }
 
    // Verify size
    if (((size % byteWidth_) != 0) || size < minSize_) {
        rxLog_->warning("Size violation size=%" PRIu32 ", count=%" PRIu32, size, rxCount_);
        rxErrCount_++;
        return;
    }
 
    // First word is sequence
    ris::fromFrame(frIter, byteWidth_, frSeq);
    expSeq = rxSeq_;
    rxSeq_ = frSeq[0] + 1;
 
    // Second word is size
    ris::fromFrame(frIter, byteWidth_, frSize);
    expSize = (frSize[0] + 1) * byteWidth_;
 
    // Check size and sequence
    // Accept any sequence if our local count is zero
    // incoming frames with seq = 0 never cause errors and treated as a restart
    if ((expSize != size) || (frSeq[0] != 0 && expSeq != 0 && frSeq[0] != expSeq)) {
        rxLog_->warning("Bad header. expSize=%" PRIu32 " gotSize=%" PRIu32 " expSeq=%" PRIu32 " gotSeq=%" PRIu32
                        " nxtSeq=%" PRIu32 " count=%" PRIu32,
                        expSize,
                        size,
                        expSeq,
                        frSeq[0],
                        rxSeq_,
                        rxCount_);
        rxErrCount_++;
        return;
    }
 
    // Is payload checking enabled
    if (checkPl_) {
        // Init data
        std::memcpy(expData, frSeq, byteWidth_);
        pos = 0;
 
        // Read payload
        while (frIter != frEnd) {
            flfsr(expData);
 
            if (!std::equal(frIter, frIter + byteWidth_, expData)) {
                snprintf(debugA,
                         sizeof(debugA),
                         "Bad value at index %" PRIu32 ". count=%" PRIu32 ", size=%" PRIu32,
                         pos,
                         rxCount_,
                         (size / byteWidth_) - 1);
 
                for (x = 0; x < byteWidth_; x++) {
                    snprintf(debugB,
                             sizeof(debugB),
                             "\n   %" PRIu32 ":%" PRIu32 " Got=0x%" PRIx8 " Exp=0x%" PRIx8,
                             pos,
                             x,
                             *(frIter + x),
                             *(expData + x));
                    snprintf(debugA + strlen(debugA), sizeof(debugA) - strlen(debugA), "%s", debugB);
                }
                rxLog_->warning(debugA);
                rxErrCount_++;
                return;
            }
            frIter += byteWidth_;
            ++pos;
        }
    }
 
    rxCount_++;
    rxBytes_ += size;
 
    if ((per = updateTime(&lastRxTime_)) > 0.0) {
        rxRate_      = static_cast<double>(rxCount_ - lastRxCount_) / per;
        rxBw_        = static_cast<double>(rxBytes_ - lastRxBytes_) / per;
        lastRxCount_ = rxCount_;
        lastRxBytes_ = rxBytes_;
    }
}
 
void ru::Prbs::setup_python() {
#ifndef NO_PYTHON
    // Keep the manual method docstrings, but suppress Boost.Python's generated
    // Python/C++ signatures. The autogenerated forms are not very readable in
    // the Sphinx Python API pages for exported C++ classes.
    bp::docstring_options doc_options(true, false, false);
 
    bp::class_<ru::Prbs, ru::PrbsPtr, bp::bases<ris::Master, ris::Slave>, boost::noncopyable>(
        "Prbs",
        "PRBS generator/checker that can act as both stream master and slave.\n\n"
        "The engine can generate deterministic pseudo-random frames and verify\n"
        "received frames for bit-error testing. It supports both one-shot frame\n"
        "generation and optional background transmit mode.",
        bp::init<>("Construct a PRBS generator/checker with default taps and width."))
        .def("genFrame", &ru::Prbs::genFrame, bp::args("size"), "Generate and transmit one PRBS frame.")
        .def("enable",
             &ru::Prbs::enable,
             bp::args("size"),
             "Enable periodic background PRBS frame generation using the configured TX period.")
        .def("disable", &ru::Prbs::disable, "Disable periodic background PRBS frame generation.")
        .def("setWidth", &ru::Prbs::setWidth, bp::args("width"), "Set the PRBS generator/checker width in bits.")
        .def("setTaps",
             &ru::Prbs::setTapsPy,
             bp::args("taps"),
             "Configure the PRBS LFSR tap positions from a bytes-like object.")
        .def("getRxEnable", &ru::Prbs::getRxEnable, "Return whether receive-side checking is enabled.")
        .def("setRxEnable", &ru::Prbs::setRxEnable, bp::args("state"), "Enable or disable receive-side checking.")
        .def("getRxErrors", &ru::Prbs::getRxErrors, "Return the receive-side error count.")
        .def("getRxCount", &ru::Prbs::getRxCount, "Return the total received frame count.")
        .def("getRxRate", &ru::Prbs::getRxRate, "Return the computed receive frame rate in frames/second.")
        .def("getRxBw", &ru::Prbs::getRxBw, "Return the computed receive bandwidth in bytes/second.")
        .def("getRxBytes", &ru::Prbs::getRxBytes, "Return the total received payload byte count.")
        .def("getTxErrors", &ru::Prbs::getTxErrors, "Return the transmit-side error count.")
        .def("getTxCount", &ru::Prbs::getTxCount, "Return the total transmitted frame count.")
        .def("getTxBytes", &ru::Prbs::getTxBytes, "Return the total transmitted payload byte count.")
        .def("getTxPeriod", &ru::Prbs::getTxPeriod, "Return the periodic transmit interval in microseconds.")
        .def("setTxPeriod",
             &ru::Prbs::setTxPeriod,
             bp::args("period"),
             "Set the periodic transmit interval in microseconds.")
        .def("getTxRate", &ru::Prbs::getTxRate, "Return the computed transmit frame rate in frames/second.")
        .def("getTxBw", &ru::Prbs::getTxBw, "Return the computed transmit bandwidth in bytes/second.")
        .def("checkPayload",
             &ru::Prbs::checkPayload,
             bp::args("state"),
             "Enable or disable PRBS payload checking on received frames.")
        .def("genPayload",
             &ru::Prbs::genPayload,
             bp::args("state"),
             "Enable or disable PRBS payload generation on transmitted frames.")
        .def("resetCount", &ru::Prbs::resetCount, "Reset transmit and receive counters.")
        .def("sendCount",
             &ru::Prbs::sendCount,
             bp::args("state"),
             "Enable or disable insertion of frame counters into generated payloads.");
 
    bp::implicitly_convertible<ru::PrbsPtr, ris::SlavePtr>();
    bp::implicitly_convertible<ru::PrbsPtr, ris::MasterPtr>();
#endif
}