XvcServer.cpp

Go to the documentation of this file.

 
#include "rogue/protocols/xilinx/XvcServer.h"
 
#include <arpa/inet.h>
#include <dlfcn.h>
#include <netinet/in.h>
#include <pthread.h>
#include <sys/select.h>
#include <sys/socket.h>
 
#include <cmath>
#include <string>
 
#include "rogue/protocols/xilinx/XvcConnection.h"
 
namespace rpx = rogue::protocols::xilinx;
 
rpx::XvcServer::XvcServer(uint16_t port, JtagDriver* drv, unsigned maxMsgSize) : drv_(drv), maxMsgSize_(maxMsgSize) {
    struct sockaddr_in a;
    int yes = 1;
 
    a.sin_family      = AF_INET;
    a.sin_addr.s_addr = INADDR_ANY;
    a.sin_port        = htons(port);
 
    if ((sd_ = ::socket(AF_INET, SOCK_STREAM, 0)) < 0)
        throw(rogue::GeneralError::create("XvcServer::XvcServer()", "Failed to create socket"));
 
    if (::setsockopt(sd_, SOL_SOCKET, SO_REUSEADDR, &yes, sizeof(yes)))
        throw(rogue::GeneralError::create("XvcServer::XvcServer()", "setsockopt(SO_REUSEADDR) failed"));
 
    if (::bind(sd_, (struct sockaddr*)&a, sizeof(a)))
        throw(rogue::GeneralError::create("XvcServer::XvcServer()", "Unable to bind Stream socket to local address"));
 
    if (::listen(sd_, 1)) throw(rogue::GeneralError::create("XvcServer::XvcServer()", "Unable to listen on socket"));
}
 
rpx::XvcServer::~XvcServer() {
    ::close(sd_);
}
 
void rpx::XvcServer::run(bool& threadEn, rogue::LoggingPtr log) {
    fd_set rset;
    int maxFd;
    int nready;
    struct timeval timeout;
 
    while (threadEn) {
        FD_ZERO(&rset);
        FD_SET(sd_, &rset);
 
        // 1 Second Timeout
        timeout.tv_sec  = 1;
        timeout.tv_usec = 0;
 
        nready = ::select(sd_ + 1, &rset, NULL, NULL, &timeout);
 
        if (nready > 0 && FD_ISSET(sd_, &rset)) {
            try {
                XvcConnection conn(sd_, drv_, maxMsgSize_);
                conn.run();
            } catch (rogue::GeneralError& e) {
                log->debug("Sub-connection failed");
            }
        }
    }
}