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