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