#include <arpa/inet.h>
#include <netinet/in.h>
#include <stdio.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include <sys/select.h>
#include <errno.h>
#include <fcntl.h>
#include <signal.h>

char buf[4096];
int alarm_time = 60;

void init_address(struct sockaddr_in *sa, const char* host, int port) {
    memset((char *) sa, 0, sizeof(*sa));
    sa->sin_family = AF_INET;
    sa->sin_port = htons(port);
    if (inet_aton(host, &sa->sin_addr)==0) {
        perror("inet_aton");
    }
}

int s1;
int s2;


char tcp_buffer[4096];
int tcp_offset = -1;
int tcp_packet_size = 0;

struct sockaddr_in peer2;

int udp_socket(int port) {
    int s2;
    struct sockaddr_in si_me;

    if ((s2=socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP))==-1) {
        perror("socket");
        return -1;
    }
 
    // si_me stores our local endpoint. Remember that this program
    // has to be run in a network with UDP endpoint previously known
    // and directly accessible by all clients. In simpler terms, the
    // server cannot be behind a NAT.
    memset((char *) &si_me, 0, sizeof(si_me));
    si_me.sin_family = AF_INET;
    si_me.sin_port = htons(port);
    si_me.sin_addr.s_addr = htonl(INADDR_ANY);
    if (bind(s2, (struct sockaddr*)(&si_me), sizeof(si_me))==-1) {
        perror("bind");
        return -1;
    }
    return s2;
}


int tcp_socket(const char* host, int port) {
    int s2;
    struct sockaddr_in si_me;

    if ((s2=socket(AF_INET, SOCK_STREAM, IPPROTO_TCP))==-1) {
        perror("socket");
        return -1;
    }
 
    tcp_offset = -1;
    
    memset((char *) &si_me, 0, sizeof(si_me));
    si_me.sin_family = AF_INET;
    si_me.sin_port = htons(port);
    si_me.sin_addr.s_addr = inet_addr(host);
    if (connect(s2, (struct sockaddr*)(&si_me), sizeof(si_me))==-1) {
        perror("connect");
        return -1;
    }
    
    fcntl(s2, F_SETFL, O_NONBLOCK);
    
    return s2;
}

int ping_not_replied = 0;


char* host1;
int port1;

void alarm_handler() { 
    if (ping_not_replied || s1 == -1) {
        close(s1);
        write(1, "t", 1);
        s1 =  tcp_socket(host1, port1);
        write(1, "c", 1);        
    }
    int ret = send(s1, "\xFF\xFF", 2, 0);
    if (ret != 2) {
        close(s1);
        write(1, "T", 1);
        s1 =  tcp_socket(host1, port1); 
        write(1, "c", 1);
    }
    ping_not_replied = 1;
    //sendto(s2, "", 0, 0, (struct sockaddr*)(&peer2), sizeof(peer2));
    alarm(alarm_time);    
}

