socket.c 6.07 KB
Newer Older
1
2
3
4
5
#include <netdb.h>
#include <stdio.h>
#include <string.h>
#include <unistd.h>
#include <arpa/inet.h>
6
#include <stdlib.h>
7
#include <pthread.h>
8
#include "../defines.h"
9
#include "socket.h"
10
11
#include "feedback_receiver.h"
#include "data_transmitter.h"
12
13

int prrt_create_socket(prrt_socket *sock_ptr, uint16_t port, uint8_t is_sender) {
14
    // Create Data Socket
15
    if((sock_ptr->fd_data = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
16
17
18
19
20
21
22
23
24
25
26
        perror("cannot create socket");
        return -1;
    }

    // Bind Data Socket
    struct sockaddr_in address;
    memset((char*) &address, 0, sizeof(address));
    address.sin_family = AF_INET;
    address.sin_addr.s_addr = htonl(INADDR_ANY);
    address.sin_port = htons(port);

27
    if(bind(sock_ptr->fd_data, (struct sockaddr *) &address, sizeof(address)) < 0) {
28
29
30
31
32
        perror("cannot bind socket");
        return -1;
    }

    // Create Feedback Socket
33
    if((sock_ptr->fd_feedback = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
34
35
36
37
38
39
40
41
42
43
        perror("cannot create socket");
        return -1;
    }

    // Bind Feedback Socket
    memset((char*) &address, 0, sizeof(address));
    address.sin_family = AF_INET;
    address.sin_addr.s_addr = htonl(INADDR_ANY);
    address.sin_port = htons((uint16_t) (port + 1)); // TODO: fail if port is 65535

44
    if(bind(sock_ptr->fd_feedback, (struct sockaddr *) &address, sizeof(address)) < 0) {
45
46
47
48
        perror("cannot bind socket");
        return -1;
    }

49
    if(is_sender) {
50
51
52
53
        pthread_mutex_init(&sock_ptr->is_data_available, NULL);
        pthread_cond_init(&sock_ptr->is_data_available_cv, NULL);

        int rc = pthread_create(&sock_ptr->receive_thread, NULL, receive_feedback_loop, (void *) sock_ptr);
54
55
56
57
58
        if(rc) {
            printf("ERROR; return code from pthread_create() is %d\n", rc);
            exit(-1);
        }

59
60
61
62
63
        rc = pthread_create(&sock_ptr->send_thread, NULL, send_data_loop, (void *) sock_ptr);
        if(rc) {
            printf("ERROR; return code from pthread_create() is %d\n", rc);
            exit(-1);
        }
64
65
66
67
    } else {

    }

68
69
70
    return 0;
}

71
72
int prrt_connect(prrt_socket *sock_ptr, char *host, uint16_t port) {
    prrt_receiver recv =  { host , port};
73

74
75
76
77
78
79
    if(sock_ptr->receiver_len < PRRT_MAX_RECEIVER_COUNT) {
        sock_ptr->receivers[sock_ptr->receiver_len] =recv;
        sock_ptr->receiver_len++;
    } else {
        return -1;
    }
80
81
82
83

    return 0;
}

84
int prrt_send(prrt_socket *sock_ptr, const void *data, size_t data_len) {
85
86
87
88
89
90
91
92
93
94
95

    pthread_mutex_lock(&sock_ptr->is_data_available);

    sock_ptr->packets_count++;
    printf("ADDING (NOW: %d)\n", sock_ptr->packets_count);
    pthread_cond_signal(&sock_ptr->is_data_available_cv);

    // TODO: add a packet to the list

    pthread_mutex_unlock(&sock_ptr->is_data_available);

96
97
98
    int res = 0;
    prrt_packet* packet = malloc(sizeof(prrt_packet));
    create_packet_data(packet, 5, data, data_len);
99
100

    uint8_t buf[MAX_PAYLOAD_LENGTH];
101
102
    uint32_t length = packet_size(packet);
    if(encode_packet(buf, MAX_PAYLOAD_LENGTH, packet) < 0) {
103
104
105
106
        perror("BUF too small.");
        return -1;
    }

107
    // SENDING TO ALL RECEIVERS
108
109
110
    int i;
    for(i = 0; i < sock_ptr->receiver_len; i++) {
        prrt_receiver recv = sock_ptr->receivers[i];
111

112
        struct hostent *hp;
113

114
115
116
117
        struct sockaddr_in targetaddr;
        memset((char*) &targetaddr, 0, sizeof(targetaddr));
        targetaddr.sin_family = AF_INET;
        targetaddr.sin_port = htons(recv.port);
118

119
120
        hp = gethostbyname(recv.host_name);
        memcpy((void *)&targetaddr.sin_addr, hp->h_addr_list[0], (size_t) hp->h_length);
121

122
        if((sendto(sock_ptr->fd_data, buf, length, 0, (struct sockaddr *) &targetaddr, sizeof(targetaddr)) < 0)) {
123
            perror("sendto failed");
124
125
            res = -1;
            break;
126
        }
127
    }
128
129
    delete_packet(packet);
    return res;
130
131
}

132
133
134
prrt_packet *prrt_recv(prrt_socket *sock_ptr) {
    unsigned char buffer[MAX_PAYLOAD_LENGTH];

135
136
137
138
139
    // RECEIVE DATA
    ssize_t n;
    struct sockaddr_in remote;
    socklen_t addrlen = sizeof(remote);

140
    n = recvfrom(sock_ptr->fd_data, buffer, MAX_PAYLOAD_LENGTH, 0, (struct sockaddr *) &remote, &addrlen);
141
142
143
    uint16_t remote_port = ntohs(remote.sin_port);
    char *remote_host = inet_ntoa(remote.sin_addr);

144
    prrt_packet *packet = malloc(sizeof(prrt_packet));
145
    decode_packet(buffer, (uint16_t) n, packet);
146
147
148
149
150

    // REPLY
    struct sockaddr_in targetaddr;
    memset((char*) &targetaddr, 0, sizeof(targetaddr));
    targetaddr.sin_family = AF_INET;
151
    targetaddr.sin_port = htons((uint16_t) (remote_port + 1));
152
153
154

    struct hostent *hp;
    hp = gethostbyname(remote_host);
155
    memcpy((void *)&targetaddr.sin_addr, hp->h_addr_list[0], (size_t) hp->h_length);
156

157
    prrt_packet* feedback_pkt_ptr = create_packet_feedback(0, 19, 4715, 7, 3, 50, 4, 6, 8, 9, 5, 1);
158
159
160
161
162
163
164
165
166
167
168
    uint8_t buf[MAX_PAYLOAD_LENGTH];
    uint32_t length = packet_size(feedback_pkt_ptr);

    if(encode_packet(buf, MAX_PAYLOAD_LENGTH, feedback_pkt_ptr) < 0) {
        perror("BUF too small.");
    } else {
        if((sendto(sock_ptr->fd_feedback, buf, length, 0, (struct sockaddr *) &targetaddr, sizeof(targetaddr)) < 0)) {
            perror("sendto failed");
            return NULL;
        }

169
    }
170
    return packet;
171
172
}

173
int prrt_close_socket(prrt_socket *sock_ptr) {
174
175
    // TODO: shut down threads;

176
177
    // TODO: clean up all receivers

178
179
180
    pthread_mutex_destroy(&sock_ptr->is_data_available);
    pthread_cond_destroy(&sock_ptr->is_data_available_cv);

181
182
    close(sock_ptr->fd_data);
    close(sock_ptr->fd_feedback);
183
184
185
    return 0;
}

186
prrt_packet * prrt_recv_feedback(prrt_socket *sock_ptr, void *bufin, size_t length) {
187
188
189
190
    ssize_t n;
    struct sockaddr_in remote;
    socklen_t addrlen = sizeof(remote);

191
    n = recvfrom(sock_ptr->fd_feedback, bufin, length, 0, (struct sockaddr *) &remote, &addrlen);
192
    if(n < 0) {
193
        perror("RECVFROM FAIL");
194
195
        return NULL;
    }
196
197
    uint16_t remote_port = ntohs(remote.sin_port);
    char *remote_host = inet_ntoa(remote.sin_addr);
198
    printf("RECV FEEDBACK: %s:%d\n", remote_host, remote_port);
199

200
201
202
    prrt_packet * packet_ptr = malloc(sizeof(prrt_packet));
    decode_packet(bufin, (uint16_t) n, packet_ptr);
    return packet_ptr;
203
}