xlxd/src/cudpsocket.cpp

//
//  cudpsocket.cpp
//  xlxd
//
//  Created by Jean-Luc Deltombe (LX3JL) on 31/10/2015.
//  Copyright © 2015 Jean-Luc Deltombe (LX3JL). All rights reserved.
//
// ----------------------------------------------------------------------------
//    This file is part of xlxd.
//
//    xlxd is free software: you can redistribute it and/or modify
//    it under the terms of the GNU General Public License as published by
//    the Free Software Foundation, either version 3 of the License, or
//    (at your option) any later version.
//
//    xlxd is distributed in the hope that it will be useful,
//    but WITHOUT ANY WARRANTY; without even the implied warranty of
//    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
//    GNU General Public License for more details.
//
//    You should have received a copy of the GNU General Public License
//    along with Foobar.  If not, see <http://www.gnu.org/licenses/>. 
// ----------------------------------------------------------------------------

#include "main.h"
#include <string.h>
#include "creflector.h"
#include "cudpsocket.h"


////////////////////////////////////////////////////////////////////////////////////////
// constructor

CUdpSocket::CUdpSocket()
{
    m_Socket = -1;
}

////////////////////////////////////////////////////////////////////////////////////////
// destructor

CUdpSocket::~CUdpSocket()
{
    if ( m_Socket != -1 )
    {
        Close();
    }
}

////////////////////////////////////////////////////////////////////////////////////////
// open & close

bool CUdpSocket::Open(uint16 uiPort)
{
    bool open = false;
    int on = 1;
    
    // create socket
    m_Socket = socket(PF_INET,SOCK_DGRAM,0);
    if ( m_Socket != -1 )
    {
        // initialize sockaddr struct
        ::memset(&m_SocketAddr, 0, sizeof(struct sockaddr_in));
        m_SocketAddr.sin_family = AF_INET;
        m_SocketAddr.sin_port = htons(uiPort);
        m_SocketAddr.sin_addr.s_addr = inet_addr(g_Reflector.GetListenIp());
        
        if ( bind(m_Socket, (struct sockaddr *)&m_SocketAddr, sizeof(struct sockaddr_in)) == 0 )
        {
            fcntl(m_Socket, F_SETFL, O_NONBLOCK);
            setsockopt(m_Socket, IPPROTO_IP, IP_PKTINFO, (char *)&on, sizeof(on));
            open = true;
        }
        else
        {
            close(m_Socket);
            m_Socket = -1;
        }
    }
    
    // done
    return open;
}

void CUdpSocket::Close(void)
{
    if ( m_Socket != -1 )
    {
        close(m_Socket);
        m_Socket = -1;
    }
}

////////////////////////////////////////////////////////////////////////////////////////
// read

int CUdpSocket::Receive(CBuffer *Buffer, CIp *Ip, int timeout)
{
    struct sockaddr_in Sin;
    fd_set FdSet;
    unsigned int uiFromLen = sizeof(struct sockaddr_in);
    int iRecvLen = -1;
    struct timeval tv;

    struct msghdr Msg;
    struct iovec Iov[1];

    union {
         struct cmsghdr cm;
         unsigned char pktinfo_sizer[sizeof(struct cmsghdr) + sizeof(struct in_pktinfo)];
    } Control;

    // socket valid ?
    if ( m_Socket != -1 )
    {
        // allocate buffer
        Buffer->resize(UDP_BUFFER_LENMAX);

        //prepare msghdr
        bzero(&Msg, sizeof(Msg));
        Iov[0].iov_base = Buffer->data();
        Iov[0].iov_len = UDP_BUFFER_LENMAX;

        bzero(&Sin, sizeof(Sin));
        Msg.msg_name = &Sin;
        Msg.msg_namelen = sizeof(Sin);
        Msg.msg_iov = Iov;
        Msg.msg_iovlen = 1;
        Msg.msg_control = &Control;
        Msg.msg_controllen = sizeof(Control);

        // control socket
        FD_ZERO(&FdSet);
        FD_SET(m_Socket, &FdSet);
        tv.tv_sec = timeout / 1000;
        tv.tv_usec = (timeout % 1000) * 1000;
        select(m_Socket + 1, &FdSet, 0, 0, &tv);
        
        // read
        iRecvLen = (int)recvmsg(m_Socket, &Msg, 0);
        
        // handle
        if ( iRecvLen != -1 )
        {
            // adjust buffer size
            Buffer->resize(iRecvLen);
            
            // get IP
            Ip->SetSockAddr(&Sin);

            // get local IP
            struct cmsghdr *Cmsg;
            for (Cmsg = CMSG_FIRSTHDR(&Msg); Cmsg != NULL; Cmsg = CMSG_NXTHDR(&Msg, Cmsg))
            {
                if (Cmsg->cmsg_level == IPPROTO_IP && Cmsg->cmsg_type == IP_PKTINFO)
                {
                    struct in_pktinfo *PktInfo = (struct in_pktinfo *)CMSG_DATA(Cmsg);
                    m_LocalAddr.s_addr = PktInfo->ipi_spec_dst.s_addr;
                }
            }
        }
    }
 
    // done
    return iRecvLen;
}

////////////////////////////////////////////////////////////////////////////////////////
// write

int CUdpSocket::Send(const CBuffer &Buffer, const CIp &Ip)
{
    CIp temp(Ip);
    return (int)::sendto(m_Socket,
           (void *)Buffer.data(), Buffer.size(),
           0, (struct sockaddr *)temp.GetSockAddr(), sizeof(struct sockaddr_in));
}

int CUdpSocket::Send(const char *Buffer, const CIp &Ip)
{
    CIp temp(Ip);
    return (int)::sendto(m_Socket,
           (void *)Buffer, ::strlen(Buffer),
           0, (struct sockaddr *)temp.GetSockAddr(), sizeof(struct sockaddr_in));
}

int CUdpSocket::Send(const CBuffer &Buffer, const CIp &Ip, uint16 destport)
{
    CIp temp(Ip);
    temp.GetSockAddr()->sin_port = htons(destport);
    return (int)::sendto(m_Socket,
                         (void *)Buffer.data(), Buffer.size(),
                         0, (struct sockaddr *)temp.GetSockAddr(), sizeof(struct sockaddr_in));
}

int CUdpSocket::Send(const char *Buffer, const CIp &Ip, uint16 destport)
{
    CIp temp(Ip);
    temp.GetSockAddr()->sin_port = htons(destport);
    return (int)::sendto(m_Socket,
                         (void *)Buffer, ::strlen(Buffer),
                         0, (struct sockaddr *)temp.GetSockAddr(), sizeof(struct sockaddr_in));
}