1: /*************************************************************************
2: * (C) 2010 AITNET ltd - Sofia/Bulgaria - <misho@aitbg.com>
3: * by Michael Pounov <misho@openbsd-bg.org>
4: *
5: * $Author: misho $
6: * $Id: srv.c,v 1.28.2.3 2016/08/02 12:00:39 misho Exp $
7: *
8: **************************************************************************
9: The ELWIX and AITNET software is distributed under the following
10: terms:
11:
12: All of the documentation and software included in the ELWIX and AITNET
13: Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
14:
15: Copyright 2004 - 2016
16: by Michael Pounov <misho@elwix.org>. All rights reserved.
17:
18: Redistribution and use in source and binary forms, with or without
19: modification, are permitted provided that the following conditions
20: are met:
21: 1. Redistributions of source code must retain the above copyright
22: notice, this list of conditions and the following disclaimer.
23: 2. Redistributions in binary form must reproduce the above copyright
24: notice, this list of conditions and the following disclaimer in the
25: documentation and/or other materials provided with the distribution.
26: 3. All advertising materials mentioning features or use of this software
27: must display the following acknowledgement:
28: This product includes software developed by Michael Pounov <misho@elwix.org>
29: ELWIX - Embedded LightWeight unIX and its contributors.
30: 4. Neither the name of AITNET nor the names of its contributors
31: may be used to endorse or promote products derived from this software
32: without specific prior written permission.
33:
34: THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND
35: ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
36: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
37: ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
38: FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
39: DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
40: OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
41: HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
42: LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
43: OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
44: SUCH DAMAGE.
45: */
46: #include "global.h"
47:
48:
49: /* SOCK_STREAM */
50: static void *acceptClients(sched_task_t *);
51: static void *closeClient(sched_task_t *);
52: static void *rxPacket(sched_task_t *);
53: static void *txPacket(sched_task_t *);
54:
55: /* SOCK_DGRAM */
56: static void *freeClient(sched_task_t *);
57: static void *rxUDPPacket(sched_task_t *);
58: static void *txUDPPacket(sched_task_t *);
59:
60: /* SOCK_RAW */
61: static void *rxRAWPacket(sched_task_t *);
62: static void *txRAWPacket(sched_task_t *);
63:
64: /* SOCK_BPF */
65: static void *rxBPFPacket(sched_task_t *);
66: static void *txBPFPacket(sched_task_t *);
67:
68: /* SOCK_EXT */
69: static void *rxEXTPacket(sched_task_t *);
70: static void *txEXTPacket(sched_task_t *);
71:
72: static sched_task_func_t cbProto[SOCK_MAX_SUPPORT][4] = {
73: { acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */
74: { acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */
75: { rxUDPPacket, freeClient, NULL /*rxUDPPacket*/, txUDPPacket }, /* SOCK_DGRAM */
76: { rxRAWPacket, freeClient, NULL /*rxRAWPacket*/, txRAWPacket }, /* SOCK_RAW */
77: { rxBPFPacket, freeClient, NULL /*rxBPFPacket*/, txBPFPacket }, /* SOCK_BPF */
78: { rxEXTPacket, freeClient, NULL /*rxEXTPacket*/, txEXTPacket } /* SOCK_EXT */
79: };
80:
81: /* Global Signal Argument when kqueue support disabled */
82:
83: static volatile uintptr_t _glSigArg = 0;
84:
85: void
86: rpc_freeCli(rpc_cli_t * __restrict c)
87: {
88: rpc_srv_t *s = c->cli_parent;
89:
90: schedCancelby(s->srv_root, taskMAX, CRITERIA_ARG, c, NULL);
91:
92: /* free buffer */
93: AIT_FREE_VAL(&c->cli_buf);
94:
95: array_Del(s->srv_clients, c->cli_id, 0);
96: if (c)
97: e_free(c);
98: }
99:
100:
101: static inline int
102: _check4freeslot(rpc_srv_t * __restrict srv, sockaddr_t * __restrict sa)
103: {
104: rpc_cli_t *c = NULL;
105: register int i;
106:
107: /* check free slots for connect */
108: for (i = 0; i < array_Size(srv->srv_clients) &&
109: (c = array(srv->srv_clients, i, rpc_cli_t*)); i++)
110: /* check for duplicates */
111: if (sa && !e_addrcmp(&c->cli_sa, sa, 42))
112: break;
113: if (i >= array_Size(srv->srv_clients))
114: return -1; /* no more free slots! */
115:
116: return i;
117: }
118:
119: static rpc_cli_t *
120: _allocClient(rpc_srv_t * __restrict srv, sockaddr_t * __restrict sa)
121: {
122: rpc_cli_t *c = NULL;
123: int n;
124:
125: if (srv->srv_proto != SOCK_EXT)
126: n = _check4freeslot(srv, sa);
127: else
128: n = 0;
129: if (n == -1)
130: return NULL;
131: else
132: c = array(srv->srv_clients, n, rpc_cli_t*);
133:
134: if (!c) {
135: c = e_malloc(sizeof(rpc_cli_t));
136: if (!c) {
137: LOGERR;
138: srv->srv_kill = 1;
139: return NULL;
140: } else {
141: memset(c, 0, sizeof(rpc_cli_t));
142: array_Set(srv->srv_clients, n, c);
143: c->cli_id = n;
144: c->cli_parent = srv;
145: }
146:
147: /* alloc empty buffer */
148: AIT_SET_BUFSIZ(&c->cli_buf, 0, srv->srv_netbuf);
149: }
150:
151: return c;
152: }
153:
154:
155: static void *
156: freeClient(sched_task_t *task)
157: {
158: rpc_freeCli(TASK_ARG(task));
159:
160: taskExit(task, NULL);
161: }
162:
163: static void *
164: closeClient(sched_task_t *task)
165: {
166: int sock = ((rpc_cli_t*) TASK_ARG(task))->cli_sock;
167:
168: rpc_freeCli(TASK_ARG(task));
169:
170: /* close client socket */
171: shutdown(sock, SHUT_RDWR);
172: close(sock);
173: taskExit(task, NULL);
174: }
175:
176: static void *
177: txPacket(sched_task_t *task)
178: {
179: rpc_cli_t *c = TASK_ARG(task);
180: rpc_srv_t *s = c->cli_parent;
181: rpc_func_t *f = NULL;
182: u_char *buf = AIT_GET_BUF(&c->cli_buf);
183: struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
184: int ret, wlen = sizeof(struct tagRPCCall);
185: #ifdef TCP_SESSION_TIMEOUT
186: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
187:
188: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
189: schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
190: TASK_ARG(task), ts, TASK_ARG(task), 0);
191: #endif
192:
193: if (rpc->call_argc) {
194: f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
195: if (!f) {
196: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
197:
198: rpc->call_argc ^= rpc->call_argc;
199: RPC_SET_RETURN(rpc, -1);
200: RPC_SET_ERRNO(rpc, rpc_Errno);
201: } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
202: rpc_SetErr(EMSGSIZE, "Message too long");
203:
204: rpc->call_argc ^= rpc->call_argc;
205: RPC_SET_RETURN(rpc, -1);
206: RPC_SET_ERRNO(rpc, rpc_Errno);
207: } else {
208: rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
209: /* Go Encapsulate variables */
210: ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,
211: RPC_RETVARS(c));
212: if (ret == -1) {
213: rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
214:
215: rpc->call_argc ^= rpc->call_argc;
216: RPC_SET_RETURN(rpc, -1);
217: RPC_SET_ERRNO(rpc, rpc_Errno);
218: } else
219: wlen += ret;
220: }
221: }
222:
223: /* Free return values */
224: ait_freeVars(&c->cli_vars);
225:
226: rpc->call_len = htonl(wlen);
227: rpc->call_io = RPC_ACK;
228:
229: #if 0
230: /* calculate CRC */
231: rpc->call_crc ^= rpc->call_crc;
232: rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
233: #endif
234:
235: /* send reply */
236: ret = send(TASK_FD(task), buf, wlen, MSG_NOSIGNAL);
237: if (ret == -1) {
238: /* close connection */
239: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
240: TASK_ARG(task), 0, NULL, 0);
241: }
242:
243: taskExit(task, NULL);
244: }
245:
246: static void *
247: execCall(sched_task_t *task)
248: {
249: rpc_cli_t *c = TASK_ARG(task);
250: rpc_srv_t *s = c->cli_parent;
251: rpc_func_t *f = NULL;
252: array_t *arr = NULL;
253: u_char *buf = AIT_GET_BUF(&c->cli_buf);
254: struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
255: int argc = rpc->call_argc;
256:
257: /* Go decapsulate variables ... */
258: if (argc) {
259: arr = ait_buffer2vars(buf + sizeof(struct tagRPCCall),
260: AIT_LEN(&c->cli_buf) - sizeof(struct tagRPCCall), argc, 42);
261: if (!arr) {
262: rpc_SetErr(ERPCMISMATCH, "#%d - %s", elwix_GetErrno(), elwix_GetError());
263:
264: rpc->call_argc ^= rpc->call_argc;
265: RPC_SET_RETURN(rpc, -1);
266: RPC_SET_ERRNO(rpc, rpc_Errno);
267: taskExit(task, NULL);
268: }
269: } else
270: arr = NULL;
271:
272: if (!(f = rpc_srv_getCall(s, ntohs(rpc->call_tag)))) {
273: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
274:
275: rpc->call_argc ^= rpc->call_argc;
276: RPC_SET_RETURN(rpc, -1);
277: RPC_SET_ERRNO(rpc, rpc_Errno);
278: } else {
279: /* if client doesn't want reply */
280: RPC_SET_RETURN(rpc, rpc_srv_execCall(c, rpc, f->func_name, arr));
281: if (rpc->call_rep.ret == htonl(-1)) {
282: if (!rpc->call_rep.eno) {
283: LOGERR;
284: RPC_SET_ERRNO(rpc, rpc_Errno);
285: }
286: rpc->call_argc ^= rpc->call_argc;
287: ait_freeVars(&c->cli_vars);
288: } else {
289: rpc->call_rep.eno ^= rpc->call_rep.eno;
290: rpc->call_argc ^= rpc->call_argc;
291: if (TASK_VAL(task)) {
292: /* without reply */
293: ait_freeVars(&c->cli_vars);
294: } else {
295: /* reply */
296: rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
297: }
298: }
299: }
300:
301: array_Destroy(&arr);
302: taskExit(task, NULL);
303: }
304:
305: static void *
306: rxPacket(sched_task_t *task)
307: {
308: rpc_cli_t *c = TASK_ARG(task);
309: rpc_srv_t *s = c->cli_parent;
310: int len, noreply = 0, rlen = AIT_LEN(&c->cli_buf);
311: #if 0
312: u_short crc;
313: #endif
314: u_char *buf = AIT_GET_BUF(&c->cli_buf);
315: struct tagRPCCall b, *rpc = (struct tagRPCCall*) buf;
316: #ifdef TCP_SESSION_TIMEOUT
317: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
318:
319: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
320: schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
321: TASK_ARG(task), ts, TASK_ARG(task), 0);
322: #endif
323:
324: /* prepare rx */
325: len = recv(TASK_FD(task), &b, sizeof b, MSG_PEEK);
326: if (len == sizeof b)
327: rlen = ntohl(b.call_len);
328:
329: rlen = recv(TASK_FD(task), buf, rlen, 0);
330: if (rlen == -1) {
331: /* close connection */
332: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
333: TASK_ARG(task), 0, NULL, 0);
334: taskExit(task, NULL);
335: }
336: if (rlen < sizeof(struct tagRPCCall)) {
337: rpc_SetErr(ERPCMISMATCH, "Short RPC packet");
338:
339: rpc->call_argc ^= rpc->call_argc;
340: RPC_SET_RETURN(rpc, -1);
341: RPC_SET_ERRNO(rpc, rpc_Errno);
342: goto err;
343: } else
344: len = ntohl(rpc->call_len);
345: if (rlen < len || len > AIT_LEN(&c->cli_buf)) {
346: rpc_SetErr(ERPCMISMATCH, "Short RPC packet");
347:
348: rpc->call_argc ^= rpc->call_argc;
349: RPC_SET_RETURN(rpc, -1);
350: RPC_SET_ERRNO(rpc, rpc_Errno);
351: goto err;
352: }
353:
354: /* skip loop packet */
355: if (rpc->call_io & RPC_ACK) {
356: schedReadSelf(task);
357: taskExit(task, NULL);
358: }
359:
360: #if 0
361: /* check integrity of packet */
362: crc = ntohs(rpc->call_crc);
363: rpc->call_crc ^= rpc->call_crc;
364: if (crc != crcFletcher16((u_short*) rpc, len / 2)) {
365: rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");
366:
367: rpc->call_argc ^= rpc->call_argc;
368: RPC_SET_RETURN(rpc, -1);
369: RPC_SET_ERRNO(rpc, rpc_Errno);
370: goto err;
371: }
372: #endif
373:
374: /* check RPC packet session info */
375: if (rpc_chkPktSession(&rpc->call_session, &s->srv_session)) {
376: rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
377:
378: rpc->call_argc ^= rpc->call_argc;
379: RPC_SET_RETURN(rpc, -1);
380: RPC_SET_ERRNO(rpc, rpc_Errno);
381: goto err;
382: }
383:
384: noreply = RPC_CHK_NOREPLY(rpc);
385:
386: /* execute RPC call */
387: schedEvent(TASK_ROOT(task), execCall, TASK_ARG(task), (int) noreply, rpc, len);
388: err:
389: /* send RPC reply */
390: if (!noreply)
391: schedWrite(TASK_ROOT(task), cbProto[s->srv_proto][CB_TXPACKET],
392: TASK_ARG(task), TASK_FD(task), rpc, len);
393:
394: /* lets get next packet */
395: schedReadSelf(task);
396: taskExit(task, NULL);
397: }
398:
399: static void *
400: acceptClients(sched_task_t *task)
401: {
402: rpc_srv_t *srv = TASK_ARG(task);
403: rpc_cli_t *c = NULL;
404: socklen_t salen = E_SOCKADDR_MAX;
405: int sock;
406: #ifdef TCP_SESSION_TIMEOUT
407: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
408: #endif
409:
410: c = _allocClient(srv, NULL);
411: if (!c) {
412: EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
413: if ((sock = accept(TASK_FD(task), NULL, NULL)) != -1) {
414: shutdown(sock, SHUT_RDWR);
415: close(sock);
416: }
417: goto end;
418: }
419:
420: /* accept client */
421: c->cli_sock = accept(TASK_FD(task), &c->cli_sa.sa, &salen);
422: if (c->cli_sock == -1) {
423: LOGERR;
424: AIT_FREE_VAL(&c->cli_buf);
425: array_Del(srv->srv_clients, c->cli_id, 42);
426: goto end;
427: } else
428: fcntl(c->cli_sock, F_SETFL, fcntl(c->cli_sock, F_GETFL) | O_NONBLOCK);
429:
430: #ifdef TCP_SESSION_TIMEOUT
431: /* armed timer for close stateless connection */
432: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
433: schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], c,
434: ts, c, 0);
435: #endif
436: schedRead(TASK_ROOT(task), cbProto[srv->srv_proto][CB_RXPACKET], c,
437: c->cli_sock, NULL, 0);
438: end:
439: schedReadSelf(task);
440: taskExit(task, NULL);
441: }
442:
443:
444: static void *
445: txUDPPacket(sched_task_t *task)
446: {
447: rpc_cli_t *c = TASK_ARG(task);
448: rpc_srv_t *s = c->cli_parent;
449: rpc_func_t *f = NULL;
450: u_char *buf = AIT_GET_BUF(&c->cli_buf);
451: struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
452: int ret, wlen = sizeof(struct tagRPCCall);
453: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
454:
455: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
456: schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
457: TASK_ARG(task), ts, TASK_ARG(task), 0);
458:
459: if (rpc->call_argc) {
460: f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
461: if (!f) {
462: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
463:
464: rpc->call_argc ^= rpc->call_argc;
465: RPC_SET_RETURN(rpc, -1);
466: RPC_SET_ERRNO(rpc, rpc_Errno);
467: } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
468: rpc_SetErr(EMSGSIZE, "Message too long");
469:
470: rpc->call_argc ^= rpc->call_argc;
471: RPC_SET_RETURN(rpc, -1);
472: RPC_SET_ERRNO(rpc, rpc_Errno);
473: } else {
474: rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
475: /* Go Encapsulate variables */
476: ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,
477: RPC_RETVARS(c));
478: if (ret == -1) {
479: rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
480:
481: rpc->call_argc ^= rpc->call_argc;
482: RPC_SET_RETURN(rpc, -1);
483: RPC_SET_ERRNO(rpc, rpc_Errno);
484: } else
485: wlen += ret;
486: }
487: }
488:
489: /* Free return values */
490: ait_freeVars(&c->cli_vars);
491:
492: rpc->call_len = htonl(wlen);
493: rpc->call_io = RPC_ACK;
494:
495: /* calculate CRC */
496: rpc->call_crc ^= rpc->call_crc;
497: rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
498:
499: /* send reply */
500: ret = sendto(TASK_FD(task), buf, wlen, MSG_NOSIGNAL,
501: &c->cli_sa.sa, sizeof c->cli_sa.sa);
502: if (ret == -1) {
503: /* close connection */
504: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
505: TASK_ARG(task), 0, NULL, 0);
506: }
507:
508: taskExit(task, NULL);
509: }
510:
511: static void *
512: rxUDPPacket(sched_task_t *task)
513: {
514: rpc_srv_t *srv = TASK_ARG(task);
515: rpc_cli_t *c = NULL;
516: int len, noreply = 0, rlen;
517: u_short crc;
518: struct tagRPCCall *rpc;
519: sockaddr_t sa;
520: socklen_t salen = E_SOCKADDR_MAX;
521: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
522: ait_val_t b = AIT_VAL_INIT;
523:
524: /* receive connect packet */
525: AIT_SET_BUF(&b, NULL, srv->srv_netbuf);
526: #ifndef __linux__
527: sa.ss.ss_len = salen;
528: #endif
529: rlen = recvfrom(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b), 0, &sa.sa, &salen);
530: rpc = (struct tagRPCCall*) AIT_GET_BUF(&b);
531: if (rlen < sizeof(struct tagRPCCall))
532: goto end;
533: else
534: len = ntohl(rpc->call_len);
535: if (rlen < len || len > srv->srv_netbuf)
536: goto end;
537:
538: /* skip loop packet */
539: if (rpc->call_io & RPC_ACK)
540: goto end;
541:
542: /* check integrity of packet */
543: crc = ntohs(rpc->call_crc);
544: rpc->call_crc ^= rpc->call_crc;
545: if (crc != crcFletcher16((u_short*) rpc, len / 2))
546: goto end;
547:
548: /* check RPC packet session info */
549: if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session))
550: goto end;
551:
552: c = _allocClient(srv, &sa);
553: if (!c) {
554: EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
555: usleep(2000); /* blocked client delay */
556: goto end;
557: } else {
558: memcpy(AIT_GET_BUF(&c->cli_buf), AIT_GET_BUF(&b), len);
559: rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
560:
561: c->cli_sock = TASK_FD(task);
562: memcpy(&c->cli_sa, &sa, sizeof c->cli_sa);
563:
564: /* armed timer for close stateless connection */
565: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
566: schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],
567: c, ts, c, 0);
568: }
569:
570: noreply = RPC_CHK_NOREPLY(rpc);
571:
572: /* execute RPC call */
573: schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
574:
575: /* send RPC reply */
576: if (!noreply)
577: schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],
578: c, TASK_FD(task), rpc, len);
579: end:
580: AIT_FREE_VAL(&b);
581: schedReadSelf(task);
582: taskExit(task, NULL);
583: }
584:
585:
586: static void *
587: txRAWPacket(sched_task_t *task)
588: {
589: rpc_cli_t *c = TASK_ARG(task);
590: rpc_srv_t *s = c->cli_parent;
591: rpc_func_t *f = NULL;
592: u_char *buf = AIT_GET_BUF(&c->cli_buf);
593: struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
594: int ret, wlen = sizeof(struct tagRPCCall);
595: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
596:
597: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
598: schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
599: TASK_ARG(task), ts, TASK_ARG(task), 0);
600:
601: if (rpc->call_argc) {
602: f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
603: if (!f) {
604: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
605:
606: rpc->call_argc ^= rpc->call_argc;
607: RPC_SET_RETURN(rpc, -1);
608: RPC_SET_ERRNO(rpc, rpc_Errno);
609: } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
610: rpc_SetErr(EMSGSIZE, "Message too long");
611:
612: rpc->call_argc ^= rpc->call_argc;
613: RPC_SET_RETURN(rpc, -1);
614: RPC_SET_ERRNO(rpc, rpc_Errno);
615: } else {
616: rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
617: /* Go Encapsulate variables */
618: ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,
619: RPC_RETVARS(c));
620: if (ret == -1) {
621: rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
622:
623: rpc->call_argc ^= rpc->call_argc;
624: RPC_SET_RETURN(rpc, -1);
625: RPC_SET_ERRNO(rpc, rpc_Errno);
626: } else
627: wlen += ret;
628: }
629: }
630:
631: /* Free return values */
632: ait_freeVars(&c->cli_vars);
633:
634: rpc->call_len = htonl(wlen);
635: rpc->call_io = RPC_ACK;
636:
637: /* calculate CRC */
638: rpc->call_crc ^= rpc->call_crc;
639: rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
640:
641: /* send reply */
642: ret = sendto(TASK_FD(task), buf, wlen, MSG_NOSIGNAL,
643: &c->cli_sa.sa, sizeof c->cli_sa.sa);
644: if (ret == -1) {
645: /* close connection */
646: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
647: TASK_ARG(task), 0, NULL, 0);
648: }
649:
650: taskExit(task, NULL);
651: }
652:
653: static void *
654: rxRAWPacket(sched_task_t *task)
655: {
656: rpc_srv_t *srv = TASK_ARG(task);
657: rpc_cli_t *c = NULL;
658: int len, noreply = 0, rlen;
659: u_short crc;
660: struct tagRPCCall *rpc;
661: sockaddr_t sa;
662: socklen_t salen = E_SOCKADDR_MAX;
663: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
664: ait_val_t b = AIT_VAL_INIT;
665:
666: /* receive connect packet */
667: AIT_SET_BUF(&b, NULL, srv->srv_netbuf);
668: #ifndef __linux__
669: sa.ss.ss_len = salen;
670: #endif
671: rlen = recvfrom(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b), 0, &sa.sa, &salen);
672: if (sa.sa.sa_family == AF_INET) {
673: struct ip *h;
674: h = (struct ip*) AIT_GET_BUF(&b);
675: if (rlen < ntohs(h->ip_len) || h->ip_p != IPPROTO_ERPC)
676: goto end;
677: else {
678: rlen -= sizeof(struct ip);
679: rpc = (struct tagRPCCall*) (h + 1);
680: }
681: } else {
682: struct ip6_hdr *h;
683: h = (struct ip6_hdr*) AIT_GET_BUF(&b);
684: if (rlen < (ntohs(h->ip6_plen) + sizeof(struct ip6_hdr)) ||
685: h->ip6_nxt != IPPROTO_ERPC)
686: goto end;
687: else {
688: rlen -= sizeof(struct ip6_hdr);
689: rpc = (struct tagRPCCall*) (h + 1);
690: }
691: }
692: if (rlen < sizeof(struct tagRPCCall))
693: goto end;
694: else
695: len = ntohl(rpc->call_len);
696: if (rlen < len || len > srv->srv_netbuf)
697: goto end;
698:
699: /* skip loop packet */
700: if (rpc->call_io & RPC_ACK)
701: goto end;
702:
703: /* check integrity of packet */
704: crc = ntohs(rpc->call_crc);
705: rpc->call_crc ^= rpc->call_crc;
706: if (crc != crcFletcher16((u_short*) rpc, len / 2))
707: goto end;
708:
709: /* check RPC packet session info */
710: if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session))
711: goto end;
712:
713: c = _allocClient(srv, &sa);
714: if (!c) {
715: EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
716: usleep(2000); /* blocked client delay */
717: goto end;
718: } else {
719: memcpy(AIT_GET_BUF(&c->cli_buf), rpc, len);
720: rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
721:
722: c->cli_sock = TASK_FD(task);
723: memcpy(&c->cli_sa, &sa, sizeof c->cli_sa);
724:
725: /* armed timer for close stateless connection */
726: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
727: schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],
728: c, ts, c, 0);
729: }
730:
731: noreply = RPC_CHK_NOREPLY(rpc);
732:
733: /* execute RPC call */
734: schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
735:
736: /* send RPC reply */
737: if (!noreply)
738: schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],
739: c, TASK_FD(task), rpc, len);
740: end:
741: AIT_FREE_VAL(&b);
742: schedReadSelf(task);
743: taskExit(task, NULL);
744: }
745:
746:
747: static void *
748: txBPFPacket(sched_task_t *task)
749: {
750: #ifndef __linux__
751: rpc_cli_t *c = TASK_ARG(task);
752: rpc_srv_t *s = c->cli_parent;
753: rpc_func_t *f = NULL;
754: u_char *buf = AIT_GET_BUF(&c->cli_buf);
755: struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
756: int ret, wlen = sizeof(struct tagRPCCall);
757: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
758: struct ether_header *eh;
759: ait_val_t b = AIT_VAL_INIT;
760:
761: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
762: schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
763: TASK_ARG(task), ts, TASK_ARG(task), 0);
764:
765: if (rpc->call_argc) {
766: f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
767: if (!f) {
768: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
769:
770: rpc->call_argc ^= rpc->call_argc;
771: RPC_SET_RETURN(rpc, -1);
772: RPC_SET_ERRNO(rpc, rpc_Errno);
773: } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
774: rpc_SetErr(EMSGSIZE, "Message too long");
775:
776: rpc->call_argc ^= rpc->call_argc;
777: RPC_SET_RETURN(rpc, -1);
778: RPC_SET_ERRNO(rpc, rpc_Errno);
779: } else {
780: rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
781: /* Go Encapsulate variables */
782: ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,
783: RPC_RETVARS(c));
784: if (ret == -1) {
785: rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
786:
787: rpc->call_argc ^= rpc->call_argc;
788: RPC_SET_RETURN(rpc, -1);
789: RPC_SET_ERRNO(rpc, rpc_Errno);
790: } else
791: wlen += ret;
792: }
793: }
794:
795: /* Free return values */
796: ait_freeVars(&RPC_RETVARS(c));
797:
798: rpc->call_len = htonl(wlen);
799: rpc->call_io = RPC_ACK;
800:
801: /* calculate CRC */
802: rpc->call_crc ^= rpc->call_crc;
803: rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
804:
805: /* send reply */
806: AIT_SET_BUF(&b, NULL, wlen + ETHER_HDR_LEN);
807: eh = (struct ether_header*) AIT_GET_BUF(&b);
808: memcpy(eh->ether_dhost, LLADDR(&c->cli_sa.sdl), ETHER_ADDR_LEN);
809: eh->ether_type = htons(RPC_DEFPORT);
810: memcpy(eh + 1, buf, wlen);
811:
812: ret = write(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));
813: AIT_FREE_VAL(&b);
814: if (ret == -1) {
815: /* close connection */
816: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
817: TASK_ARG(task), 0, NULL, 0);
818: }
819: #else
820: rpc_SetErr(ENOTSUP, "Feature isn't supported on Linux!");
821: #endif
822:
823: taskExit(task, NULL);
824: }
825:
826: static void *
827: rxBPFPacket(sched_task_t *task)
828: {
829: #ifndef __linux__
830: rpc_srv_t *srv = TASK_ARG(task);
831: rpc_cli_t *c = NULL;
832: int len, rlen, noreply;
833: u_short crc;
834: struct tagRPCCall *rpc;
835: sockaddr_t sa;
836: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
837: struct bpf_hdr *h;
838: struct ether_header *eh;
839: ait_val_t b = AIT_VAL_INIT;
840:
841: /* receive connect packet */
842: AIT_SET_BUF(&b, NULL, srv->srv_netbuf);
843: rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));
844: h = (struct bpf_hdr*) AIT_GET_BUF(&b);
845: rlen -= h->bh_hdrlen;
846: if (rlen < h->bh_datalen || h->bh_caplen != h->bh_datalen ||
847: rlen < ETHER_HDR_LEN + sizeof(struct tagRPCCall))
848: goto end;
849: else {
850: rlen = h->bh_caplen;
851: eh = (struct ether_header*) (AIT_GET_BUF(&b) + h->bh_hdrlen);
852: rlen -= ETHER_HDR_LEN;
853: rpc = (struct tagRPCCall*) (eh + 1);
854:
855: if (eh->ether_type != ntohs(RPC_DEFPORT))
856: goto end;
857: else
858: e_getlinkbymac((const ether_addr_t*) eh->ether_shost, &sa);
859: }
860: if (rlen < sizeof(struct tagRPCCall))
861: goto end;
862: else
863: len = ntohl(rpc->call_len);
864: if (rlen < len || len > srv->srv_netbuf)
865: goto end;
866:
867: #ifdef CHECK_ETHACK
868: /* skip loop packet */
869: if (rpc->call_io & RPC_ACK)
870: goto end;
871: #endif
872:
873: /* check integrity of packet */
874: crc = ntohs(rpc->call_crc);
875: rpc->call_crc ^= rpc->call_crc;
876: if (crc != crcFletcher16((u_short*) rpc, len / 2))
877: goto end;
878:
879: /* check RPC packet session info */
880: if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session))
881: goto end;
882:
883: c = _allocClient(srv, &sa);
884: if (!c) {
885: EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
886: usleep(2000); /* blocked client delay */
887: goto end;
888: } else {
889: memcpy(AIT_GET_BUF(&c->cli_buf), rpc, len);
890: rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
891:
892: c->cli_sock = TASK_FD(task);
893: memcpy(&c->cli_sa, &sa, sizeof c->cli_sa);
894:
895: /* armed timer for close stateless connection */
896: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
897: schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],
898: c, ts, c, 0);
899: }
900:
901: noreply = RPC_CHK_NOREPLY(rpc);
902:
903: /* execute RPC call */
904: schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
905:
906: /* send RPC reply */
907: if (!noreply)
908: schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],
909: c, TASK_FD(task), rpc, len);
910: end:
911: AIT_FREE_VAL(&b);
912: schedReadSelf(task);
913: #else
914: rpc_SetErr(ENOTSUP, "Feature isn't supported on Linux!");
915: #endif
916:
917: taskExit(task, NULL);
918: }
919:
920:
921: static void *
922: txEXTPacket(sched_task_t *task)
923: {
924: rpc_cli_t *c = TASK_ARG(task);
925: rpc_srv_t *s = c->cli_parent;
926: rpc_func_t *f = NULL;
927: u_char *buf = AIT_GET_BUF(&c->cli_buf);
928: struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
929: int ret, wlen = sizeof(struct tagRPCCall);
930: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
931:
932: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
933: schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
934: TASK_ARG(task), ts, TASK_ARG(task), 0);
935:
936: if (rpc->call_argc) {
937: f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
938: if (!f) {
939: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
940:
941: rpc->call_argc ^= rpc->call_argc;
942: RPC_SET_RETURN(rpc, -1);
943: RPC_SET_ERRNO(rpc, rpc_Errno);
944: } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
945: rpc_SetErr(EMSGSIZE, "Message too long");
946:
947: rpc->call_argc ^= rpc->call_argc;
948: RPC_SET_RETURN(rpc, -1);
949: RPC_SET_ERRNO(rpc, rpc_Errno);
950: } else {
951: rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
952: /* Go Encapsulate variables */
953: ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,
954: RPC_RETVARS(c));
955: if (ret == -1) {
956: rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
957:
958: rpc->call_argc ^= rpc->call_argc;
959: RPC_SET_RETURN(rpc, -1);
960: RPC_SET_ERRNO(rpc, rpc_Errno);
961: } else
962: wlen += ret;
963: }
964: }
965:
966: /* Free return values */
967: ait_freeVars(&RPC_RETVARS(c));
968:
969: rpc->call_len = htonl(wlen);
970: rpc->call_io = RPC_ACK;
971:
972: /* send reply */
973: ret = write(TASK_FD(task), buf, wlen);
974: if (ret == -1) {
975: /* close connection */
976: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
977: TASK_ARG(task), 0, NULL, 0);
978: }
979:
980: taskExit(task, NULL);
981: }
982:
983: static void *
984: rxEXTPacket(sched_task_t *task)
985: {
986: rpc_srv_t *srv = TASK_ARG(task);
987: rpc_cli_t *c = NULL;
988: int len, noreply = 0, rlen = AIT_LEN(&c->cli_buf);
989: struct tagRPCCall *rpc;
990: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
991: sockaddr_t sa;
992: ait_val_t b = AIT_VAL_INIT;
993:
994: memset(&sa, 0, sizeof sa);
995: /* receive connect packet */
996: AIT_SET_BUF(&b, NULL, srv->srv_netbuf);
997: rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));
998: rpc = (struct tagRPCCall*) AIT_GET_BUF(&b);
999: if (rlen < sizeof(struct tagRPCCall))
1000: goto end;
1001: else
1002: len = ntohl(rpc->call_len);
1003: if (rlen < len || len > srv->srv_netbuf)
1004: goto end;
1005:
1006: /* skip loop packet */
1007: if (rpc->call_io & RPC_ACK)
1008: goto end;
1009:
1010: /* check RPC packet session info */
1011: if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session))
1012: goto end;
1013:
1014: c = _allocClient(srv, &sa);
1015: if (!c) {
1016: EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
1017: usleep(2000); /* blocked client delay */
1018: goto end;
1019: } else {
1020: memcpy(AIT_GET_BUF(&c->cli_buf), AIT_GET_BUF(&b), len);
1021: rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
1022:
1023: c->cli_sock = TASK_FD(task);
1024:
1025: /* armed timer for close stateless connection */
1026: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
1027: schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],
1028: c, ts, c, 0);
1029: }
1030:
1031: noreply = RPC_CHK_NOREPLY(rpc);
1032:
1033: /* execute RPC call */
1034: schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
1035:
1036: /* send RPC reply */
1037: if (!noreply)
1038: schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],
1039: c, TASK_FD(task), rpc, len);
1040: end:
1041: AIT_FREE_VAL(&b);
1042: schedReadSelf(task);
1043: taskExit(task, NULL);
1044: }
1045:
1046: /* ------------------------------------------------------ */
1047:
1048: void
1049: rpc_freeBLOBCli(rpc_cli_t * __restrict c)
1050: {
1051: rpc_srv_t *s = c->cli_parent;
1052:
1053: schedCancelby(s->srv_blob.root, taskMAX, CRITERIA_ARG, c, NULL);
1054:
1055: /* free buffer */
1056: AIT_FREE_VAL(&c->cli_buf);
1057:
1058: array_Del(s->srv_blob.clients, c->cli_id, 0);
1059: if (c)
1060: e_free(c);
1061: }
1062:
1063:
1064: static void *
1065: closeBLOBClient(sched_task_t *task)
1066: {
1067: int sock = ((rpc_cli_t*) TASK_ARG(task))->cli_sock;
1068:
1069: rpc_freeBLOBCli(TASK_ARG(task));
1070:
1071: /* close client socket */
1072: shutdown(sock, SHUT_RDWR);
1073: close(sock);
1074: taskExit(task, NULL);
1075: }
1076:
1077: static void *
1078: txBLOB(sched_task_t *task)
1079: {
1080: rpc_cli_t *c = TASK_ARG(task);
1081: u_char *buf = AIT_GET_BUF(&c->cli_buf);
1082: int wlen = sizeof(struct tagBLOBHdr);
1083:
1084: /* send reply */
1085: wlen = send(TASK_FD(task), buf, wlen, MSG_NOSIGNAL);
1086: if (wlen == -1 || wlen != sizeof(struct tagBLOBHdr)) {
1087: /* close blob connection */
1088: schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);
1089: }
1090:
1091: taskExit(task, NULL);
1092: }
1093:
1094: static void *
1095: rxBLOB(sched_task_t *task)
1096: {
1097: rpc_cli_t *c = TASK_ARG(task);
1098: rpc_srv_t *s = c->cli_parent;
1099: rpc_blob_t *b;
1100: struct tagBLOBHdr blob;
1101: int rlen;
1102:
1103: memset(&blob, 0, sizeof blob);
1104: rlen = recv(TASK_FD(task), &blob, sizeof blob, 0);
1105: if (rlen < 1) {
1106: /* close blob connection */
1107: schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);
1108: taskExit(task, NULL);
1109: }
1110:
1111: /* check BLOB packet */
1112: if (rlen < sizeof(struct tagBLOBHdr)) {
1113: rpc_SetErr(ERPCMISMATCH, "Short BLOB packet");
1114:
1115: schedReadSelf(task);
1116: taskExit(task, NULL);
1117: }
1118:
1119: /* check RPC packet session info */
1120: if (rpc_chkPktSession(&blob.hdr_session, &s->srv_session)) {
1121: rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
1122: blob.hdr_cmd = error;
1123: goto end;
1124: }
1125:
1126: /* Go to proceed packet ... */
1127: switch (blob.hdr_cmd) {
1128: case get:
1129: if (!(b = rpc_srv_getBLOB(s, ntohl(blob.hdr_var)))) {
1130: rpc_SetErr(EINVAL, "Var=%x not found", ntohl(blob.hdr_var));
1131: blob.hdr_cmd = no;
1132: RPC_SET_BLOB_RET(&blob, -1);
1133: break;
1134: } else
1135: blob.hdr_len = htonl(b->blob_len);
1136:
1137: if (rpc_srv_blobMap(s, b) != -1) {
1138: /* deliver BLOB variable to client */
1139: blob.hdr_ret = htonl(rpc_srv_sendBLOB(c, b));
1140: rpc_srv_blobUnmap(b);
1141: } else {
1142: blob.hdr_cmd = error;
1143: RPC_SET_BLOB_RET(&blob, -1);
1144: }
1145: break;
1146: case set:
1147: if ((b = rpc_srv_registerBLOB(s, ntohl(blob.hdr_len),
1148: ntohl(blob.hdr_ret)))) {
1149: /* set new BLOB variable for reply :) */
1150: blob.hdr_var = htonl(b->blob_var);
1151:
1152: /* receive BLOB from client */
1153: blob.hdr_ret = htonl(rpc_srv_recvBLOB(c, b));
1154: rpc_srv_blobUnmap(b);
1155: } else {
1156: blob.hdr_cmd = error;
1157: RPC_SET_BLOB_RET(&blob, -1);
1158: }
1159: break;
1160: case unset:
1161: if (rpc_srv_unregisterBLOB(s, ntohl(blob.hdr_var)) == -1) {
1162: blob.hdr_cmd = error;
1163: RPC_SET_BLOB_RET(&blob, -1);
1164: }
1165: break;
1166: default:
1167: rpc_SetErr(EPROCUNAVAIL, "Unsupported BLOB command %d", blob.hdr_cmd);
1168: blob.hdr_cmd = error;
1169: RPC_SET_BLOB_RET(&blob, -1);
1170: }
1171:
1172: end:
1173: memcpy(AIT_ADDR(&c->cli_buf), &blob, sizeof blob);
1174: schedWrite(TASK_ROOT(task), txBLOB, TASK_ARG(task), TASK_FD(task), NULL, 0);
1175: schedReadSelf(task);
1176: taskExit(task, NULL);
1177: }
1178:
1179: static void *
1180: flushBLOB(sched_task_t *task)
1181: {
1182: #ifdef atomic_load_acq_ptr
1183: uintptr_t sigArg = atomic_load_acq_ptr(&_glSigArg);
1184: #else
1185: uintptr_t sigArg = *((volatile uintptr_t*) &_glSigArg);
1186: #endif
1187: rpc_srv_t *srv = sigArg ? (void*) sigArg : TASK_ARG(task);
1188: rpc_blob_t *b, *tmp;
1189:
1190: TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) {
1191: TAILQ_REMOVE(&srv->srv_blob.blobs, b, blob_node);
1192:
1193: rpc_srv_blobFree(srv, b);
1194: e_free(b);
1195: }
1196:
1197: if (!schedSignalSelf(task)) {
1198: /* disabled kqueue support in libaitsched */
1199: struct sigaction sa;
1200:
1201: memset(&sa, 0, sizeof sa);
1202: sigemptyset(&sa.sa_mask);
1203: sa.sa_handler = (void (*)(int)) flushBLOB;
1204: sa.sa_flags = SA_RESTART | SA_RESETHAND;
1205: sigaction(SIGFBLOB, &sa, NULL);
1206: }
1207:
1208: taskExit(task, NULL);
1209: }
1210:
1211: static void *
1212: acceptBLOBClients(sched_task_t *task)
1213: {
1214: rpc_srv_t *srv = TASK_ARG(task);
1215: rpc_cli_t *c = NULL;
1216: register int i;
1217: socklen_t salen = E_SOCKADDR_MAX;
1218: int sock;
1219: #ifdef TCP_NOPUSH
1220: int n = 1;
1221: #endif
1222:
1223: /* check free slots for connect */
1224: for (i = 0; i < array_Size(srv->srv_blob.clients) &&
1225: (c = array(srv->srv_blob.clients, i, rpc_cli_t*)); i++);
1226: if (c) { /* no more free slots! */
1227: EVERBOSE(1, "BLOB client quota exceeded! Connection will be shutdown!\n");
1228: if ((sock = accept(TASK_FD(task), NULL, NULL)) != -1) {
1229: shutdown(sock, SHUT_RDWR);
1230: close(sock);
1231: }
1232: goto end;
1233: }
1234:
1235: c = e_malloc(sizeof(rpc_cli_t));
1236: if (!c) {
1237: LOGERR;
1238: srv->srv_kill = srv->srv_blob.kill = 1;
1239: taskExit(task, NULL);
1240: } else {
1241: memset(c, 0, sizeof(rpc_cli_t));
1242: array_Set(srv->srv_blob.clients, i, c);
1243: c->cli_id = i;
1244: c->cli_parent = srv;
1245: }
1246:
1247: /* alloc empty buffer */
1248: AIT_SET_BUFSIZ(&c->cli_buf, 0, srv->srv_netbuf);
1249:
1250: /* accept client */
1251: c->cli_sock = accept(TASK_FD(task), &c->cli_sa.sa, &salen);
1252: if (c->cli_sock == -1) {
1253: LOGERR;
1254: AIT_FREE_VAL(&c->cli_buf);
1255: array_Del(srv->srv_blob.clients, i, 42);
1256: goto end;
1257: } else {
1258: #ifdef TCP_NOPUSH
1259: setsockopt(c->cli_sock, IPPROTO_TCP, TCP_NOPUSH, &n, sizeof n);
1260: #endif
1261: fcntl(c->cli_sock, F_SETFL, fcntl(c->cli_sock, F_GETFL) | O_NONBLOCK);
1262: }
1263:
1264: schedRead(TASK_ROOT(task), rxBLOB, c, c->cli_sock, NULL, 0);
1265: end:
1266: schedReadSelf(task);
1267: taskExit(task, NULL);
1268: }
1269:
1270: /* ------------------------------------------------------ */
1271:
1272: /*
1273: * rpc_srv_initBLOBServer() - Init & create BLOB Server
1274: *
1275: * @srv = RPC server instance
1276: * @Port = Port for bind server, if Port == 0 default port is selected
1277: * @diskDir = Disk place for BLOB file objects
1278: * return: -1 == error or 0 bind and created BLOB server instance
1279: */
1280: int
1281: rpc_srv_initBLOBServer(rpc_srv_t * __restrict srv, u_short Port, const char *diskDir)
1282: {
1283: int n = 1;
1284: socklen_t salen;
1285:
1286: if (!srv || srv->srv_kill) {
1287: rpc_SetErr(EINVAL, "Invalid parameters can`t init BLOB server");
1288: return -1;
1289: }
1290:
1291: memset(&srv->srv_blob, 0, sizeof srv->srv_blob);
1292: if (access(diskDir, R_OK | W_OK) == -1) {
1293: LOGERR;
1294: return -1;
1295: } else
1296: AIT_SET_STR(&srv->srv_blob.dir, diskDir);
1297:
1298: /* init blob list */
1299: TAILQ_INIT(&srv->srv_blob.blobs);
1300:
1301: srv->srv_blob.server.cli_parent = srv;
1302:
1303: memcpy(&srv->srv_blob.server.cli_sa, &srv->srv_server.cli_sa, sizeof(sockaddr_t));
1304: switch (srv->srv_blob.server.cli_sa.sa.sa_family) {
1305: case AF_INET:
1306: srv->srv_blob.server.cli_sa.sin.sin_port =
1307: htons(Port ? Port : ntohs(srv->srv_blob.server.cli_sa.sin.sin_port) + 1);
1308: salen = sizeof srv->srv_blob.server.cli_sa.sin;
1309: break;
1310: case AF_INET6:
1311: srv->srv_blob.server.cli_sa.sin6.sin6_port =
1312: htons(Port ? Port : ntohs(srv->srv_blob.server.cli_sa.sin6.sin6_port) + 1);
1313: salen = sizeof srv->srv_blob.server.cli_sa.sin6;
1314: break;
1315: case AF_LOCAL:
1316: strlcat(srv->srv_blob.server.cli_sa.sun.sun_path, ".blob",
1317: sizeof srv->srv_blob.server.cli_sa.sun.sun_path);
1318: salen = sizeof srv->srv_blob.server.cli_sa.sun;
1319: break;
1320: default:
1321: AIT_FREE_VAL(&srv->srv_blob.dir);
1322: return -1;
1323: }
1324:
1325: /* create BLOB server socket */
1326: srv->srv_blob.server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family, SOCK_STREAM, 0);
1327: if (srv->srv_blob.server.cli_sock == -1) {
1328: LOGERR;
1329: AIT_FREE_VAL(&srv->srv_blob.dir);
1330: return -1;
1331: }
1332: if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
1333: LOGERR;
1334: close(srv->srv_blob.server.cli_sock);
1335: AIT_FREE_VAL(&srv->srv_blob.dir);
1336: return -1;
1337: }
1338: n = srv->srv_netbuf;
1339: if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
1340: LOGERR;
1341: close(srv->srv_blob.server.cli_sock);
1342: AIT_FREE_VAL(&srv->srv_blob.dir);
1343: return -1;
1344: }
1345: if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
1346: LOGERR;
1347: close(srv->srv_blob.server.cli_sock);
1348: AIT_FREE_VAL(&srv->srv_blob.dir);
1349: return -1;
1350: }
1351: if (bind(srv->srv_blob.server.cli_sock, &srv->srv_blob.server.cli_sa.sa, salen) == -1) {
1352: LOGERR;
1353: close(srv->srv_blob.server.cli_sock);
1354: AIT_FREE_VAL(&srv->srv_blob.dir);
1355: return -1;
1356: } else
1357: fcntl(srv->srv_blob.server.cli_sock, F_SETFL,
1358: fcntl(srv->srv_blob.server.cli_sock, F_GETFL) | O_NONBLOCK);
1359:
1360:
1361: /* allocate pool for concurent blob clients */
1362: srv->srv_blob.clients = array_Init(array_Size(srv->srv_clients));
1363: if (!srv->srv_blob.clients) {
1364: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
1365: close(srv->srv_blob.server.cli_sock);
1366: AIT_FREE_VAL(&srv->srv_blob.dir);
1367: return -1;
1368: }
1369:
1370: /* init blob scheduler */
1371: srv->srv_blob.root = schedBegin();
1372: if (!srv->srv_blob.root) {
1373: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
1374: array_Destroy(&srv->srv_blob.clients);
1375: close(srv->srv_blob.server.cli_sock);
1376: AIT_FREE_VAL(&srv->srv_blob.dir);
1377: return -1;
1378: }
1379:
1380: return 0;
1381: }
1382:
1383: /*
1384: * rpc_srv_endBLOBServer() - Destroy BLOB server, close all opened sockets and free resources
1385: *
1386: * @srv = RPC Server instance
1387: * return: none
1388: */
1389: void
1390: rpc_srv_endBLOBServer(rpc_srv_t * __restrict srv)
1391: {
1392: if (!srv)
1393: return;
1394:
1395: srv->srv_blob.kill = 1;
1396:
1397: if (srv->srv_blob.server.cli_sa.sa.sa_family == AF_LOCAL)
1398: unlink(srv->srv_blob.server.cli_sa.sun.sun_path);
1399:
1400: schedEnd(&srv->srv_blob.root);
1401: }
1402:
1403: /*
1404: * rpc_srv_loopBLOBServer() - Execute Main BLOB server loop and wait for clients requests
1405: *
1406: * @srv = RPC Server instance
1407: * return: -1 error or 0 ok, infinite loop ...
1408: */
1409: int
1410: rpc_srv_loopBLOBServer(rpc_srv_t * __restrict srv)
1411: {
1412: rpc_cli_t *c;
1413: register int i;
1414: rpc_blob_t *b, *tmp;
1415: struct timespec ts = { RPC_SCHED_POLLING, 0 };
1416:
1417: if (!srv || srv->srv_kill) {
1418: rpc_SetErr(EINVAL, "Invalid parameter can`t start BLOB server");
1419: return -1;
1420: }
1421:
1422: if (listen(srv->srv_blob.server.cli_sock, array_Size(srv->srv_blob.clients)) == -1) {
1423: LOGERR;
1424: return -1;
1425: }
1426:
1427: if (!schedSignal(srv->srv_blob.root, flushBLOB, srv, SIGFBLOB, NULL, 0)) {
1428: /* disabled kqueue support in libaitsched */
1429: struct sigaction sa;
1430:
1431: #ifdef atomic_store_rel_ptr
1432: atomic_store_rel_ptr(&_glSigArg, (uintptr_t) srv);
1433: #else
1434: *((volatile uintptr_t*) &_glSigArg) = (uintptr_t) srv;
1435: #endif
1436:
1437: memset(&sa, 0, sizeof sa);
1438: sigemptyset(&sa.sa_mask);
1439: sa.sa_handler = (void (*)(int)) flushBLOB;
1440: sa.sa_flags = SA_RESTART | SA_RESETHAND;
1441: sigaction(SIGFBLOB, &sa, NULL);
1442: }
1443:
1444: if (!schedRead(srv->srv_blob.root, acceptBLOBClients, srv,
1445: srv->srv_blob.server.cli_sock, NULL, 0)) {
1446: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
1447: return -1;
1448: }
1449:
1450: schedPolling(srv->srv_blob.root, &ts, NULL);
1451: /* main rpc loop */
1452: schedRun(srv->srv_blob.root, &srv->srv_blob.kill);
1453:
1454: /* detach blobs */
1455: TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) {
1456: TAILQ_REMOVE(&srv->srv_blob.blobs, b, blob_node);
1457:
1458: rpc_srv_blobFree(srv, b);
1459: e_free(b);
1460: }
1461:
1462: /* close all clients connections & server socket */
1463: for (i = 0; i < array_Size(srv->srv_blob.clients); i++) {
1464: c = array(srv->srv_blob.clients, i, rpc_cli_t*);
1465: if (c) {
1466: shutdown(c->cli_sock, SHUT_RDWR);
1467: close(c->cli_sock);
1468:
1469: schedCancelby(srv->srv_blob.root, taskMAX, CRITERIA_ARG, c, NULL);
1470: AIT_FREE_VAL(&c->cli_buf);
1471: }
1472: array_Del(srv->srv_blob.clients, i, 42);
1473: }
1474: array_Destroy(&srv->srv_blob.clients);
1475:
1476: close(srv->srv_blob.server.cli_sock);
1477:
1478: AIT_FREE_VAL(&srv->srv_blob.dir);
1479: return 0;
1480: }
1481:
1482:
1483: /*
1484: * rpc_srv_initServer() - Init & create RPC Server
1485: *
1486: * @InstID = Instance for authentication & recognition
1487: * @concurentClients = Concurent clients at same time to this server
1488: * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
1489: * @csHost = Host name or address for bind server, if NULL any address
1490: * @Port = Port for bind server, if Port == 0 default port is selected
1491: * @proto = Protocol, if == 0 choose SOCK_STREAM
1492: * return: NULL == error or !=NULL bind and created RPC server instance
1493: */
1494: rpc_srv_t *
1495: rpc_srv_initServer(u_char InstID, int concurentClients, int netBuf,
1496: const char *csHost, u_short Port, int proto)
1497: {
1498: int n = 1;
1499: rpc_srv_t *srv = NULL;
1500: sockaddr_t sa = E_SOCKADDR_INIT;
1501: socklen_t salen;
1502:
1503: if (!concurentClients || (proto < 0 || proto > SOCK_RAW)) {
1504: rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server");
1505: return NULL;
1506: }
1507: if (!Port && proto < SOCK_RAW)
1508: Port = RPC_DEFPORT;
1509: if (!(salen = e_gethostbyname(csHost, Port, &sa)))
1510: return NULL;
1511: if (!proto)
1512: proto = SOCK_STREAM;
1513: if (netBuf < RPC_MIN_BUFSIZ)
1514: netBuf = BUFSIZ;
1515: else
1516: netBuf = E_ALIGN(netBuf, 2); /* align netBuf length */
1517:
1518: #ifdef HAVE_SRANDOMDEV
1519: srandomdev();
1520: #else
1521: time_t tim;
1522:
1523: srandom((time(&tim) ^ getpid()));
1524: #endif
1525:
1526: srv = e_malloc(sizeof(rpc_srv_t));
1527: if (!srv) {
1528: LOGERR;
1529: return NULL;
1530: } else
1531: memset(srv, 0, sizeof(rpc_srv_t));
1532:
1533: srv->srv_proto = proto;
1534: srv->srv_netbuf = netBuf;
1535: srv->srv_session.sess_version = RPC_VERSION;
1536: srv->srv_session.sess_instance = InstID;
1537:
1538: srv->srv_server.cli_parent = srv;
1539: memcpy(&srv->srv_server.cli_sa, &sa, sizeof srv->srv_server.cli_sa);
1540:
1541: /* init functions */
1542: pthread_mutex_init(&srv->srv_funcs.mtx, NULL);
1543: SLIST_INIT(&srv->srv_funcs);
1544: AVL_INIT(&srv->srv_funcs);
1545:
1546: /* init scheduler */
1547: srv->srv_root = schedBegin();
1548: if (!srv->srv_root) {
1549: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
1550: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1551: e_free(srv);
1552: return NULL;
1553: }
1554:
1555: /* init pool for clients */
1556: srv->srv_clients = array_Init(concurentClients);
1557: if (!srv->srv_clients) {
1558: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
1559: schedEnd(&srv->srv_root);
1560: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1561: e_free(srv);
1562: return NULL;
1563: }
1564:
1565: /* create server socket */
1566: srv->srv_server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family,
1567: srv->srv_proto, srv->srv_proto == SOCK_RAW ? IPPROTO_ERPC : 0);
1568: if (srv->srv_server.cli_sock == -1) {
1569: LOGERR;
1570: array_Destroy(&srv->srv_clients);
1571: schedEnd(&srv->srv_root);
1572: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1573: e_free(srv);
1574: return NULL;
1575: }
1576: if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
1577: LOGERR;
1578: goto err;
1579: }
1580: if (srv->srv_proto == SOCK_STREAM)
1581: setsockopt(srv->srv_server.cli_sock, IPPROTO_TCP, TCP_NODELAY, &n, sizeof n);
1582: n = srv->srv_netbuf;
1583: if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
1584: LOGERR;
1585: goto err;
1586: }
1587: if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
1588: LOGERR;
1589: goto err;
1590: }
1591: if (bind(srv->srv_server.cli_sock, &srv->srv_server.cli_sa.sa, salen) == -1) {
1592: LOGERR;
1593: goto err;
1594: } else
1595: fcntl(srv->srv_server.cli_sock, F_SETFL,
1596: fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK);
1597:
1598: rpc_register_srvPing(srv);
1599:
1600: return srv;
1601: err: /* error condition */
1602: close(srv->srv_server.cli_sock);
1603: array_Destroy(&srv->srv_clients);
1604: schedEnd(&srv->srv_root);
1605: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1606: e_free(srv);
1607: return NULL;
1608: }
1609:
1610: /*
1611: * rpc_srv_endServer() - Destroy RPC server, close all opened sockets and free resources
1612: *
1613: * @psrv = RPC Server instance
1614: * return: none
1615: */
1616: void
1617: rpc_srv_endServer(rpc_srv_t ** __restrict psrv)
1618: {
1619: if (!psrv || !*psrv)
1620: return;
1621:
1622: /* if send kill to blob server */
1623: rpc_srv_endBLOBServer(*psrv);
1624: /* wait for BLOB server done */
1625: while (*(&(*psrv)->srv_blob.root))
1626: usleep(1000);
1627:
1628: (*psrv)->srv_kill = 1;
1629: sleep(RPC_SCHED_POLLING);
1630:
1631: if ((*psrv)->srv_server.cli_sa.sa.sa_family == AF_LOCAL)
1632: unlink((*psrv)->srv_server.cli_sa.sun.sun_path);
1633:
1634: schedEnd(&(*psrv)->srv_root);
1635:
1636: pthread_mutex_destroy(&(*psrv)->srv_funcs.mtx);
1637: e_free(*psrv);
1638: *psrv = NULL;
1639: }
1640:
1641: /*
1642: * rpc_srv_loopServer() - Execute Main server loop and wait for clients requests
1643: *
1644: * @srv = RPC Server instance
1645: * return: -1 error or 0 ok, infinite loop ...
1646: */
1647: int
1648: rpc_srv_loopServer(rpc_srv_t * __restrict srv)
1649: {
1650: rpc_cli_t *c;
1651: register int i;
1652: rpc_func_t *f;
1653: struct timespec ts = { RPC_SCHED_POLLING, 0 };
1654:
1655: if (!srv) {
1656: rpc_SetErr(EINVAL, "Invalid parameter can`t start RPC server");
1657: return -1;
1658: }
1659:
1660: if (srv->srv_proto == SOCK_STREAM)
1661: if (listen(srv->srv_server.cli_sock, array_Size(srv->srv_clients)) == -1) {
1662: LOGERR;
1663: return -1;
1664: }
1665:
1666: if (!schedRead(srv->srv_root, cbProto[srv->srv_proto][CB_ACCEPTCLIENT], srv,
1667: srv->srv_server.cli_sock, NULL, 0)) {
1668: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
1669: return -1;
1670: }
1671:
1672: schedPolling(srv->srv_root, &ts, NULL);
1673: /* main rpc loop */
1674: schedRun(srv->srv_root, &srv->srv_kill);
1675:
1676: /* close all clients connections & server socket */
1677: for (i = 0; i < array_Size(srv->srv_clients); i++) {
1678: c = array(srv->srv_clients, i, rpc_cli_t*);
1679: if (c) {
1680: if (srv->srv_proto == SOCK_STREAM) {
1681: shutdown(c->cli_sock, SHUT_RDWR);
1682: close(c->cli_sock);
1683: }
1684:
1685: schedCancelby(srv->srv_root, taskMAX, CRITERIA_ARG, c, NULL);
1686: ait_freeVars(&RPC_RETVARS(c));
1687: AIT_FREE_VAL(&c->cli_buf);
1688: }
1689: array_Del(srv->srv_clients, i, 42);
1690: }
1691: array_Destroy(&srv->srv_clients);
1692:
1693: if (srv->srv_proto != SOCK_EXT)
1694: close(srv->srv_server.cli_sock);
1695:
1696: /* detach exported calls */
1697: RPC_FUNCS_LOCK(&srv->srv_funcs);
1698: while ((f = SLIST_FIRST(&srv->srv_funcs))) {
1699: SLIST_REMOVE_HEAD(&srv->srv_funcs, func_next);
1700:
1701: AIT_FREE_VAL(&f->func_name);
1702: e_free(f);
1703: }
1704: srv->srv_funcs.avlh_root = NULL;
1705: RPC_FUNCS_UNLOCK(&srv->srv_funcs);
1706:
1707: return 0;
1708: }
1709:
1710:
1711: /*
1712: * rpc_srv_execCall() Execute registered call from RPC server
1713: *
1714: * @cli = RPC client
1715: * @rpc = IN RPC call structure
1716: * @funcname = Execute RPC function
1717: * @args = IN RPC calling arguments from RPC client
1718: * return: -1 error, !=-1 ok
1719: */
1720: int
1721: rpc_srv_execCall(rpc_cli_t * __restrict cli, struct tagRPCCall * __restrict rpc,
1722: ait_val_t funcname, array_t * __restrict args)
1723: {
1724: rpc_callback_t func;
1725:
1726: if (!cli || !rpc || !AIT_ADDR(&funcname)) {
1727: rpc_SetErr(EINVAL, "Invalid parameter can`t exec function");
1728: return -1;
1729: }
1730:
1731: func = AIT_GET_LIKE(&funcname, rpc_callback_t);
1732: return func(cli, rpc, args);
1733: }
1734:
1735:
1736: /*
1737: * rpc_srv_initServer2() - Init & create layer2 RPC Server
1738: *
1739: * @InstID = Instance for authentication & recognition
1740: * @concurentClients = Concurent clients at same time to this server
1741: * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
1742: * @csIface = Interface name for bind server, if NULL first interface on host
1743: * return: NULL == error or !=NULL bind and created RPC server instance
1744: */
1745: rpc_srv_t *
1746: rpc_srv_initServer2(u_char InstID, int concurentClients, int netBuf, const char *csIface)
1747: {
1748: #ifndef __linux__
1749: int n = 1;
1750: rpc_srv_t *srv = NULL;
1751: sockaddr_t sa = E_SOCKADDR_INIT;
1752: char szIface[64], szStr[STRSIZ];
1753: register int i;
1754: struct ifreq ifr;
1755: struct bpf_insn insns[] = {
1756: BPF_STMT(BPF_LD + BPF_H + BPF_ABS, 12),
1757: BPF_JUMP(BPF_JMP + BPF_JEQ + BPF_K, RPC_DEFPORT, 0, 1),
1758: BPF_STMT(BPF_RET + BPF_K, -1),
1759: BPF_STMT(BPF_RET + BPF_K, 0),
1760: };
1761: struct bpf_program fcode = {
1762: .bf_len = sizeof(insns) / sizeof(struct bpf_insn),
1763: .bf_insns = insns
1764: };
1765:
1766: if (!concurentClients) {
1767: rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server");
1768: return NULL;
1769: }
1770: if (!csIface) {
1771: if (e_get1stiface(szIface, sizeof szIface))
1772: return NULL;
1773: } else
1774: strlcpy(szIface, csIface, sizeof szIface);
1775: if (!e_getifacebyname(szIface, &sa))
1776: return NULL;
1777:
1778: #ifdef HAVE_SRANDOMDEV
1779: srandomdev();
1780: #else
1781: time_t tim;
1782:
1783: srandom((time(&tim) ^ getpid()));
1784: #endif
1785:
1786: srv = e_malloc(sizeof(rpc_srv_t));
1787: if (!srv) {
1788: LOGERR;
1789: return NULL;
1790: } else
1791: memset(srv, 0, sizeof(rpc_srv_t));
1792:
1793: srv->srv_proto = SOCK_BPF;
1794: srv->srv_netbuf = netBuf;
1795: srv->srv_session.sess_version = RPC_VERSION;
1796: srv->srv_session.sess_instance = InstID;
1797:
1798: srv->srv_server.cli_parent = srv;
1799: memcpy(&srv->srv_server.cli_sa, &sa, sizeof srv->srv_server.cli_sa);
1800:
1801: /* init functions */
1802: pthread_mutex_init(&srv->srv_funcs.mtx, NULL);
1803: SLIST_INIT(&srv->srv_funcs);
1804: AVL_INIT(&srv->srv_funcs);
1805:
1806: /* init scheduler */
1807: srv->srv_root = schedBegin();
1808: if (!srv->srv_root) {
1809: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
1810: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1811: e_free(srv);
1812: return NULL;
1813: }
1814:
1815: /* init pool for clients */
1816: srv->srv_clients = array_Init(concurentClients);
1817: if (!srv->srv_clients) {
1818: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
1819: schedEnd(&srv->srv_root);
1820: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1821: e_free(srv);
1822: return NULL;
1823: }
1824:
1825: /* create server handler */
1826: for (i = 0; i < 10; i++) {
1827: memset(szStr, 0, sizeof szStr);
1828: snprintf(szStr, sizeof szStr, "/dev/bpf%d", i);
1829: srv->srv_server.cli_sock = open(szStr, O_RDWR);
1830: if (srv->srv_server.cli_sock > STDERR_FILENO)
1831: break;
1832: }
1833: if (srv->srv_server.cli_sock < 3) {
1834: LOGERR;
1835: array_Destroy(&srv->srv_clients);
1836: schedEnd(&srv->srv_root);
1837: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1838: e_free(srv);
1839: return NULL;
1840: }
1841:
1842: if (ioctl(srv->srv_server.cli_sock, BIOCIMMEDIATE, &n) == -1) {
1843: LOGERR;
1844: goto err;
1845: }
1846: if (ioctl(srv->srv_server.cli_sock, BIOCSETF, &fcode) == -1) {
1847: LOGERR;
1848: goto err;
1849: }
1850: n = (netBuf < RPC_MIN_BUFSIZ) ? getpagesize() : E_ALIGN(netBuf, 2);
1851: if (ioctl(srv->srv_server.cli_sock, BIOCSBLEN, &n) == -1) {
1852: LOGERR;
1853: goto err;
1854: } else
1855: srv->srv_netbuf = n;
1856:
1857: memset(&ifr, 0, sizeof ifr);
1858: strlcpy(ifr.ifr_name, szIface, sizeof ifr.ifr_name);
1859: if (ioctl(srv->srv_server.cli_sock, BIOCSETIF, &ifr) == -1) {
1860: LOGERR;
1861: goto err;
1862: } else
1863: fcntl(srv->srv_server.cli_sock, F_SETFL,
1864: fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK);
1865:
1866: rpc_register_srvPing(srv);
1867:
1868: return srv;
1869: err: /* error condition */
1870: close(srv->srv_server.cli_sock);
1871: array_Destroy(&srv->srv_clients);
1872: schedEnd(&srv->srv_root);
1873: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1874: e_free(srv);
1875: #else
1876: rpc_SetErr(ENOTSUP, "Feature isn't supported on Linux!");
1877: #endif
1878:
1879: return NULL;
1880: }
1881:
1882: /*
1883: * rpc_srv_initServerExt() - Init & create pipe RPC Server
1884: *
1885: * @InstID = Instance for authentication & recognition
1886: * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
1887: * @fd = File descriptor
1888: * return: NULL == error or !=NULL bind and created RPC server instance
1889: */
1890: rpc_srv_t *
1891: rpc_srv_initServerExt(u_char InstID, int netBuf, int fd)
1892: {
1893: rpc_srv_t *srv = NULL;
1894:
1895: #ifdef HAVE_SRANDOMDEV
1896: srandomdev();
1897: #else
1898: time_t tim;
1899:
1900: srandom((time(&tim) ^ getpid()));
1901: #endif
1902:
1903: srv = e_malloc(sizeof(rpc_srv_t));
1904: if (!srv) {
1905: LOGERR;
1906: return NULL;
1907: } else
1908: memset(srv, 0, sizeof(rpc_srv_t));
1909:
1910: srv->srv_proto = SOCK_EXT;
1911: srv->srv_netbuf = (netBuf < RPC_MIN_BUFSIZ) ?
1912: getpagesize() : E_ALIGN(netBuf, 2);
1913: srv->srv_session.sess_version = RPC_VERSION;
1914: srv->srv_session.sess_instance = InstID;
1915:
1916: srv->srv_server.cli_parent = srv;
1917: srv->srv_server.cli_sock = fd;
1918:
1919: /* init functions */
1920: pthread_mutex_init(&srv->srv_funcs.mtx, NULL);
1921: SLIST_INIT(&srv->srv_funcs);
1922: AVL_INIT(&srv->srv_funcs);
1923:
1924: /* init scheduler */
1925: srv->srv_root = schedBegin();
1926: if (!srv->srv_root) {
1927: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
1928: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1929: e_free(srv);
1930: return NULL;
1931: }
1932:
1933: /* init pool for clients */
1934: srv->srv_clients = array_Init(1);
1935: if (!srv->srv_clients) {
1936: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
1937: schedEnd(&srv->srv_root);
1938: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1939: e_free(srv);
1940: return NULL;
1941: }
1942:
1943: fcntl(srv->srv_server.cli_sock, F_SETFL,
1944: fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK);
1945:
1946: rpc_register_srvPing(srv);
1947:
1948: return srv;
1949: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>