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