1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
|
/* iemnet
*
* sender
* sends data "chunks" to a socket
* possibly threaded
*
* copyright (c) 2010 IOhannes m zmölnig, IEM
*/
/* This program 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 2 */
/* of the License, or (at your option) any later version. */
/* */
/* This program 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 this program; if not, write to the Free Software */
/* Foundation, Inc., */
/* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. */
/* */
#define DEBUGLEVEL 2
#include "iemnet.h"
#include "iemnet_data.h"
#include <string.h>
#include <stdio.h>
#include <stdlib.h>
#include <errno.h>
#include <sys/types.h>
#ifdef _WIN32
# include <winsock2.h>
# include <ws2tcpip.h> /* for socklen_t */
#else
# include <sys/socket.h>
#endif
#include <pthread.h>
#if IEMNET_HAVE_DEBUG
static int debug_lockcount=0;
# define LOCK(x) do {if(iemnet_debug(DEBUGLEVEL, __FILE__, __LINE__, __FUNCTION__))post(" LOCKing %p", x); pthread_mutex_lock(x);debug_lockcount++; if(iemnet_debug(DEBUGLEVEL, __FILE__, __LINE__, __FUNCTION__))post(" LOCKed %p[%d]", x, debug_lockcount); } while(0)
# define UNLOCK(x) do {debug_lockcount--;if(iemnet_debug(DEBUGLEVEL, __FILE__, __LINE__, __FUNCTION__))post(" UNLOCK %p [%d]", x, debug_lockcount); pthread_mutex_unlock(x);}while(0)
#else
# define LOCK(x) pthread_mutex_lock(x)
# define UNLOCK(x) pthread_mutex_unlock(x)
#endif
/* draft:
* - there is a sender thread for each open connection
* - the main thread just adds chunks to each sender threads processing queue
* - the sender thread tries to send the queue as fast as possible
*/
struct _iemnet_sender {
pthread_t thread;
int sockfd; /* owned outside; must call iemnet__sender_destroy() before freeing socket yourself */
t_iemnet_queue*queue;
int keepsending; // indicates whether we want to thread to continue or to terminate
int isrunning;
pthread_mutex_t mtx; /* mutex to protect isrunning,.. */
};
/* the workhorse of the family */
static int iemnet__sender_dosend(int sockfd, t_iemnet_queue*q) {
struct sockaddr_in to;
socklen_t tolen = sizeof(to);
t_iemnet_chunk*c=queue_pop_block(q);
if(c) {
unsigned char*data=c->data;
unsigned int size=c->size;
int result=-1;
// fprintf(stderr, "sending %d bytes at %x to %d\n", size, data, sockfd);
if(c->port) {
DEBUG("sending %d bytes to %x:%d", size, c->addr, c->port);
to.sin_addr.s_addr=htonl(c->addr);
to.sin_port =htons(c->port);
result = sendto(sockfd, data, size, 0, (struct sockaddr *)&to, tolen);
} else {
DEBUG("sending %d bytes", size);
result = send(sockfd, data, size, 0);
}
if(result<0) {
// broken pipe
return 0;
}
// shouldn't we do something with the result here?
DEBUG("sent %d bytes", result);
iemnet__chunk_destroy(c);
} else {
return 0;
}
return 1;
}
static void*iemnet__sender_sendthread(void*arg) {
t_iemnet_sender*sender=(t_iemnet_sender*)arg;
int sockfd=-1;
t_iemnet_queue*q=NULL;
LOCK(&sender->mtx);
sockfd=sender->sockfd;
q=sender->queue;
while(sender->keepsending) {
UNLOCK(&sender->mtx);
if(!iemnet__sender_dosend(sockfd, q)){
LOCK(&sender->mtx);
break;
}
LOCK(&sender->mtx);
}
sender->isrunning=0;
UNLOCK (&sender->mtx);
DEBUG("send thread terminated");
return NULL;
}
int iemnet__sender_send(t_iemnet_sender*s, t_iemnet_chunk*c) {
t_iemnet_queue*q=0;
int size=-1;
LOCK (&s->mtx);
q=s->queue;
if(!s->isrunning) {
UNLOCK (&s->mtx);
return -1;
}
UNLOCK (&s->mtx);
if(q) {
t_iemnet_chunk*chunk=iemnet__chunk_create_chunk(c);
size = queue_push(q, chunk);
}
return size;
}
void iemnet__sender_destroy(t_iemnet_sender*s) {
int sockfd=-1;
/* simple protection against recursive calls:
* s->keepsending is only set to "0" in here,
* so if it is false, we know that we are already being called
*/
DEBUG("destroy sender %x with queue %x (%d)", s, s->queue, s->keepsending);
LOCK (&s->mtx);
sockfd=s->sockfd;
// check s->isrunning
DEBUG("keepsending %d\tisrunning %d", s->keepsending, s->isrunning);
if(!s->keepsending) {
UNLOCK (&s->mtx);
return;
}
s->keepsending=0;
while(s->isrunning) {
s->keepsending=0;
queue_finish(s->queue);
UNLOCK (&s->mtx);
LOCK (&s->mtx);
}
UNLOCK (&s->mtx);
queue_finish(s->queue);
DEBUG("queue finished");
if(sockfd>=0) {
int err=shutdown(sockfd, 2); /* needed on linux, since the recv won't shutdown on sys_closesocket() alone */
sys_closesocket(sockfd);
}
pthread_join(s->thread, NULL);
DEBUG("thread joined");
queue_destroy(s->queue);
pthread_mutex_destroy (&s->mtx);
memset(s, 0, sizeof(t_iemnet_sender));
free(s);
s=NULL;
DEBUG("destroyed sender");
}
t_iemnet_sender*iemnet__sender_create(int sock) {
static pthread_mutex_t mtx = PTHREAD_MUTEX_INITIALIZER;
t_iemnet_sender*result=(t_iemnet_sender*)malloc(sizeof(t_iemnet_sender));
int res=0;
DEBUG("create sender %x", result);
if(NULL==result){
DEBUG("create sender failed");
return NULL;
}
result->queue = queue_create();
result->sockfd = sock;
result->keepsending =1;
result->isrunning=1;
DEBUG("create_sender queue=%x", result->queue);
memcpy(&result->mtx , &mtx, sizeof(pthread_mutex_t));
res=pthread_create(&result->thread, 0, iemnet__sender_sendthread, result);
if(0==res) {
} else {
// something went wrong
}
DEBUG("created sender");
return result;
}
int iemnet__sender_getlasterror(t_iemnet_sender*x) {
x=NULL;
#ifdef _WIN32
return WSAGetLastError();
#endif
return errno;
}
int iemnet__sender_getsockopt(t_iemnet_sender*s, int level, int optname, void *optval, socklen_t*optlen) {
int result=getsockopt(s->sockfd, level, optname, optval, optlen);
if(result!=0) {
post("%s: getsockopt returned %d", __FUNCTION__, iemnet__sender_getlasterror(s));
}
return result;
}
int iemnet__sender_setsockopt(t_iemnet_sender*s, int level, int optname, const void*optval, socklen_t optlen) {
int result=setsockopt(s->sockfd, level, optname, optval, optlen);
if(result!=0) {
post("%s: setsockopt returned %d", __FUNCTION__, iemnet__sender_getlasterror(s));
}
return result;
}
int iemnet__sender_getsize(t_iemnet_sender*x) {
int size=-1;
if(x && x->queue)
size=queue_getsize(x->queue);
return size;
}
|