//
//  cudpmsgsocket.cpp
//  xlxd
//
//  Created by Marius Petrescu (YO2LOJ) on 22/02/2020.
//  Copyright © 2020 Marius Petrescu (YO2LOJ). 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 "cudpmsgsocket.h"

////////////////////////////////////////////////////////////////////////////////////////
// open
bool CUdpMsgSocket::Open(uint16 uiPort)
{
    bool ret;
    int on = 1;

    ret = CUdpSocket::Open(uiPort);
    setsockopt(m_Socket, IPPROTO_IP, IP_PKTINFO, (char *)&on, sizeof(on));

    return ret;
}


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

int CUdpMsgSocket::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_MSG_BUFFER_LENMAX);

        //prepare msghdr
        bzero(&Msg, sizeof(Msg));
        Iov[0].iov_base = Buffer->data();
        Iov[0].iov_len = UDP_MSG_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;
}