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.17.4.8 2013/08/21 15:28:16 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, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013
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:
62: static sched_task_func_t cbProto[SOCK_RAW + 1][4] = {
63: { acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */
64: { acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */
65: { rxUDPPacket, freeClient, rxUDPPacket, txUDPPacket }, /* SOCK_DGRAM */
66: { NULL, NULL, NULL, NULL } /* SOCK_RAW */
67: };
68:
69:
70: ait_val_t *
71: rpc_getBufVar(rpc_cli_t * __restrict c)
72: {
73: return array(c->cli_buf, RPC_ISNEXTBUF(c), ait_val_t*);
74: }
75:
76: u_char *
77: rpc_getBuffer(rpc_cli_t * __restrict c)
78: {
79: u_char *b = NULL;
80:
81: assert(c);
82:
83: if (RPC_ISNEXTBUF(c))
84: b = AIT_GET_BUF(array(c->cli_buf, 1, ait_val_t*));
85: else
86: b = AIT_GET_BUF(array(c->cli_buf, 0, ait_val_t*)) +
87: sizeof(struct tagRPCCall);
88:
89: return b;
90: }
91:
92: struct tagRPCCall *
93: rpc_getHeader(rpc_cli_t * __restrict c)
94: {
95: assert(c);
96:
97: return (struct tagRPCCall*) AIT_GET_BUF(array(c->cli_buf, 0, ait_val_t*));
98: }
99:
100: void
101: rpc_freeCli(rpc_cli_t * __restrict c)
102: {
103: rpc_srv_t *s = c->cli_parent;
104:
105: schedCancelby(s->srv_root, taskMAX, CRITERIA_ARG, c, NULL);
106:
107: /* free buffer(s) */
108: ait_freeVars(&c->cli_buf);
109:
110: array_Del(s->srv_clients, c->cli_id, 0);
111: if (c)
112: e_free(c);
113: }
114:
115:
116: static inline int
117: _check4freeslot(rpc_srv_t * __restrict srv, sockaddr_t * __restrict sa)
118: {
119: rpc_cli_t *c = NULL;
120: register int i;
121:
122: /* check free slots for connect */
123: for (i = 0; i < array_Size(srv->srv_clients) &&
124: (c = array(srv->srv_clients, i, rpc_cli_t*)); i++)
125: /* check for duplicates */
126: if (sa && !e_addrcmp(&c->cli_sa, sa, 42))
127: break;
128: if (i >= array_Size(srv->srv_clients))
129: return -1; /* no more free slots! */
130:
131: return i;
132: }
133:
134: static rpc_cli_t *
135: _allocClient(rpc_srv_t * __restrict srv, sockaddr_t * __restrict sa)
136: {
137: rpc_cli_t *c = NULL;
138: int n;
139:
140: n = _check4freeslot(srv, sa);
141: if (n == -1)
142: return NULL;
143: else
144: c = array(srv->srv_clients, n, rpc_cli_t*);
145:
146: if (!c) {
147: c = e_malloc(sizeof(rpc_cli_t));
148: if (!c) {
149: LOGERR;
150: srv->srv_kill = 1;
151: return NULL;
152: } else {
153: memset(c, 0, sizeof(rpc_cli_t));
154: array_Set(srv->srv_clients, n, c);
155: c->cli_id = n;
156: c->cli_parent = srv;
157: }
158:
159: /* init buffer(s) */
160: c->cli_buf = ait_allocVars(2);
161: if (!c->cli_buf) {
162: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
163: array_Del(srv->srv_clients, n, 42);
164: return NULL;
165: } else
166: AIT_SET_BUFSIZ(array(c->cli_buf, 0, ait_val_t*), 0, srv->srv_netbuf);
167: }
168:
169: return c;
170: }
171:
172:
173: static void *
174: freeClient(sched_task_t *task)
175: {
176: rpc_freeCli(TASK_ARG(task));
177:
178: return NULL;
179: }
180:
181: static void *
182: closeClient(sched_task_t *task)
183: {
184: int sock = ((rpc_cli_t*) TASK_ARG(task))->cli_sock;
185:
186: rpc_freeCli(TASK_ARG(task));
187:
188: /* close client socket */
189: shutdown(sock, SHUT_RDWR);
190: close(sock);
191: return NULL;
192: }
193:
194: static void *
195: txPacket(sched_task_t *task)
196: {
197: rpc_cli_t *c = TASK_ARG(task);
198: rpc_srv_t *s = c->cli_parent;
199: rpc_func_t *f = NULL;
200: u_char *buf;
201: struct tagRPCCall *rpc = (struct tagRPCCall*) TASK_DATA(task);
202: int ret, wlen = sizeof(struct tagRPCCall);
203: int len = sizeof(struct tagRPCCall) + ntohl(rpc->call_len);
204:
205: buf = e_malloc(len);
206: if (!buf) {
207: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
208: /* close connection */
209: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
210: TASK_ARG(task), 0, NULL, 0);
211: return NULL;
212: } else {
213: /* copy RPC header */
214: memcpy(buf, rpc, wlen);
215: rpc = (struct tagRPCCall*) buf;
216: }
217:
218: if (rpc->call_argc) {
219: f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
220: if (!f) {
221: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
222:
223: rpc->call_argc ^= rpc->call_argc;
224: rpc->call_rep.ret = RPC_ERROR(-1);
225: rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
226: } else {
227: rpc->call_argc = htons(array_Size(RPC_RETVARS(c)));
228: /* Go Encapsulate variables */
229: ret = ait_vars2buffer(buf + wlen, len - wlen, RPC_RETVARS(c));
230: /* Free return values */
231: ait_freeVars(&c->cli_vars);
232: if (ret == -1) {
233: rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
234:
235: rpc->call_argc ^= rpc->call_argc;
236: rpc->call_rep.ret = RPC_ERROR(-1);
237: rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
238: } else
239: wlen += ret;
240: }
241: }
242:
243: rpc->call_len = htonl(wlen);
244:
245: /* send reply */
246: ret = send(TASK_FD(task), buf, wlen, MSG_NOSIGNAL);
247: if (ret == -1 || ret != wlen) {
248: /* close connection */
249: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
250: TASK_ARG(task), 0, NULL, 0);
251: }
252:
253: e_free(buf);
254: return NULL;
255: }
256:
257: static void *
258: execCall(sched_task_t *task)
259: {
260: rpc_cli_t *c = TASK_ARG(task);
261: rpc_srv_t *s = c->cli_parent;
262: rpc_func_t *f = NULL;
263: array_t *arr = NULL;
264: u_char *buf = rpc_getBuffer(c);
265: struct tagRPCCall *rpc = rpc_getHeader(c);
266: int argc = ntohs(rpc->call_argc);
267:
268: /* Go decapsulate variables ... */
269: if (argc) {
270: arr = ait_buffer2vars(buf, ntohl(rpc->call_len), argc, 42);
271: if (!arr) {
272: rpc_SetErr(ERPCMISMATCH, "#%d - %s", elwix_GetErrno(), elwix_GetError());
273:
274: rpc->call_argc ^= rpc->call_argc;
275: rpc->call_rep.ret = RPC_ERROR(-1);
276: rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
277: return NULL;
278: }
279: } else
280: arr = NULL;
281:
282: if (!(f = rpc_srv_getCall(s, ntohs(rpc->call_tag)))) {
283: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
284:
285: rpc->call_argc ^= rpc->call_argc;
286: rpc->call_rep.ret = RPC_ERROR(-1);
287: rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
288: } else {
289: /* if client doesn't want reply */
290: argc = RPC_CHK_NOREPLY(rpc);
291: rpc->call_rep.ret = RPC_ERROR(rpc_srv_execCall(c, rpc, f->func_name, arr));
292: if (rpc->call_rep.ret == htonl(-1)) {
293: rpc->call_rep.eno = RPC_ERROR(errno);
294: rpc->call_argc ^= rpc->call_argc;
295: } else {
296: rpc->call_rep.eno ^= rpc->call_rep.eno;
297: if (argc) {
298: /* without reply */
299: ait_freeVars(&c->cli_vars);
300: rpc->call_argc ^= rpc->call_argc;
301: } else {
302: /* reply */
303: rpc->call_argc = htons(array_Size(RPC_RETVARS(c)));
304: }
305: }
306: }
307:
308: array_Destroy(&arr);
309: return NULL;
310: }
311:
312: static void *
313: rxPacket(sched_task_t *task)
314: {
315: rpc_cli_t *c = TASK_ARG(task);
316: rpc_srv_t *s = c->cli_parent;
317: int len, rlen, noreply;
318: ait_val_t *bufz = array(c->cli_buf, 0, ait_val_t*);
319: u_char *buf = (u_char*) AIT_GET_BUF(bufz);
320: struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
321:
322: memset(buf, 0, AIT_LEN(bufz));
323: /* 1st buffer is last */
324: RPC_CLR_NEXTBUF(c);
325:
326: /* read rpc header */
327: rlen = recv(TASK_FD(task), rpc, MIN(sizeof(struct tagRPCCall), AIT_LEN(bufz)), 0);
328: if (rlen < sizeof(struct tagRPCCall) ||
329: ntohl(rpc->call_len) < sizeof(struct tagRPCCall)) {
330: /* close connection */
331: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
332: TASK_ARG(task), 0, NULL, 0);
333: return NULL;
334: } else {
335: buf += sizeof(struct tagRPCCall);
336: len = ntohl(rpc->call_len);
337: }
338:
339: if (len > (AIT_LEN(bufz) - sizeof(struct tagRPCCall))) {
340: /* add extra buffer */
341: if (!(bufz = ait_getVars(&c->cli_buf, 1))) {
342: /* close connection */
343: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
344: TASK_ARG(task), 0, NULL, 0);
345: return NULL;
346: } else {
347: AIT_FREE_VAL(bufz);
348: AIT_SET_BUFSIZ(bufz, 0, len);
349: buf = AIT_GET_BUF(bufz);
350: }
351: /* buffer isnt last */
352: RPC_SET_NEXTBUF(c);
353: }
354:
355: /* read payload */
356: rlen = recv(TASK_FD(task), buf, len, 0);
357: if (rlen < len) {
358: /* close connection */
359: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
360: TASK_ARG(task), 0, NULL, 0);
361: return NULL;
362: }
363:
364: noreply = RPC_CHK_NOREPLY(rpc);
365:
366: /* check RPC packet session info */
367: if (rpc_chkPktSession(&rpc->call_session, &s->srv_session)) {
368: rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
369:
370: rpc->call_argc ^= rpc->call_argc;
371: rpc->call_rep.ret = RPC_ERROR(-1);
372: rpc->call_rep.eno = RPC_ERROR(errno);
373: } else {
374: /* execute RPC call */
375: schedEvent(TASK_ROOT(task), execCall, TASK_ARG(task), noreply, rpc, len);
376: }
377:
378: /* send RPC reply */
379: if (!noreply)
380: schedWrite(TASK_ROOT(task), cbProto[s->srv_proto][CB_TXPACKET],
381: TASK_ARG(task), TASK_FD(task), rpc, len);
382:
383: /* lets get next packet */
384: schedReadSelf(task);
385: return NULL;
386: }
387:
388: static void *
389: acceptClients(sched_task_t *task)
390: {
391: rpc_srv_t *srv = TASK_ARG(task);
392: rpc_cli_t *c = NULL;
393: socklen_t salen = sizeof(sockaddr_t);
394:
395: c = _allocClient(srv, NULL);
396: if (!c)
397: goto end;
398:
399: /* accept client */
400: c->cli_sock = accept(TASK_FD(task), &c->cli_sa.sa, &salen);
401: if (c->cli_sock == -1) {
402: LOGERR;
403: ait_freeVars(&c->cli_buf);
404: array_Del(srv->srv_clients, c->cli_id, 42);
405: goto end;
406: } else
407: fcntl(c->cli_sock, F_SETFL, fcntl(c->cli_sock, F_GETFL) | O_NONBLOCK);
408:
409: schedRead(TASK_ROOT(task), cbProto[srv->srv_proto][CB_RXPACKET], c,
410: c->cli_sock, NULL, 0);
411: end:
412: schedReadSelf(task);
413: return NULL;
414: }
415:
416:
417: static void *
418: txUDPPacket(sched_task_t *task)
419: {
420: rpc_cli_t *c = TASK_ARG(task);
421: rpc_srv_t *s = c->cli_parent;
422: rpc_func_t *f = NULL;
423: u_char *buf;
424: struct tagRPCCall *rpc = (struct tagRPCCall*) TASK_DATA(task);
425: int ret, wlen = sizeof(struct tagRPCCall);
426: int len = sizeof(struct tagRPCCall) + ntohl(rpc->call_len);
427: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
428:
429: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
430: schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
431: TASK_ARG(task), ts, TASK_ARG(task), 0);
432:
433: buf = e_malloc(len);
434: if (!buf) {
435: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
436: /* close connection */
437: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
438: TASK_ARG(task), 0, NULL, 0);
439: return NULL;
440: } else {
441: /* copy RPC header */
442: memcpy(buf, rpc, wlen);
443: rpc = (struct tagRPCCall*) buf;
444: }
445:
446: if (rpc->call_argc) {
447: f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
448: if (!f) {
449: rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
450:
451: rpc->call_argc ^= rpc->call_argc;
452: rpc->call_rep.ret = RPC_ERROR(-1);
453: rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
454: } else {
455: rpc->call_argc = htons(array_Size(RPC_RETVARS(c)));
456: /* Go Encapsulate variables */
457: ret = ait_vars2buffer(buf + wlen, len - wlen, RPC_RETVARS(c));
458: /* Free return values */
459: ait_freeVars(&c->cli_vars);
460: if (ret == -1) {
461: rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
462:
463: rpc->call_argc ^= rpc->call_argc;
464: rpc->call_rep.ret = RPC_ERROR(-1);
465: rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
466: } else
467: wlen += ret;
468: }
469: }
470:
471: rpc->call_len = htonl(wlen);
472:
473: /* calculate CRC */
474: rpc->call_crc ^= rpc->call_crc;
475: rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
476:
477: /* send reply */
478: ret = sendto(TASK_FD(task), buf, wlen, MSG_NOSIGNAL,
479: &c->cli_sa.sa, c->cli_sa.sa.sa_len);
480: if (ret == -1 || ret != wlen) {
481: /* close connection */
482: schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],
483: TASK_ARG(task), 0, NULL, 0);
484: }
485:
486: e_free(buf);
487: return NULL;
488: }
489:
490: static void *
491: rxUDPPacket(sched_task_t *task)
492: {
493: rpc_srv_t *srv = TASK_ARG(task);
494: rpc_cli_t *c = NULL;
495: int len, rlen, noreply;
496: ait_val_t *bufz;
497: u_char *buf = NULL;
498: struct tagRPCCall rpcbuf, *rpc;
499: sockaddr_t sa[2];
500: socklen_t salen;
501: struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
502:
503: memset(&rpcbuf, 0, sizeof rpcbuf);
504:
505: /* receive connect packet */
506: salen = sa[0].ss.ss_len = sizeof(sockaddr_t);
507: rlen = recvfrom(TASK_FD(task), &rpcbuf, sizeof rpcbuf, 0, &sa[0].sa, &salen);
508: if (rlen < sizeof(struct tagRPCCall) || ntohl(rpcbuf.call_len) < sizeof(struct tagRPCCall))
509: goto end;
510: else
511: len = ntohl(rpcbuf.call_len);
512:
513: buf = e_malloc(len);
514: if (!buf)
515: goto end;
516: else
517: memset(buf, 0, len);
518:
519: /* read payload */
520: salen = sa[1].ss.ss_len = sizeof(sockaddr_t);
521: rlen = recvfrom(TASK_FD(task), buf, len, 0, &sa[1].sa, &salen);
522: if (rlen < len || memcmp(&sa[0], &sa[1], sizeof sa[0]))
523: goto end;
524:
525: c = _allocClient(srv, sa);
526: if (!c)
527: goto end;
528: else {
529: /* add extra buffer */
530: if (!(bufz = ait_getVars(&c->cli_buf, 1)))
531: goto end;
532: else {
533: AIT_FREE_VAL(bufz);
534: AIT_SET_BUFSIZ(bufz, 0, len);
535: /* buffer isnt last */
536: RPC_SET_NEXTBUF(c);
537: }
538:
539: rpc = rpc_getHeader(c);
540: memcpy(rpc, &rpcbuf, sizeof(struct tagRPCCall));
541: memcpy(rpc_getBuffer(c), buf, len);
542:
543: c->cli_sock = TASK_FD(task);
544: memcpy(&c->cli_sa, sa, sizeof c->cli_sa);
545: /* armed timer for close stateless connection */
546: schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
547: schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],
548: c, ts, c, 0);
549: }
550:
551: /* check integrity of packet */
552: if (ntohs(rpc->call_crc) != crcFletcher16((u_short*) buf, len / 2)) {
553: rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");
554: goto end;
555: }
556:
557: noreply = RPC_CHK_NOREPLY(rpc);
558:
559: /* check RPC packet session info */
560: if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) {
561: rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
562:
563: rpc->call_argc ^= rpc->call_argc;
564: rpc->call_rep.ret = RPC_ERROR(-1);
565: rpc->call_rep.eno = RPC_ERROR(errno);
566: } else {
567: /* execute RPC call */
568: schedEvent(TASK_ROOT(task), execCall, c, noreply, rpc, len);
569: }
570:
571: /* send RPC reply */
572: if (!noreply)
573: schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],
574: c, TASK_FD(task), rpc, len);
575: end:
576: if (buf)
577: e_free(buf);
578: schedReadSelf(task);
579: return NULL;
580: }
581:
582: /* ------------------------------------------------------ */
583:
584: void
585: rpc_freeBLOBCli(rpc_cli_t * __restrict c)
586: {
587: rpc_srv_t *s = c->cli_parent;
588:
589: schedCancelby(s->srv_blob.root, taskMAX, CRITERIA_ARG, c, NULL);
590:
591: /* free buffer(s) */
592: ait_freeVars(&c->cli_buf);
593:
594: array_Del(s->srv_blob.clients, c->cli_id, 0);
595: if (c)
596: e_free(c);
597: }
598:
599:
600: static void *
601: closeBLOBClient(sched_task_t *task)
602: {
603: int sock = ((rpc_cli_t*) TASK_ARG(task))->cli_sock;
604:
605: rpc_freeBLOBCli(TASK_ARG(task));
606:
607: /* close client socket */
608: shutdown(sock, SHUT_RDWR);
609: close(sock);
610: return NULL;
611: }
612:
613: static void *
614: txBLOB(sched_task_t *task)
615: {
616: rpc_cli_t *c = TASK_ARG(task);
617: u_char *buf = AIT_GET_BUF(array(c->cli_buf, 0, ait_val_t*));
618: int wlen = sizeof(struct tagBLOBHdr);
619:
620: /* send reply */
621: wlen = send(TASK_FD(task), buf, wlen, MSG_NOSIGNAL);
622: if (wlen == -1 || wlen != sizeof(struct tagBLOBHdr)) {
623: /* close blob connection */
624: schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);
625: }
626:
627: return NULL;
628: }
629:
630: static void *
631: rxBLOB(sched_task_t *task)
632: {
633: rpc_cli_t *c = TASK_ARG(task);
634: rpc_srv_t *s = c->cli_parent;
635: rpc_blob_t *b;
636: struct tagBLOBHdr blob;
637: int rlen;
638:
639: memset(&blob, 0, sizeof blob);
640: rlen = recv(TASK_FD(task), &blob, sizeof blob, 0);
641: if (rlen < 1) {
642: /* close blob connection */
643: schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);
644: return NULL;
645: }
646:
647: /* check BLOB packet */
648: if (rlen < sizeof(struct tagBLOBHdr)) {
649: rpc_SetErr(ERPCMISMATCH, "Short BLOB packet");
650:
651: schedReadSelf(task);
652: return NULL;
653: }
654:
655: /* check RPC packet session info */
656: if (rpc_chkPktSession(&blob.hdr_session, &s->srv_session)) {
657: rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
658: blob.hdr_cmd = error;
659: goto end;
660: }
661:
662: /* Go to proceed packet ... */
663: switch (blob.hdr_cmd) {
664: case get:
665: if (!(b = rpc_srv_getBLOB(s, ntohl(blob.hdr_var)))) {
666: rpc_SetErr(EINVAL, "Var=%x not found", ntohl(blob.hdr_var));
667: blob.hdr_cmd = no;
668: blob.hdr_ret = RPC_ERROR(-1);
669: break;
670: } else
671: blob.hdr_len = htonl(b->blob_len);
672:
673: if (rpc_srv_blobMap(s, b) != -1) {
674: /* deliver BLOB variable to client */
675: blob.hdr_ret = htonl(rpc_srv_sendBLOB(c, b));
676: rpc_srv_blobUnmap(b);
677: } else {
678: blob.hdr_cmd = error;
679: blob.hdr_ret = RPC_ERROR(-1);
680: }
681: break;
682: case set:
683: if ((b = rpc_srv_registerBLOB(s, ntohl(blob.hdr_len),
684: ntohl(blob.hdr_ret)))) {
685: /* set new BLOB variable for reply :) */
686: blob.hdr_var = htonl(b->blob_var);
687:
688: /* receive BLOB from client */
689: blob.hdr_ret = htonl(rpc_srv_recvBLOB(c, b));
690: rpc_srv_blobUnmap(b);
691: } else {
692: blob.hdr_cmd = error;
693: blob.hdr_ret = RPC_ERROR(-1);
694: }
695: break;
696: case unset:
697: if (rpc_srv_unregisterBLOB(s, ntohl(blob.hdr_var)) == -1) {
698: blob.hdr_cmd = error;
699: blob.hdr_ret = RPC_ERROR(-1);
700: }
701: break;
702: default:
703: rpc_SetErr(EPROCUNAVAIL, "Unsupported BLOB command %d", blob.hdr_cmd);
704: blob.hdr_cmd = error;
705: blob.hdr_ret = RPC_ERROR(-1);
706: }
707:
708: end:
709: memcpy(AIT_ADDR(array(c->cli_buf, 0, ait_val_t*)), &blob, sizeof blob);
710: schedWrite(TASK_ROOT(task), txBLOB, TASK_ARG(task), TASK_FD(task), NULL, 0);
711: schedReadSelf(task);
712: return NULL;
713: }
714:
715: static void *
716: flushBLOB(sched_task_t *task)
717: {
718: rpc_srv_t *srv = TASK_ARG(task);
719: rpc_blob_t *b, *tmp;
720:
721: TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) {
722: TAILQ_REMOVE(&srv->srv_blob.blobs, b, blob_node);
723:
724: rpc_srv_blobFree(srv, b);
725: e_free(b);
726: }
727:
728: schedSignalSelf(task);
729: return NULL;
730: }
731:
732: static void *
733: acceptBLOBClients(sched_task_t *task)
734: {
735: rpc_srv_t *srv = TASK_ARG(task);
736: rpc_cli_t *c = NULL;
737: register int i;
738: socklen_t salen = sizeof(sockaddr_t);
739: #ifdef TCP_NOPUSH
740: int n = 1;
741: #endif
742:
743: /* check free slots for connect */
744: for (i = 0; i < array_Size(srv->srv_blob.clients) &&
745: (c = array(srv->srv_blob.clients, i, rpc_cli_t*)); i++);
746: if (c) /* no more free slots! */
747: goto end;
748: c = e_malloc(sizeof(rpc_cli_t));
749: if (!c) {
750: LOGERR;
751: srv->srv_kill = srv->srv_blob.kill = 1;
752: return NULL;
753: } else {
754: memset(c, 0, sizeof(rpc_cli_t));
755: array_Set(srv->srv_blob.clients, i, c);
756: c->cli_id = i;
757: c->cli_parent = srv;
758: }
759:
760: /* init buffer(s) */
761: c->cli_buf = ait_allocVars(1);
762: if (!c->cli_buf) {
763: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
764: array_Del(srv->srv_blob.clients, i, 42);
765: goto end;
766: } else
767: AIT_SET_BUFSIZ(array(c->cli_buf, 0, ait_val_t*), 0, srv->srv_netbuf);
768:
769: /* accept client */
770: c->cli_sock = accept(TASK_FD(task), &c->cli_sa.sa, &salen);
771: if (c->cli_sock == -1) {
772: LOGERR;
773: ait_freeVars(&c->cli_buf);
774: array_Del(srv->srv_blob.clients, i, 42);
775: goto end;
776: } else {
777: #ifdef TCP_NOPUSH
778: setsockopt(c->cli_sock, IPPROTO_TCP, TCP_NOPUSH, &n, sizeof n);
779: #endif
780: fcntl(c->cli_sock, F_SETFL, fcntl(c->cli_sock, F_GETFL) | O_NONBLOCK);
781: }
782:
783: schedRead(TASK_ROOT(task), rxBLOB, c, c->cli_sock, NULL, 0);
784: end:
785: schedReadSelf(task);
786: return NULL;
787: }
788:
789: /* ------------------------------------------------------ */
790:
791: /*
792: * rpc_srv_initBLOBServer() - Init & create BLOB Server
793: *
794: * @srv = RPC server instance
795: * @Port = Port for bind server, if Port == 0 default port is selected
796: * @diskDir = Disk place for BLOB file objects
797: * return: -1 == error or 0 bind and created BLOB server instance
798: */
799: int
800: rpc_srv_initBLOBServer(rpc_srv_t * __restrict srv, u_short Port, const char *diskDir)
801: {
802: int n = 1;
803:
804: if (!srv || srv->srv_kill) {
805: rpc_SetErr(EINVAL, "Invalid parameters can`t init BLOB server");
806: return -1;
807: }
808:
809: memset(&srv->srv_blob, 0, sizeof srv->srv_blob);
810: if (access(diskDir, R_OK | W_OK) == -1) {
811: LOGERR;
812: return -1;
813: } else
814: AIT_SET_STR(&srv->srv_blob.dir, diskDir);
815:
816: /* init blob list */
817: TAILQ_INIT(&srv->srv_blob.blobs);
818:
819: srv->srv_blob.server.cli_parent = srv;
820:
821: memcpy(&srv->srv_blob.server.cli_sa, &srv->srv_server.cli_sa, sizeof(sockaddr_t));
822: switch (srv->srv_blob.server.cli_sa.sa.sa_family) {
823: case AF_INET:
824: srv->srv_blob.server.cli_sa.sin.sin_port =
825: htons(Port ? Port : ntohs(srv->srv_blob.server.cli_sa.sin.sin_port) + 1);
826: break;
827: case AF_INET6:
828: srv->srv_blob.server.cli_sa.sin6.sin6_port =
829: htons(Port ? Port : ntohs(srv->srv_blob.server.cli_sa.sin6.sin6_port) + 1);
830: break;
831: case AF_LOCAL:
832: strlcat(srv->srv_blob.server.cli_sa.sun.sun_path, ".blob",
833: sizeof srv->srv_blob.server.cli_sa.sun.sun_path);
834: break;
835: default:
836: AIT_FREE_VAL(&srv->srv_blob.dir);
837: return -1;
838: }
839:
840: /* create BLOB server socket */
841: srv->srv_blob.server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family, SOCK_STREAM, 0);
842: if (srv->srv_blob.server.cli_sock == -1) {
843: LOGERR;
844: AIT_FREE_VAL(&srv->srv_blob.dir);
845: return -1;
846: }
847: if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
848: LOGERR;
849: close(srv->srv_blob.server.cli_sock);
850: AIT_FREE_VAL(&srv->srv_blob.dir);
851: return -1;
852: }
853: n = srv->srv_netbuf;
854: if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
855: LOGERR;
856: close(srv->srv_blob.server.cli_sock);
857: AIT_FREE_VAL(&srv->srv_blob.dir);
858: return -1;
859: }
860: if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
861: LOGERR;
862: close(srv->srv_blob.server.cli_sock);
863: AIT_FREE_VAL(&srv->srv_blob.dir);
864: return -1;
865: }
866: if (bind(srv->srv_blob.server.cli_sock, &srv->srv_blob.server.cli_sa.sa,
867: srv->srv_blob.server.cli_sa.sa.sa_len) == -1) {
868: LOGERR;
869: close(srv->srv_blob.server.cli_sock);
870: AIT_FREE_VAL(&srv->srv_blob.dir);
871: return -1;
872: } else
873: fcntl(srv->srv_blob.server.cli_sock, F_SETFL,
874: fcntl(srv->srv_blob.server.cli_sock, F_GETFL) | O_NONBLOCK);
875:
876:
877: /* allocate pool for concurent blob clients */
878: srv->srv_blob.clients = array_Init(array_Size(srv->srv_clients));
879: if (!srv->srv_blob.clients) {
880: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
881: close(srv->srv_blob.server.cli_sock);
882: AIT_FREE_VAL(&srv->srv_blob.dir);
883: return -1;
884: }
885:
886: /* init blob scheduler */
887: srv->srv_blob.root = schedBegin();
888: if (!srv->srv_blob.root) {
889: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
890: array_Destroy(&srv->srv_blob.clients);
891: close(srv->srv_blob.server.cli_sock);
892: AIT_FREE_VAL(&srv->srv_blob.dir);
893: return -1;
894: }
895:
896: return 0;
897: }
898:
899: /*
900: * rpc_srv_endBLOBServer() - Destroy BLOB server, close all opened sockets and free resources
901: *
902: * @srv = RPC Server instance
903: * return: none
904: */
905: void
906: rpc_srv_endBLOBServer(rpc_srv_t * __restrict srv)
907: {
908: if (!srv)
909: return;
910:
911: srv->srv_blob.kill = 1;
912:
913: schedEnd(&srv->srv_blob.root);
914: }
915:
916: /*
917: * rpc_srv_loopBLOBServer() - Execute Main BLOB server loop and wait for clients requests
918: *
919: * @srv = RPC Server instance
920: * return: -1 error or 0 ok, infinite loop ...
921: */
922: int
923: rpc_srv_loopBLOBServer(rpc_srv_t * __restrict srv)
924: {
925: rpc_cli_t *c;
926: register int i;
927: rpc_blob_t *b, *tmp;
928: struct timespec ts = { RPC_SCHED_POLLING, 0 };
929:
930: if (!srv || srv->srv_kill) {
931: rpc_SetErr(EINVAL, "Invalid parameter can`t start BLOB server");
932: return -1;
933: }
934:
935: if (listen(srv->srv_blob.server.cli_sock, array_Size(srv->srv_blob.clients)) == -1) {
936: LOGERR;
937: return -1;
938: }
939:
940: schedSignal(srv->srv_blob.root, flushBLOB, srv, SIGFBLOB, NULL, 0);
941: if (!schedRead(srv->srv_blob.root, acceptBLOBClients, srv,
942: srv->srv_blob.server.cli_sock, NULL, 0)) {
943: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
944: return -1;
945: }
946:
947: schedPolling(srv->srv_blob.root, &ts, NULL);
948: /* main rpc loop */
949: schedRun(srv->srv_blob.root, &srv->srv_blob.kill);
950:
951: /* detach blobs */
952: TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) {
953: TAILQ_REMOVE(&srv->srv_blob.blobs, b, blob_node);
954:
955: rpc_srv_blobFree(srv, b);
956: e_free(b);
957: }
958:
959: /* close all clients connections & server socket */
960: for (i = 0; i < array_Size(srv->srv_blob.clients); i++) {
961: c = array(srv->srv_blob.clients, i, rpc_cli_t*);
962: if (c) {
963: shutdown(c->cli_sock, SHUT_RDWR);
964: close(c->cli_sock);
965:
966: schedCancelby(srv->srv_blob.root, taskMAX, CRITERIA_ARG, c, NULL);
967: ait_freeVars(&c->cli_buf);
968: }
969: array_Del(srv->srv_blob.clients, i, 42);
970: }
971: array_Destroy(&srv->srv_blob.clients);
972:
973: close(srv->srv_blob.server.cli_sock);
974:
975: AIT_FREE_VAL(&srv->srv_blob.dir);
976: return 0;
977: }
978:
979:
980: /*
981: * rpc_srv_initServer() - Init & create RPC Server
982: *
983: * @InstID = Instance for authentication & recognition
984: * @concurentClients = Concurent clients at same time to this server
985: * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
986: * @csHost = Host name or address for bind server, if NULL any address
987: * @Port = Port for bind server, if Port == 0 default port is selected
988: * @proto = Protocol, if == 0 choose SOCK_STREAM
989: * return: NULL == error or !=NULL bind and created RPC server instance
990: */
991: rpc_srv_t *
992: rpc_srv_initServer(u_char InstID, int concurentClients, int netBuf,
993: const char *csHost, u_short Port, int proto)
994: {
995: int n = 1;
996: rpc_srv_t *srv = NULL;
997: sockaddr_t sa = E_SOCKADDR_INIT;
998:
999: if (!concurentClients || (proto < 0 || proto > SOCK_DGRAM)) {
1000: rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server");
1001: return NULL;
1002: }
1003: if (!e_gethostbyname(csHost, Port, &sa))
1004: return NULL;
1005: if (!Port)
1006: Port = RPC_DEFPORT;
1007: if (!proto)
1008: proto = SOCK_STREAM;
1009: if (netBuf < RPC_MIN_BUFSIZ)
1010: netBuf = BUFSIZ;
1011: else
1012: netBuf = E_ALIGN(netBuf, 2); /* align netBuf length */
1013:
1014: #ifdef HAVE_SRANDOMDEV
1015: srandomdev();
1016: #else
1017: time_t tim;
1018:
1019: srandom((time(&tim) ^ getpid()));
1020: #endif
1021:
1022: srv = e_malloc(sizeof(rpc_srv_t));
1023: if (!srv) {
1024: LOGERR;
1025: return NULL;
1026: } else
1027: memset(srv, 0, sizeof(rpc_srv_t));
1028:
1029: srv->srv_proto = proto;
1030: srv->srv_netbuf = netBuf;
1031: srv->srv_session.sess_version = RPC_VERSION;
1032: srv->srv_session.sess_instance = InstID;
1033:
1034: srv->srv_server.cli_parent = srv;
1035: memcpy(&srv->srv_server.cli_sa, &sa, sizeof srv->srv_server.cli_sa);
1036:
1037: /* init functions */
1038: pthread_mutex_init(&srv->srv_funcs.mtx, NULL);
1039: SLIST_INIT(&srv->srv_funcs);
1040: AVL_INIT(&srv->srv_funcs);
1041:
1042: /* init scheduler */
1043: srv->srv_root = schedBegin();
1044: if (!srv->srv_root) {
1045: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
1046: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1047: e_free(srv);
1048: return NULL;
1049: }
1050:
1051: /* init pool for clients */
1052: srv->srv_clients = array_Init(concurentClients);
1053: if (!srv->srv_clients) {
1054: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
1055: schedEnd(&srv->srv_root);
1056: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1057: e_free(srv);
1058: return NULL;
1059: }
1060:
1061: /* create server socket */
1062: srv->srv_server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family, srv->srv_proto, 0);
1063: if (srv->srv_server.cli_sock == -1) {
1064: LOGERR;
1065: array_Destroy(&srv->srv_clients);
1066: schedEnd(&srv->srv_root);
1067: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1068: e_free(srv);
1069: return NULL;
1070: }
1071: if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
1072: LOGERR;
1073: goto err;
1074: }
1075: n = srv->srv_netbuf;
1076: if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
1077: LOGERR;
1078: goto err;
1079: }
1080: if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
1081: LOGERR;
1082: goto err;
1083: }
1084: if (bind(srv->srv_server.cli_sock, &srv->srv_server.cli_sa.sa,
1085: srv->srv_server.cli_sa.sa.sa_len) == -1) {
1086: LOGERR;
1087: goto err;
1088: } else
1089: fcntl(srv->srv_server.cli_sock, F_SETFL,
1090: fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK);
1091:
1092: rpc_register_srvPing(srv);
1093:
1094: return srv;
1095: err: /* error condition */
1096: close(srv->srv_server.cli_sock);
1097: array_Destroy(&srv->srv_clients);
1098: schedEnd(&srv->srv_root);
1099: pthread_mutex_destroy(&srv->srv_funcs.mtx);
1100: e_free(srv);
1101: return NULL;
1102: }
1103:
1104: /*
1105: * rpc_srv_endServer() - Destroy RPC server, close all opened sockets and free resources
1106: *
1107: * @psrv = RPC Server instance
1108: * return: none
1109: */
1110: void
1111: rpc_srv_endServer(rpc_srv_t ** __restrict psrv)
1112: {
1113: if (!psrv || !*psrv)
1114: return;
1115:
1116: /* if send kill to blob server */
1117: rpc_srv_endBLOBServer(*psrv);
1118:
1119: (*psrv)->srv_kill = 1;
1120: sleep(RPC_SCHED_POLLING);
1121:
1122: schedEnd(&(*psrv)->srv_root);
1123:
1124: pthread_mutex_destroy(&(*psrv)->srv_funcs.mtx);
1125: e_free(*psrv);
1126: *psrv = NULL;
1127: }
1128:
1129: /*
1130: * rpc_srv_loopServer() - Execute Main server loop and wait for clients requests
1131: *
1132: * @srv = RPC Server instance
1133: * return: -1 error or 0 ok, infinite loop ...
1134: */
1135: int
1136: rpc_srv_loopServer(rpc_srv_t * __restrict srv)
1137: {
1138: rpc_cli_t *c;
1139: register int i;
1140: rpc_func_t *f;
1141: struct timespec ts = { RPC_SCHED_POLLING, 0 };
1142:
1143: if (!srv) {
1144: rpc_SetErr(EINVAL, "Invalid parameter can`t start RPC server");
1145: return -1;
1146: }
1147:
1148: if (srv->srv_proto == SOCK_STREAM)
1149: if (listen(srv->srv_server.cli_sock, array_Size(srv->srv_clients)) == -1) {
1150: LOGERR;
1151: return -1;
1152: }
1153:
1154: if (!schedRead(srv->srv_root, cbProto[srv->srv_proto][CB_ACCEPTCLIENT], srv,
1155: srv->srv_server.cli_sock, NULL, 0)) {
1156: rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
1157: return -1;
1158: }
1159:
1160: schedPolling(srv->srv_root, &ts, NULL);
1161: /* main rpc loop */
1162: schedRun(srv->srv_root, &srv->srv_kill);
1163:
1164: /* close all clients connections & server socket */
1165: for (i = 0; i < array_Size(srv->srv_clients); i++) {
1166: c = array(srv->srv_clients, i, rpc_cli_t*);
1167: if (c) {
1168: shutdown(c->cli_sock, SHUT_RDWR);
1169: close(c->cli_sock);
1170:
1171: schedCancelby(srv->srv_root, taskMAX, CRITERIA_ARG, c, NULL);
1172: ait_freeVars(&RPC_RETVARS(c));
1173: ait_freeVars(&c->cli_buf);
1174: }
1175: array_Del(srv->srv_clients, i, 42);
1176: }
1177: array_Destroy(&srv->srv_clients);
1178:
1179: close(srv->srv_server.cli_sock);
1180:
1181: /* detach exported calls */
1182: RPC_FUNCS_LOCK(&srv->srv_funcs);
1183: while ((f = SLIST_FIRST(&srv->srv_funcs))) {
1184: SLIST_REMOVE_HEAD(&srv->srv_funcs, func_next);
1185:
1186: AIT_FREE_VAL(&f->func_name);
1187: e_free(f);
1188: }
1189: srv->srv_funcs.avlh_root = NULL;
1190: RPC_FUNCS_UNLOCK(&srv->srv_funcs);
1191:
1192: return 0;
1193: }
1194:
1195:
1196: /*
1197: * rpc_srv_execCall() Execute registered call from RPC server
1198: *
1199: * @cli = RPC client
1200: * @rpc = IN RPC call structure
1201: * @funcname = Execute RPC function
1202: * @args = IN RPC calling arguments from RPC client
1203: * return: -1 error, !=-1 ok
1204: */
1205: int
1206: rpc_srv_execCall(rpc_cli_t * __restrict cli, struct tagRPCCall * __restrict rpc,
1207: ait_val_t funcname, array_t * __restrict args)
1208: {
1209: rpc_callback_t func;
1210:
1211: if (!cli || !rpc || !AIT_ADDR(&funcname)) {
1212: rpc_SetErr(EINVAL, "Invalid parameter can`t exec function");
1213: return -1;
1214: }
1215:
1216: func = AIT_GET_LIKE(&funcname, rpc_callback_t);
1217: return func(cli, rpc, args);
1218: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to srv.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / libaitrpc / src