int main(int argc, char* argv[])
{
    if (argc<3) {
        fprintf(stderr, "Usage: udppair_client host1 port host2:port2 port3 host4:port4 ...\n");
        return 1;
    }
    host1 = argv[1];
    port1 = atoi(argv[2]);
    
    int portcount = argc-3;
    
    int ports[256];
    int sockets[256];
    struct sockaddr_in peers[256];
    int i;    
    for(i=0; i<portcount; ++i) {
        char* arg = argv[i+3];
        if(strchr(arg, ':') == NULL) {
            ports[i]=atoi(arg);
            sockets[i]=udp_socket(ports[i]);
            fcntl(sockets[i], F_SETFL, O_NONBLOCK);
            memset((char *) &peers[i], 0, sizeof(peers[i]));
        } else {
            ports[i]=0;
            sockets[i]=udp_socket(0);
            fcntl(sockets[i], F_SETFL, O_NONBLOCK);
            char* sep = strchr(arg, ':');
            *sep='\0';
            init_address(&peers[i], arg, atoi(sep+1));
        }
    }

    if(getenv("UDPPAIR_PERIOD")) {
        alarm_time = atoi(getenv("UDPPAIR_PERIOD"));
    }

    s1 = tcp_socket(host1, port1);
    write(1, "c", 1);

    struct sigaction siga = {{alarm_handler}};
    sigaction(SIGALRM, &siga, NULL);
    alarm_handler();

    fd_set rfds;

    for(;;) {
select_repeat:

        FD_ZERO(&rfds);
        if(s1!=-1) {
            FD_SET(s1, &rfds);
        }
        int maxfd = s1;
        for(i=0; i<portcount; ++i) {
            FD_SET(sockets[i], &rfds);
            if (maxfd < sockets[i]) maxfd = sockets[i];
        }
        int ret = select(maxfd+1, &rfds, NULL, NULL, NULL);

        if(ret==-1) {
            if(errno==EINTR  || errno==EAGAIN) goto select_repeat;
            perror("select");
            return 2;
        }
        
        if(FD_ISSET(s1, &rfds)) {
            if (tcp_offset == -1) {
                unsigned short int packetlen;
                ret = recv(s1, &packetlen, 2, 0);
                if (ret!=2) {
                    close(s1);
                    write(1, "x", 1);
                    s1 =  tcp_socket(host1, port1); 
                    write(1, "c", 1);
                }
                packetlen = ntohs(packetlen);
                
                if (packetlen == 0xFFFF) {
                    ping_not_replied = 0;
                    write(1, "p", 1);
                    continue;
                } 
                
                tcp_packet_size = packetlen;
                tcp_offset = 0;
            } else {
                ret = recv(s1, tcp_buffer+tcp_offset, tcp_packet_size-tcp_offset, 0);
                
                if(ret==0 || (ret == -1 && errno != EAGAIN && errno != EINTR)) {
                    close(s1);
                    write(1, "X", 1);
                    s1 =  tcp_socket(host1, port1); 
                    write(1, "c", 1);
                    continue;
                } 
                tcp_offset += ret;
                
                if(tcp_offset == tcp_packet_size) {
                    tcp_offset = -1;
                    write(1, "}", 1);
                    write(1, tcp_buffer, 1);
                    int i = (((unsigned char)tcp_buffer[0])-'0')%256;
                    int slen = sizeof peer2;
                    ret = sendto(sockets[i], tcp_buffer+1, tcp_packet_size-1, 0, (struct sockaddr*)(&peers[i]), slen);
                    if (ret==-1) {
                        perror("sendto");
                    } else {
                    }
                }
            }
        }
        for(i=0; i<portcount; ++i) {
        if(FD_ISSET(sockets[i], &rfds)) {
            socklen_t slen = sizeof(peer2);
            struct sockaddr_in tmpaddr;
            struct sockaddr* addrptr = (struct sockaddr*)&peers[i];
            if(!ports[i]) addrptr =  (struct sockaddr*)&tmpaddr; // don't allow override this address
            ret = recvfrom(sockets[i], buf+1, sizeof(buf), 0, addrptr, &slen);
            if(ret==-1) {
                perror("recvfrom");
                return 4;
            }
            if(ret) {
                buf[0] = (i+'0')%256;
                
                int packetlen = ret+1;
                unsigned short int packetlen_b = htons(packetlen);
                ret = send(s1, &packetlen_b, 2, 0);
                if (ret!=2) {
                    close(s1);
                    write(1, "S", 1);
                    s1 =  tcp_socket(host1, port1); 
                    write(1, "c", 1);
                    continue;
                }
                
                ret = send(s1, buf, packetlen, 0);
                if (ret!=packetlen) {
                    close(s1);
                    write(1, "s", 1);
                    s1 =  tcp_socket(host1, port1); 
                    write(1, "c", 1);
                } else {
                    write(1, "{", 1);
                    write(1, buf, 1);
                }
            }
        }
        }
    }    
}