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