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