mapiipc.c 10.3 KB
Newer Older
Arne Øslebø's avatar
Arne Øslebø committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <errno.h>
#include <sys/ipc.h>
#include <sys/msg.h>
#include <sys/socket.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/un.h>
#include <string.h>
#include <errno.h>

#include "mapiipc.h"
#include "debug.h"

#define HAVE_MSGHDR_MSG_CONTROL 1

19
20
21
22
23
24
25
#ifdef DIMAPI
#include <netdb.h>
#include <netinet/in.h>
#include <semaphore.h>
#include "flist.h"
#endif

Arne Øslebø's avatar
Arne Øslebø committed
26
27
// this file contains all the client-side IPC related functions

's avatar
   
committed
28
29
30
static int sock;
static int mapidaddr_len;
static struct sockaddr_un mapidaddr;
's avatar
committed
31
//static struct sockaddr_un fromaddr;
's avatar
committed
32
static char* mapidsocket;
Arne Øslebø's avatar
Arne Øslebø committed
33

's avatar
committed
34
int mapiipc_write(struct mapiipcbuf *qbuf)
Arne Øslebø's avatar
Arne Øslebø committed
35
36
37
38
39
40
//Sends an IPC message to mapid
{
  qbuf->uid=getuid();
  if(send(sock, qbuf, sizeof(struct mapiipcbuf), 0) == -1) {
    WARNING_CMD(printf("send: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
    //    exit(1);
's avatar
committed
41
    return -1;
Arne Øslebø's avatar
Arne Øslebø committed
42
  }
's avatar
committed
43
  return 0;
Arne Øslebø's avatar
Arne Øslebø committed
44
45
}

's avatar
committed
46
int mapiipc_read(struct mapiipcbuf *qbuf)
Arne Øslebø's avatar
Arne Øslebø committed
47
48
49
50
//Reads an IPC message. Blocking call
{
  if(recv(sock, qbuf, MAX_SEND_SIZE, 0) == -1){
    ERROR_CMD(printf("recv: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
's avatar
committed
51
52
    //exit(1);
    return -1;
Arne Øslebø's avatar
Arne Øslebø committed
53
  }
's avatar
committed
54
  return 0;
Arne Øslebø's avatar
Arne Øslebø committed
55
56
}

's avatar
committed
57
int mapiipc_client_init()
Arne Øslebø's avatar
Arne Øslebø committed
58
59
60
61
//Initializes IPC for mapi functions
{
  if ((sock = socket(AF_LOCAL, SOCK_STREAM, 0)) == -1) {
    ERROR_CMD(printf("socket: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
's avatar
committed
62
63
    //exit(1);
    return -1;
Arne Øslebø's avatar
Arne Øslebø committed
64
  }
's avatar
committed
65
66
67

  mapidsocket=malloc(sizeof(MAPIDSOCKHOME)-2+strlen(getenv("HOME")));
  sprintf(mapidsocket,MAPIDSOCKHOME,getenv("HOME")); 
Arne Øslebø's avatar
Arne Øslebø committed
68
69
70

  // Construct name of mapid's socket
  mapidaddr.sun_family = AF_LOCAL;
's avatar
committed
71
  strcpy(mapidaddr.sun_path, mapidsocket);
Arne Øslebø's avatar
Arne Øslebø committed
72
73
  mapidaddr_len = sizeof mapidaddr.sun_family + strlen(mapidaddr.sun_path);

's avatar
committed
74
  if (connect(sock, (struct sockaddr *)&mapidaddr, mapidaddr_len) < 0) 
's avatar
   
committed
75
  {
's avatar
committed
76
	//	ERROR_CMD(printf("connect: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
's avatar
committed
77
78
79
80
81
82
83
      free(mapidsocket);
      mapidsocket=strdup(MAPIDSOCKGLOBAL);
      strcpy(mapidaddr.sun_path, mapidsocket);
      mapidaddr_len = sizeof mapidaddr.sun_family + strlen(mapidaddr.sun_path);
      if (connect(sock, (struct sockaddr *)&mapidaddr, mapidaddr_len) < 0)
    	ERROR_CMD(printf("connect: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
      else
's avatar
committed
84
85
      //exit(EXIT_FAILURE);
      return -1;
's avatar
   
committed
86
  }
's avatar
committed
87
  free(mapidsocket);
's avatar
committed
88
  return 0;
Arne Øslebø's avatar
Arne Øslebø committed
89
90
91
92
93
94
95
96
}

void mapiipc_client_close()
//Releases socket resources
{
  close(sock);
}

97
98
99
100
#ifdef DIMAPI
struct sockaddr_in remoteaddr;
flist_t *remote_flowlist=NULL;

's avatar
committed
101
int mapiipc_remote_write(struct dmapiipcbuf *dbuf, struct host *h)
102
103
104
105
106
107
//Sends an IPC message to mapid
{
//  qbuf->uid=getuid(); 
  if(send(h->sockfd, dbuf, dbuf->length, 0) == -1) {
    WARNING_CMD(printf("send: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
    //    exit(1);
's avatar
committed
108
    return -1;
109
  }
's avatar
committed
110
  return 0;
111
112
}

's avatar
committed
113
int mapiipc_remote_write_to_all(remote_flowdescr_t* rflow)
114
115
116
{
  host_flow* hflow;
  flist_node_t* fnode;
's avatar
committed
117

118
  pthread_mutex_lock(&rflow->mutex);
's avatar
committed
119
  rflow->pending_msgs=0;
120
121
122
  for (fnode=flist_head(rflow->host_flowlist); fnode!=NULL; fnode=flist_next(fnode)) {
    hflow=(host_flow*)fnode->data;
    hflow->dbuf->fd=hflow->fd;
's avatar
fix    
committed
123
    if (mapiipc_remote_write(hflow->dbuf, hflow->rhost)<0) return -1;
124
125
126
127
    rflow->pending_msgs++;
  }
  pthread_mutex_unlock(&rflow->mutex);
  sem_wait(&rflow->fd_sem);
's avatar
committed
128
  return 0;
129
130
131
132
}

void *mapiipc_comm_thread(void *host) {
//Reads an IPC message. Blocking call
's avatar
committed
133
  char buffer[DIMAPI_DATA_SIZE];
134
135
136
137
138
  struct dmapiipcbuf* dbuf;
  remote_flowdescr_t* rflow;
  host_flow* hflow;
  int recv_bytes;
  unsigned int dbuf_bytes=0;
's avatar
committed
139
  int pending;
's avatar
committed
140
  int sockfd=((struct host *)host)->sockfd;
141
	
142
  dbuf=(struct dmapiipcbuf*)&buffer[0];
143
144
145

  while (1) {

's avatar
fix    
committed
146
    if (dbuf_bytes==0 || (dbuf->length<DIMAPI_DATA_SIZE && dbuf_bytes<dbuf->length)) {
's avatar
committed
147
148
149
      if (host==NULL) return NULL;
      recv_bytes=recv(sockfd, (char*)&buffer+dbuf_bytes, DIMAPI_DATA_SIZE, 0);
      if (recv_bytes == -1) {
150
	//ERROR_CMD(printf("recv: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
's avatar
committed
151
	//exit(1);
's avatar
committed
152
	//printf("error in recv\n");
153
154
	continue ;
      }
's avatar
committed
155
156
157
158
159
      else if (recv_bytes == 0) {
	//printf("Socket closed\n");
	//exit(1);
	return NULL;
      }
160
161
162
163
164
165
166
167
168
169

      dbuf_bytes += recv_bytes; 
    }

    if (dbuf_bytes<dbuf->length) continue;


    hflow=(host_flow*)flist_get( ((struct host*)host)->flows, dbuf->fd );
    if (hflow!=NULL) {
      rflow=flist_get(remote_flowlist, hflow->scope_fd);
's avatar
   
committed
170
171
      if (dbuf->cmd==GET_NEXT_PKT_ACK) {
		memcpy(hflow->pkt, dbuf->data, dbuf->length-BASIC_SIZE);
's avatar
committed
172
173
		flist_append(rflow->pkt_list, 0, hflow);
		sem_post(&rflow->pkt_sem);
's avatar
   
committed
174
175
176
177
178
      }
      else {
	memcpy( hflow->dbuf, dbuf, dbuf->length );	//place data
	pthread_mutex_lock(&rflow->mutex);
	//if (rflow->pending_msgs>0) {
179
	--rflow->pending_msgs;
's avatar
committed
180
	pending=rflow->pending_msgs;
181
182
	pthread_mutex_unlock(&rflow->mutex);

's avatar
committed
183
	if ( pending==0 ) {
184
185
	  sem_post( &rflow->fd_sem );
	}
's avatar
   
committed
186
187
      	//}
	//else pthread_mutex_unlock(&rflow->mutex);
188
189
190
      }
    }
    else {
's avatar
committed
191
192
      printf("Invalid IPC message, unknown fd %d\n",dbuf->fd);
      //exit(-1);
193
      //failure
's avatar
committed
194
      continue;
195
196
197
198
199
200
201
202
    }

    dbuf_bytes=dbuf_bytes-dbuf->length;
    memcpy(buffer,buffer+dbuf->length,dbuf_bytes);
  }
}


's avatar
committed
203
int mapiipc_remote_init(struct host *h)
204
205
//Initializes IPC for dmapi functions
{
's avatar
committed
206
207
  struct hostent* host=gethostbyname(h->hostname);
  struct timeval tv;
208
209
210

  if ((h->sockfd = socket(AF_INET, SOCK_STREAM, 0)) == -1) {
    ERROR_CMD(printf("socket: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
's avatar
committed
211
212
    //exit(-1);
    return -1;
's avatar
committed
213
214
  }

's avatar
fix    
committed
215
  /*
216
  tv.tv_sec=20;		//timeout 20 sec for recv
's avatar
committed
217
218
219
220
221
  tv.tv_usec=0;

  if (setsockopt(h->sockfd, SOL_SOCKET, SO_RCVTIMEO, &tv, sizeof(struct timeval)) == -1) {
    close(h->sockfd);
    printf("Unexpected error on setsockopt()");
's avatar
committed
222
223
    //exit(-1);
    return -1;
's avatar
committed
224
  }
's avatar
fix    
committed
225
  */
226

's avatar
committed
227
228
229
230
231
232
  tv.tv_sec=10;		//timeout 10 sec for send
  tv.tv_usec=0;

  if (setsockopt(h->sockfd, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(struct timeval)) == -1) {
    close(h->sockfd);
    printf("Unexpected error on setsockopt()");
's avatar
committed
233
234
    //exit(-1);
    return -1;
's avatar
committed
235
236
237
238
  }

  if (host==NULL) {
    printf("Could not determine address for %s\n",h->hostname);
's avatar
committed
239
240
    //exit(1);
    return -1;
241
  }
's avatar
committed
242

243
244
  // Construct name of dmapid's socket
  remoteaddr.sin_family = AF_INET;
's avatar
committed
245
  remoteaddr.sin_addr = *((struct in_addr *)host->h_addr);
246
247
248
  remoteaddr.sin_port = htons(h->port);

  if (connect(h->sockfd, (struct sockaddr *)&remoteaddr, sizeof(remoteaddr)) < 0) {     
's avatar
committed
249
    ERROR_CMD(printf("connect failed: %s [%s:%d]\n",strerror(errno),__FILE__,__LINE__));
's avatar
committed
250
251
    //exit(EXIT_FAILURE);
    return -1;
252
  }
's avatar
committed
253
  return 0;
's avatar
committed
254

255
256
257
258
259
}

void mapiipc_remote_close(struct host *h)
//Releases socket resources
{
's avatar
committed
260
  shutdown(h->sockfd, SHUT_RDWR);
261
262
263
264
  close(h->sockfd);
}
#endif

Arne Øslebø's avatar
Arne Øslebø committed
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292

// Helper functions for function arguments retrieval
int getargint(mapiFunctArg **pos){
	int i;
	i = *((int *)(*pos));
	//	printf("getint: %d\n", i);
	(*pos) += sizeof(int);
	return i;
}

char getargchar(mapiFunctArg **pos){
	char c;
	c = *((char *)(*pos));
	//printf("getchar: %c\n", c);
	(*pos) += sizeof(char);
	return c;
}

unsigned long long getargulonglong(mapiFunctArg **pos){
	unsigned long long l;
	l = *((unsigned long long *)(*pos));
	//printf("getulonglong: %lld\n", l);
	(*pos) += sizeof(unsigned long long);
	return l;
}

char * getargstr(mapiFunctArg **pos){
	char *s;
293
	s = (char*)*pos;
Arne Øslebø's avatar
Arne Øslebø committed
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
	//printf("getstr: %s\n", s);
	(*pos) += strlen(s)+1;
	return s;
}

void addarg(mapiFunctArg **pos, void *arg, int type)
// Helper function for mapi_apply_function()
// pos: current position in message's argument buffer.
// arg: argument to copy into buffer
// type: argument type
{
  switch(type){
    case INT:
      memcpy(*pos, arg, sizeof(int));
      //printf("add_arg: %d\n", *((int *)(*pos)));
      (*pos) += sizeof(int);
      break;
    case CHAR:
      memcpy(*pos, arg, sizeof(char));
      //printf("add_arg: %d\n", *((char *)(*pos)));
      (*pos) += sizeof(char);
      break;
    case UNSIGNED_LONG_LONG:
      memcpy(*pos, arg, sizeof(unsigned long long));
      //printf("add_arg: %llu\n", *((unsigned long long *)(*pos)));
      (*pos) += sizeof(unsigned long long);
      break;
    case STRING:
      memcpy(*pos, arg, strlen((char *)arg)+1);
      //printf("add_arg: %s\n", (char *)(*pos));
      (*pos) += strlen((char *)arg)+1;
      break;
    default:
      break;
  }
}

int mapiipc_send_fd(int sendfd)
{
  struct msghdr	msg;
  struct iovec	iov[1];
  char ptr[2];
  int ret;

#ifdef	HAVE_MSGHDR_MSG_CONTROL
  union {
    struct cmsghdr	cm;
    char control[CMSG_SPACE(sizeof(int))];
  } control_un;
  struct cmsghdr	*cmptr;
  
  msg.msg_control = control_un.control;
  msg.msg_controllen = sizeof(control_un.control);
  
  cmptr = CMSG_FIRSTHDR(&msg);
  cmptr->cmsg_len = CMSG_LEN(sizeof(int));
  cmptr->cmsg_level = SOL_SOCKET;
  cmptr->cmsg_type = SCM_RIGHTS;
  *((int *) CMSG_DATA(cmptr)) = sendfd;
#else
  msg.msg_accrights = (caddr_t) &sendfd;
  msg.msg_accrightslen = sizeof(int);
#endif
    
  iov[0].iov_base = ptr;
  iov[0].iov_len = 2;
  msg.msg_iov = iov;
  msg.msg_iovlen = 1;
  msg.msg_name = NULL;
  msg.msg_namelen = 0;

  ret=sendmsg(sock,&msg,0);
  return(ret);
}


int mapiipc_read_fd(int sock)
{
  struct msghdr	msg;
  struct iovec	iov[1];
  ssize_t n;
  int recvfd;
  char c[2];
  
#ifdef	HAVE_MSGHDR_MSG_CONTROL
  union {
    struct cmsghdr	cm;
    char				control[CMSG_SPACE(sizeof(int))];
  } control_un;
  struct cmsghdr	*cmptr;
  
  msg.msg_control = control_un.control;
  msg.msg_controllen = sizeof(control_un.control);
#else
  msg.msg_accrights = (caddr_t) &newfd;
  msg.msg_accrightslen = sizeof(int);
#endif
  
  iov[0].iov_base = &c;
  iov[0].iov_len = 2;
  msg.msg_iov = iov;
  msg.msg_iovlen = 1;
  msg.msg_name = NULL;
  msg.msg_namelen = 0;
  
  
  if ( (n = recvmsg(sock, &msg, 0)) <= 0)
    return(n);
  
#ifdef	HAVE_MSGHDR_MSG_CONTROL
  if ( (cmptr = CMSG_FIRSTHDR(&msg)) != NULL &&
       cmptr->cmsg_len == CMSG_LEN(sizeof(int))) {
    if (cmptr->cmsg_level != SOL_SOCKET) {
      // err_quit("control level != SOL_SOCKET");
      fprintf(stderr, "control level != SOL_SOCKET");
      return -1;
    }
    if (cmptr->cmsg_type != SCM_RIGHTS) {
      // err_quit("control type != SCM_RIGHTS");
      fprintf(stderr, "control type != SCM_RIGHTS");
      return -1;
    }
    recvfd = *((int *) CMSG_DATA(cmptr));
  } else
    recvfd = -1;		/* descriptor was not passed */
#else
  /* *INDENT-OFF* */
  if (msg.msg_accrightslen == sizeof(int))
    recvfd = newfd;
  else
    recvfd = -1;		/* descriptor was not passed */
  /* *INDENT-ON* */
#endif

  return recvfd;
}