File:  [ELWIX - Embedded LightWeight unIX -] / libaitrpc / src / srv.c
Revision 1.24.2.5: download - view: text, annotated - select for diffs - revision graph
Sun Jan 18 00:55:05 2015 UTC (9 years, 6 months ago) by misho
Branches: rpc7_3
Diff to: branchpoint 1.24: preferred, unified
adds rx/tx pipe funcs

    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.24.2.5 2015/01/18 00:55: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 - 2015
   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: /* SOCK_BPF */
   63: static void *rxBPFPacket(sched_task_t *);
   64: static void *txBPFPacket(sched_task_t *);
   65: 
   66: /* SOCK_EXT */
   67: static void *rxEXTPacket(sched_task_t *);
   68: static void *txEXTPacket(sched_task_t *);
   69: 
   70: static sched_task_func_t cbProto[SOCK_MAX_SUPPORT][4] = {
   71: 	{ acceptClients, closeClient, rxPacket, txPacket },	/* SOCK_STREAM */
   72: 	{ acceptClients, closeClient, rxPacket, txPacket },	/* SOCK_STREAM */
   73: 	{ rxUDPPacket, freeClient, rxUDPPacket, txUDPPacket }, 	/* SOCK_DGRAM */
   74: 	{ NULL, NULL, NULL, NULL },				/* SOCK_RAW */
   75: 	{ rxBPFPacket, freeClient, rxBPFPacket, txBPFPacket }, 	/* SOCK_BPF */
   76: 	{ rxEXTPacket, freeClient, rxEXTPacket, txEXTPacket }	/* SOCK_EXT */
   77: };
   78: 
   79: /* Global Signal Argument when kqueue support disabled */
   80: 
   81: static volatile uintptr_t _glSigArg = 0;
   82: 
   83: 
   84: void
   85: rpc_freeCli(rpc_cli_t * __restrict c)
   86: {
   87: 	rpc_srv_t *s = c->cli_parent;
   88: 
   89: 	schedCancelby(s->srv_root, taskMAX, CRITERIA_ARG, c, NULL);
   90: 
   91: 	/* free buffer */
   92: 	AIT_FREE_VAL(&c->cli_buf);
   93: 
   94: 	array_Del(s->srv_clients, c->cli_id, 0);
   95: 	if (c)
   96: 		e_free(c);
   97: }
   98: 
   99: 
  100: static inline int
  101: _check4freeslot(rpc_srv_t * __restrict srv, sockaddr_t * __restrict sa)
  102: {
  103: 	rpc_cli_t *c = NULL;
  104: 	register int i;
  105: 
  106: 	/* check free slots for connect */
  107: 	for (i = 0; i < array_Size(srv->srv_clients) && 
  108: 			(c = array(srv->srv_clients, i, rpc_cli_t*)); i++)
  109: 		/* check for duplicates */
  110: 		if (sa && !e_addrcmp(&c->cli_sa, sa, 42))
  111: 			break;
  112: 	if (i >= array_Size(srv->srv_clients))
  113: 		return -1;	/* no more free slots! */
  114: 
  115: 	return i;
  116: }
  117: 
  118: static rpc_cli_t *
  119: _allocClient(rpc_srv_t * __restrict srv, sockaddr_t * __restrict sa)
  120: {
  121: 	rpc_cli_t *c = NULL;
  122: 	int n;
  123: 
  124: 	if (srv->srv_proto != SOCK_EXT)
  125: 		n = _check4freeslot(srv, sa);
  126: 	else
  127: 		n = 0;
  128: 	if (n == -1)
  129: 		return NULL;
  130: 	else
  131: 		c = array(srv->srv_clients, n, rpc_cli_t*);
  132: 
  133: 	if (!c) {
  134: 		c = e_malloc(sizeof(rpc_cli_t));
  135: 		if (!c) {
  136: 			LOGERR;
  137: 			srv->srv_kill = 1;
  138: 			return NULL;
  139: 		} else {
  140: 			memset(c, 0, sizeof(rpc_cli_t));
  141: 			array_Set(srv->srv_clients, n, c);
  142: 			c->cli_id = n;
  143: 			c->cli_parent = srv;
  144: 		}
  145: 
  146: 		/* alloc empty buffer */
  147: 		AIT_SET_BUFSIZ(&c->cli_buf, 0, srv->srv_netbuf);
  148: 	}
  149: 
  150: 	return c;
  151: }
  152: 
  153: 
  154: static void *
  155: freeClient(sched_task_t *task)
  156: {
  157: 	rpc_freeCli(TASK_ARG(task));
  158: 
  159: 	return NULL;
  160: }
  161: 
  162: static void *
  163: closeClient(sched_task_t *task)
  164: {
  165: 	int sock = ((rpc_cli_t*) TASK_ARG(task))->cli_sock;
  166: 
  167: 	rpc_freeCli(TASK_ARG(task));
  168: 
  169: 	/* close client socket */
  170: 	shutdown(sock, SHUT_RDWR);
  171: 	close(sock);
  172: 	return NULL;
  173: }
  174: 
  175: static void *
  176: txPacket(sched_task_t *task)
  177: {
  178: 	rpc_cli_t *c = TASK_ARG(task);
  179: 	rpc_srv_t *s = c->cli_parent;
  180: 	rpc_func_t *f = NULL;
  181: 	u_char *buf = AIT_GET_BUF(&c->cli_buf);
  182: 	struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
  183: 	int ret, estlen, wlen = sizeof(struct tagRPCCall);
  184: 	struct pollfd pfd;
  185: #ifdef TCP_SESSION_TIMEOUT
  186: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  187: 
  188: 	schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
  189: 	schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  190: 			 TASK_ARG(task), ts, TASK_ARG(task), 0);
  191: #endif
  192: 
  193: 	if (rpc->call_argc) {
  194: 		f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
  195: 		if (!f) {
  196: 			rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
  197: 
  198: 			rpc->call_argc ^= rpc->call_argc;
  199: 			rpc->call_rep.ret = RPC_ERROR(-1);
  200: 			rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  201: 		} else {
  202: 			/* calc estimated length */
  203: 			estlen = ait_resideVars(RPC_RETVARS(c)) + wlen;
  204: 			if (estlen > AIT_LEN(&c->cli_buf))
  205: 				AIT_RE_BUF(&c->cli_buf, estlen);
  206: 			buf = AIT_GET_BUF(&c->cli_buf);
  207: 			rpc = (struct tagRPCCall*) buf;
  208: 
  209: 			rpc->call_argc = htons(array_Size(RPC_RETVARS(c)));
  210: 			/* Go Encapsulate variables */
  211: 			ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
  212: 					RPC_RETVARS(c));
  213: 			/* Free return values */
  214: 			ait_freeVars(&c->cli_vars);
  215: 			if (ret == -1) {
  216: 				rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
  217: 
  218: 				rpc->call_argc ^= rpc->call_argc;
  219: 				rpc->call_rep.ret = RPC_ERROR(-1);
  220: 				rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  221: 			} else
  222: 				wlen += ret;
  223: 		}
  224: 	}
  225: 
  226: 	rpc->call_len = htonl(wlen);
  227: 
  228: #if 0
  229: 	/* calculate CRC */
  230: 	rpc->call_crc ^= rpc->call_crc;
  231: 	rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
  232: #endif
  233: 
  234: 	/* send reply */
  235: 	pfd.fd = TASK_FD(task);
  236: 	pfd.events = POLLOUT;
  237: 	for (; wlen > 0; wlen -= ret, buf += ret) {
  238: 		if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || 
  239: 				pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {
  240: 			if (ret)
  241: 				LOGERR;
  242: 			else
  243: 				rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond");
  244: 			/* close connection */
  245: 			schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  246: 					TASK_ARG(task), 0, NULL, 0);
  247: 			return NULL;
  248: 		}
  249: 		ret = send(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf), MSG_NOSIGNAL);
  250: 		if (ret == -1) {
  251: 			/* close connection */
  252: 			schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  253: 					TASK_ARG(task), 0, NULL, 0);
  254: 			return NULL;
  255: 		}
  256: 	}
  257: 
  258: 	return NULL;
  259: }
  260: 
  261: static void *
  262: execCall(sched_task_t *task)
  263: {
  264: 	rpc_cli_t *c = TASK_ARG(task);
  265: 	rpc_srv_t *s = c->cli_parent;
  266: 	rpc_func_t *f = NULL;
  267: 	array_t *arr = NULL;
  268: 	u_char *buf = AIT_GET_BUF(&c->cli_buf);
  269: 	struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
  270: 	int argc = ntohs(rpc->call_argc);
  271: 
  272: 	/* Go decapsulate variables ... */
  273: 	if (argc) {
  274: 		arr = ait_buffer2vars(buf + sizeof(struct tagRPCCall), 
  275: 				AIT_LEN(&c->cli_buf) - sizeof(struct tagRPCCall), argc, 42);
  276: 		if (!arr) {
  277: 			rpc_SetErr(ERPCMISMATCH, "#%d - %s", elwix_GetErrno(), elwix_GetError());
  278: 
  279: 			rpc->call_argc ^= rpc->call_argc;
  280: 			rpc->call_rep.ret = RPC_ERROR(-1);
  281: 			rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  282: 			return NULL;
  283: 		}
  284: 	} else
  285: 		arr = NULL;
  286: 
  287: 	if (!(f = rpc_srv_getCall(s, ntohs(rpc->call_tag)))) {
  288: 		rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
  289: 
  290: 		rpc->call_argc ^= rpc->call_argc;
  291: 		rpc->call_rep.ret = RPC_ERROR(-1);
  292: 		rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  293: 	} else {
  294: 		/* if client doesn't want reply */
  295: 		argc = RPC_CHK_NOREPLY(rpc);
  296: 		rpc->call_rep.ret = RPC_ERROR(rpc_srv_execCall(c, rpc, f->func_name, arr));
  297: 		if (rpc->call_rep.ret == htonl(-1)) {
  298: 			if (!rpc->call_rep.eno) {
  299: 				LOGERR;
  300: 				rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  301: 			}
  302: 			rpc->call_argc ^= rpc->call_argc;
  303: 		} else {
  304: 			rpc->call_rep.eno ^= rpc->call_rep.eno;
  305: 			if (argc) {
  306: 				/* without reply */
  307: 				ait_freeVars(&c->cli_vars);
  308: 				rpc->call_argc ^= rpc->call_argc;
  309: 			} else {
  310: 				/* reply */
  311: 				rpc->call_argc = htons(array_Size(RPC_RETVARS(c)));
  312: 			}
  313: 		}
  314: 	}
  315: 
  316: 	array_Destroy(&arr);
  317: 	return NULL;
  318: }
  319: 
  320: static void *
  321: rxPacket(sched_task_t *task)
  322: {
  323: 	rpc_cli_t *c = TASK_ARG(task);
  324: 	rpc_srv_t *s = c->cli_parent;
  325: 	int len, rlen, noreply, estlen;
  326: #if 0
  327: 	u_short crc;
  328: #endif
  329: 	u_char *buf = AIT_GET_BUF(&c->cli_buf);
  330: 	struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
  331: 	struct pollfd pfd;
  332: #ifdef TCP_SESSION_TIMEOUT
  333: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  334: 
  335: 	schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
  336: 	schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  337: 			 TASK_ARG(task), ts, TASK_ARG(task), 0);
  338: #endif
  339: 
  340: 	memset(buf, 0, sizeof(struct tagRPCCall));
  341: 	rlen = recv(TASK_FD(task), rpc, sizeof(struct tagRPCCall), MSG_PEEK);
  342: 	if (rlen < sizeof(struct tagRPCCall)) {
  343: 		/* close connection */
  344: 		schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  345: 				TASK_ARG(task), 0, NULL, 0);
  346: 		return NULL;
  347: 	} else {
  348: 		estlen = ntohl(rpc->call_len);
  349: 		if (estlen > AIT_LEN(&c->cli_buf))
  350: 			AIT_RE_BUF(&c->cli_buf, estlen);
  351: 		rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
  352: 		buf = AIT_GET_BUF(&c->cli_buf);
  353: 		len = estlen;
  354: 	}
  355: 
  356: 	/* get next part of packet */
  357: 	memset(buf, 0, len);
  358: 	pfd.fd = TASK_FD(task);
  359: 	pfd.events = POLLIN | POLLPRI;
  360: 	for (; len > 0; len -= rlen, buf += rlen) {
  361: 		if ((rlen = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || 
  362: 				pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {
  363: 			if (rlen)
  364: 				LOGERR;
  365: 			else
  366: 				rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond");
  367: 			schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  368: 					TASK_ARG(task), 0, NULL, 0);
  369: 			return NULL;
  370: 		}
  371: 		rlen = recv(TASK_FD(task), buf, len, 0);
  372: 		if (rlen == -1) {
  373: 			/* close connection */
  374: 			schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  375: 					TASK_ARG(task), 0, NULL, 0);
  376: 			return NULL;
  377: 		}
  378: 	}
  379: 	len = estlen;
  380: 
  381: #if 0
  382: 	/* check integrity of packet */
  383: 	crc = ntohs(rpc->call_crc);
  384: 	rpc->call_crc ^= rpc->call_crc;
  385: 	if (crc != crcFletcher16((u_short*) rpc, len / 2)) {
  386: 		rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");
  387: 		return NULL;
  388: 	}
  389: #endif
  390: 
  391: 	noreply = RPC_CHK_NOREPLY(rpc);
  392: 
  393: 	/* check RPC packet session info */
  394: 	if (rpc_chkPktSession(&rpc->call_session, &s->srv_session)) {
  395: 		rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
  396: 
  397: 		rpc->call_argc ^= rpc->call_argc;
  398: 		rpc->call_rep.ret = RPC_ERROR(-1);
  399: 		rpc->call_rep.eno = RPC_ERROR(errno);
  400: 	} else {
  401: 		/* execute RPC call */
  402: 		schedEvent(TASK_ROOT(task), execCall, TASK_ARG(task), (int) noreply, rpc, len);
  403: 	}
  404: 
  405: 	/* send RPC reply */
  406: 	if (!noreply)
  407: 		schedWrite(TASK_ROOT(task), cbProto[s->srv_proto][CB_TXPACKET], 
  408: 				TASK_ARG(task), TASK_FD(task), rpc, len);
  409: 
  410: 	/* lets get next packet */
  411: 	schedReadSelf(task);
  412: 	return NULL;
  413: }
  414: 
  415: static void *
  416: acceptClients(sched_task_t *task)
  417: {
  418: 	rpc_srv_t *srv = TASK_ARG(task);
  419: 	rpc_cli_t *c = NULL;
  420: 	socklen_t salen = sizeof(sockaddr_t);
  421: 	int sock;
  422: #ifdef TCP_SESSION_TIMEOUT
  423: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  424: #endif
  425: 
  426: 	c = _allocClient(srv, NULL);
  427: 	if (!c) {
  428: 		EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
  429: 		if ((sock = accept(TASK_FD(task), NULL, NULL)) != -1) {
  430: 			shutdown(sock, SHUT_RDWR);
  431: 			close(sock);
  432: 		}
  433: 		goto end;
  434: 	}
  435: 
  436: 	/* accept client */
  437: 	c->cli_sock = accept(TASK_FD(task), &c->cli_sa.sa, &salen);
  438: 	if (c->cli_sock == -1) {
  439: 		LOGERR;
  440: 		AIT_FREE_VAL(&c->cli_buf);
  441: 		array_Del(srv->srv_clients, c->cli_id, 42);
  442: 		goto end;
  443: 	} else
  444: 		fcntl(c->cli_sock, F_SETFL, fcntl(c->cli_sock, F_GETFL) | O_NONBLOCK);
  445: 
  446: #ifdef TCP_SESSION_TIMEOUT
  447: 	/* armed timer for close stateless connection */
  448: 	schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
  449: 	schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], c, 
  450: 			ts, c, 0);
  451: #endif
  452: 	schedRead(TASK_ROOT(task), cbProto[srv->srv_proto][CB_RXPACKET], c, 
  453: 			c->cli_sock, NULL, 0);
  454: end:
  455: 	schedReadSelf(task);
  456: 	return NULL;
  457: }
  458: 
  459: 
  460: static void *
  461: txUDPPacket(sched_task_t *task)
  462: {
  463: 	rpc_cli_t *c = TASK_ARG(task);
  464: 	rpc_srv_t *s = c->cli_parent;
  465: 	rpc_func_t *f = NULL;
  466: 	u_char *buf = AIT_GET_BUF(&c->cli_buf);
  467: 	struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
  468: 	int ret, estlen, wlen = sizeof(struct tagRPCCall);
  469: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  470: 	struct pollfd pfd;
  471: 
  472: 	schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
  473: 	schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  474: 			 TASK_ARG(task), ts, TASK_ARG(task), 0);
  475: 
  476: 	if (rpc->call_argc) {
  477: 		f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
  478: 		if (!f) {
  479: 			rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
  480: 			rpc->call_argc ^= rpc->call_argc;
  481: 			rpc->call_rep.ret = RPC_ERROR(-1);
  482: 			rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  483: 		} else {
  484: 			/* calc estimated length */
  485: 			estlen = ait_resideVars(RPC_RETVARS(c)) + wlen;
  486: 			if (estlen > AIT_LEN(&c->cli_buf))
  487: 				AIT_RE_BUF(&c->cli_buf, estlen);
  488: 			buf = AIT_GET_BUF(&c->cli_buf);
  489: 			rpc = (struct tagRPCCall*) buf;
  490: 
  491: 			rpc->call_argc = htons(array_Size(RPC_RETVARS(c)));
  492: 			/* Go Encapsulate variables */
  493: 			ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
  494: 					RPC_RETVARS(c));
  495: 			/* Free return values */
  496: 			ait_freeVars(&c->cli_vars);
  497: 			if (ret == -1) {
  498: 				rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
  499: 				rpc->call_argc ^= rpc->call_argc;
  500: 				rpc->call_rep.ret = RPC_ERROR(-1);
  501: 				rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  502: 			} else
  503: 				wlen += ret;
  504: 		}
  505: 	}
  506: 
  507: 	rpc->call_len = htonl(wlen);
  508: 
  509: 	/* calculate CRC */
  510: 	rpc->call_crc ^= rpc->call_crc;
  511: 	rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
  512: 
  513: 	/* send reply */
  514: 	pfd.fd = TASK_FD(task);
  515: 	pfd.events = POLLOUT;
  516: 	for (; wlen > 0; wlen -= ret, buf += ret) {
  517: 		if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || 
  518: 				pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {
  519: 			if (ret)
  520: 				LOGERR;
  521: 			else
  522: 				rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond");
  523: 			/* close connection */
  524: 			schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  525: 					TASK_ARG(task), 0, NULL, 0);
  526: 			return NULL;
  527: 		}
  528: 		ret = sendto(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf), MSG_NOSIGNAL, 
  529: 				&c->cli_sa.sa, c->cli_sa.sa.sa_len);
  530: 		if (ret == -1) {
  531: 			/* close connection */
  532: 			schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  533: 					TASK_ARG(task), 0, NULL, 0);
  534: 			return NULL;
  535: 		}
  536: 	}
  537: 
  538: 	return NULL;
  539: }
  540: 
  541: static void *
  542: rxUDPPacket(sched_task_t *task)
  543: {
  544: 	rpc_srv_t *srv = TASK_ARG(task);
  545: 	rpc_cli_t *c = NULL;
  546: 	int len, rlen, noreply, estlen;
  547: 	u_short crc;
  548: 	u_char *buf, b[sizeof(struct tagRPCCall)];
  549: 	struct tagRPCCall *rpc = (struct tagRPCCall*) b;
  550: 	sockaddr_t sa;
  551: 	socklen_t salen;
  552: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  553: 	struct pollfd pfd;
  554: 
  555: 	/* receive connect packet */
  556: 	salen = sa.ss.ss_len = sizeof(sockaddr_t);
  557: 	rlen = recvfrom(TASK_FD(task), b, sizeof b, MSG_PEEK, &sa.sa, &salen);
  558: 	if (rlen < sizeof(struct tagRPCCall)) {
  559: 		rpc_SetErr(ERPCMISMATCH, "Short RPC packet");
  560: 		goto end;
  561: 	}
  562: 
  563: 	c = _allocClient(srv, &sa);
  564: 	if (!c) {
  565: 		EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
  566: 		usleep(2000);	/* blocked client delay */
  567: 		goto end;
  568: 	} else {
  569: 		estlen = ntohl(rpc->call_len);
  570: 		if (estlen > AIT_LEN(&c->cli_buf))
  571: 			AIT_RE_BUF(&c->cli_buf, estlen);
  572: 		rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
  573: 		buf = AIT_GET_BUF(&c->cli_buf);
  574: 		len = estlen;
  575: 
  576: 		c->cli_sock = TASK_FD(task);
  577: 		memcpy(&c->cli_sa, &sa, sizeof c->cli_sa);
  578: 
  579: 		/* armed timer for close stateless connection */
  580: 		schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
  581: 		schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  582: 				c, ts, c, 0);
  583: 	}
  584: 
  585: 	/* get next part of packet */
  586: 	memset(buf, 0, len);
  587: 	pfd.fd = TASK_FD(task);
  588: 	pfd.events = POLLIN | POLLPRI;
  589: 	for (; len > 0; len -= rlen, buf += rlen) {
  590: 		if ((rlen = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || 
  591: 				pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {
  592: 			if (rlen)
  593: 				LOGERR;
  594: 			else
  595: 				rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond");
  596: 			schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  597: 					c, 0, NULL, 0);
  598: 			goto end;
  599: 		}
  600: 		salen = sa.ss.ss_len = sizeof(sockaddr_t);
  601: 		rlen = recvfrom(TASK_FD(task), buf, len, 0, &sa.sa, &salen);
  602: 		if (rlen == -1) {
  603: 			/* close connection */
  604: 			schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  605: 					c, 0, NULL, 0);
  606: 			goto end;
  607: 		}
  608: 		if (e_addrcmp(&c->cli_sa, &sa, 42))
  609: 			rlen ^= rlen;	/* skip if arrive from different address */
  610: 	}
  611: 	len = estlen;
  612: 
  613: 	/* check integrity of packet */
  614: 	crc = ntohs(rpc->call_crc);
  615: 	rpc->call_crc ^= rpc->call_crc;
  616: 	if (crc != crcFletcher16((u_short*) rpc, len / 2)) {
  617: 		rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");
  618: 		/* close connection */
  619: 		schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  620: 				c, 0, NULL, 0);
  621: 		goto end;
  622: 	}
  623: 
  624: 	noreply = RPC_CHK_NOREPLY(rpc);
  625: 
  626: 	/* check RPC packet session info */
  627: 	if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) {
  628: 		rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
  629: 
  630: 		rpc->call_argc ^= rpc->call_argc;
  631: 		rpc->call_rep.ret = RPC_ERROR(-1);
  632: 		rpc->call_rep.eno = RPC_ERROR(errno);
  633: 	} else {
  634: 		/* execute RPC call */
  635: 		schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
  636: 	}
  637: 
  638: 	/* send RPC reply */
  639: 	if (!noreply)
  640: 		schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], 
  641: 				c, TASK_FD(task), rpc, len);
  642: end:
  643: 	schedReadSelf(task);
  644: 	return NULL;
  645: }
  646: 
  647: 
  648: static void *
  649: txBPFPacket(sched_task_t *task)
  650: {
  651: 	rpc_cli_t *c = TASK_ARG(task);
  652: 	rpc_srv_t *s = c->cli_parent;
  653: 	rpc_func_t *f = NULL;
  654: 	u_char *buf = AIT_GET_BUF(&c->cli_buf);
  655: 	struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
  656: 	int ret, len, wlen = sizeof(struct tagRPCCall);
  657: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  658: 	struct ether_header *eh;
  659: 	ait_val_t b = AIT_VAL_INIT;
  660: 
  661: 	schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
  662: 	schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  663: 			 TASK_ARG(task), ts, TASK_ARG(task), 0);
  664: 
  665: 	if (rpc->call_argc) {
  666: 		f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
  667: 		if (!f) {
  668: 			rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
  669: 			rpc->call_argc ^= rpc->call_argc;
  670: 			rpc->call_rep.ret = RPC_ERROR(-1);
  671: 			rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  672: 		} else {
  673: 			/* calc estimated length */
  674: 			len = ait_resideVars(RPC_RETVARS(c)) + wlen;
  675: 			if (len > AIT_LEN(&c->cli_buf))
  676: 				AIT_RE_BUF(&c->cli_buf, len);
  677: 			buf = AIT_GET_BUF(&c->cli_buf);
  678: 			rpc = (struct tagRPCCall*) buf;
  679: 
  680: 			rpc->call_argc = htons(array_Size(RPC_RETVARS(c)));
  681: 			/* Go Encapsulate variables */
  682: 			ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
  683: 					RPC_RETVARS(c));
  684: 			/* Free return values */
  685: 			ait_freeVars(&RPC_RETVARS(c));
  686: 			if (ret == -1) {
  687: 				rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
  688: 				rpc->call_argc ^= rpc->call_argc;
  689: 				rpc->call_rep.ret = RPC_ERROR(-1);
  690: 				rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  691: 			} else
  692: 				wlen += ret;
  693: 		}
  694: 	}
  695: 
  696: 	rpc->call_len = htonl(wlen);
  697: 
  698: 	/* calculate CRC */
  699: 	rpc->call_crc ^= rpc->call_crc;
  700: 	rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
  701: 
  702: 	/* send reply */
  703: 	AIT_SET_BUF(&b, NULL, MIN(wlen, s->srv_netbuf) + ETHER_HDR_LEN);
  704: 	eh = (struct ether_header*) AIT_GET_BUF(&b);
  705: 	memcpy(eh->ether_dhost, LLADDR(&c->cli_sa.sdl), ETHER_ADDR_LEN);
  706: 	eh->ether_type = htons(RPC_DEFPORT);
  707: 	memcpy(eh + 1, buf, MIN(wlen, s->srv_netbuf));
  708: 
  709: 	ret = write(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));
  710: 	AIT_FREE_VAL(&b);
  711: 	if (ret == -1) {
  712: 		/* close connection */
  713: 		schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  714: 				TASK_ARG(task), 0, NULL, 0);
  715: 		return NULL;
  716: 	}
  717: 
  718: 	return NULL;
  719: }
  720: 
  721: static void *
  722: rxBPFPacket(sched_task_t *task)
  723: {
  724: 	rpc_srv_t *srv = TASK_ARG(task);
  725: 	rpc_cli_t *c = NULL;
  726: 	int len, rlen, noreply;
  727: 	u_short crc;
  728: 	struct tagRPCCall *rpc;
  729: 	sockaddr_t sa;
  730: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  731: 	struct bpf_hdr *h;
  732: 	struct ether_header *eh;
  733: 	ait_val_t b = AIT_VAL_INIT;
  734: 
  735: 	/* receive connect packet */
  736: 	AIT_SET_BUF(&b, NULL, srv->srv_netbuf);
  737: 	rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));
  738: 	h = (struct bpf_hdr*) AIT_GET_BUF(&b);
  739: 	rlen -= h->bh_hdrlen;
  740: 	if (rlen < h->bh_datalen || h->bh_caplen != h->bh_datalen || 
  741: 			rlen < ETHER_HDR_LEN + sizeof(struct tagRPCCall)) {
  742: 		rpc_SetErr(ERPCMISMATCH, "Short RPC packet");
  743: 		goto end;
  744: 	} else {
  745: 		rlen = h->bh_caplen;
  746: 		eh = (struct ether_header*) (AIT_GET_BUF(&b) + h->bh_hdrlen);
  747: 		rlen -= ETHER_HDR_LEN;
  748: 		rpc = (struct tagRPCCall*) (eh + 1);
  749: 		if (eh->ether_type != ntohs(RPC_DEFPORT))
  750: 			goto end;
  751: 		else
  752: 			e_getlinkbymac((const ether_addr_t*) eh->ether_shost, &sa);
  753: 	}
  754: 
  755: 	c = _allocClient(srv, &sa);
  756: 	if (!c) {
  757: 		EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
  758: 		usleep(2000);	/* blocked client delay */
  759: 		goto end;
  760: 	} else {
  761: 		len = ntohl(rpc->call_len);
  762: 		if (len > AIT_LEN(&c->cli_buf))
  763: 			AIT_RE_BUF(&c->cli_buf, len);
  764: 		memcpy(AIT_GET_BUF(&c->cli_buf), rpc, AIT_LEN(&c->cli_buf));
  765: 		rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
  766: 
  767: 		c->cli_sock = TASK_FD(task);
  768: 		memcpy(&c->cli_sa, &sa, sizeof c->cli_sa);
  769: 
  770: 		/* armed timer for close stateless connection */
  771: 		schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
  772: 		schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  773: 				c, ts, c, 0);
  774: 	}
  775: 
  776: 	/* check integrity of packet */
  777: 	crc = ntohs(rpc->call_crc);
  778: 	rpc->call_crc ^= rpc->call_crc;
  779: 	if (crc != crcFletcher16((u_short*) rpc, len / 2)) {
  780: 		rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");
  781: 		/* close connection */
  782: 		schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  783: 				c, 0, NULL, 0);
  784: 		goto end;
  785: 	}
  786: 
  787: 	noreply = RPC_CHK_NOREPLY(rpc);
  788: 
  789: 	/* check RPC packet session info */
  790: 	if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) {
  791: 		rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
  792: 
  793: 		rpc->call_argc ^= rpc->call_argc;
  794: 		rpc->call_rep.ret = RPC_ERROR(-1);
  795: 		rpc->call_rep.eno = RPC_ERROR(errno);
  796: 	} else {
  797: 		/* execute RPC call */
  798: 		schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
  799: 	}
  800: 
  801: 	/* send RPC reply */
  802: 	if (!noreply)
  803: 		schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], 
  804: 				c, TASK_FD(task), rpc, len);
  805: end:
  806: 	AIT_FREE_VAL(&b);
  807: 	schedReadSelf(task);
  808: 	return NULL;
  809: }
  810: 
  811: 
  812: static void *
  813: txEXTPacket(sched_task_t *task)
  814: {
  815: 	rpc_cli_t *c = TASK_ARG(task);
  816: 	rpc_srv_t *s = c->cli_parent;
  817: 	rpc_func_t *f = NULL;
  818: 	u_char *buf = AIT_GET_BUF(&c->cli_buf);
  819: 	struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
  820: 	int ret, estlen, wlen = sizeof(struct tagRPCCall);
  821: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  822: 	struct pollfd pfd;
  823: 
  824: 	schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
  825: 	schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  826: 			 TASK_ARG(task), ts, TASK_ARG(task), 0);
  827: 
  828: 	if (rpc->call_argc) {
  829: 		f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
  830: 		if (!f) {
  831: 			rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
  832: 			rpc->call_argc ^= rpc->call_argc;
  833: 			rpc->call_rep.ret = RPC_ERROR(-1);
  834: 			rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  835: 		} else {
  836: 			/* calc estimated length */
  837: 			estlen = ait_resideVars(RPC_RETVARS(c)) + wlen;
  838: 			if (estlen > AIT_LEN(&c->cli_buf))
  839: 				AIT_RE_BUF(&c->cli_buf, estlen);
  840: 			buf = AIT_GET_BUF(&c->cli_buf);
  841: 			rpc = (struct tagRPCCall*) buf;
  842: 
  843: 			rpc->call_argc = htons(array_Size(RPC_RETVARS(c)));
  844: 			/* Go Encapsulate variables */
  845: 			ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
  846: 					RPC_RETVARS(c));
  847: 			/* Free return values */
  848: 			ait_freeVars(&c->cli_vars);
  849: 			if (ret == -1) {
  850: 				rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
  851: 				rpc->call_argc ^= rpc->call_argc;
  852: 				rpc->call_rep.ret = RPC_ERROR(-1);
  853: 				rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
  854: 			} else
  855: 				wlen += ret;
  856: 		}
  857: 	}
  858: 
  859: 	rpc->call_len = htonl(wlen);
  860: 
  861: 	/* send reply */
  862: 	pfd.fd = TASK_FD(task);
  863: 	pfd.events = POLLOUT;
  864: 	for (; wlen > 0; wlen -= ret, buf += ret) {
  865: 		if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || 
  866: 				pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {
  867: 			if (ret)
  868: 				LOGERR;
  869: 			else
  870: 				rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond");
  871: 			/* close connection */
  872: 			schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  873: 					TASK_ARG(task), 0, NULL, 0);
  874: 			return NULL;
  875: 		}
  876: 		ret = write(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf));
  877: 		if (ret == -1) {
  878: 			/* close connection */
  879: 			schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
  880: 					TASK_ARG(task), 0, NULL, 0);
  881: 			return NULL;
  882: 		}
  883: 	}
  884: 
  885: 	return NULL;
  886: }
  887: 
  888: static void *
  889: rxEXTPacket(sched_task_t *task)
  890: {
  891: 	rpc_srv_t *srv = TASK_ARG(task);
  892: 	rpc_cli_t *c = NULL;
  893: 	int len, rlen, noreply, estlen;
  894: 	u_char *buf, b[sizeof(struct tagRPCCall)];
  895: 	struct tagRPCCall *rpc = (struct tagRPCCall*) b;
  896: 	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
  897: 	struct pollfd pfd;
  898: 
  899: 	/* receive connect packet */
  900: 	rlen = read(TASK_FD(task), b, sizeof b);
  901: 	if (rlen < sizeof(struct tagRPCCall)) {
  902: 		rpc_SetErr(ERPCMISMATCH, "Short RPC packet");
  903: 		goto end;
  904: 	}
  905: 
  906: 	c = _allocClient(srv, (sockaddr_t*) -1);
  907: 	if (!c) {
  908: 		EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
  909: 		usleep(2000);	/* blocked client delay */
  910: 		goto end;
  911: 	} else {
  912: 		estlen = ntohl(rpc->call_len);
  913: 		if (estlen > AIT_LEN(&c->cli_buf))
  914: 			AIT_RE_BUF(&c->cli_buf, estlen);
  915: 		rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
  916: 		memcpy(rpc, b, sizeof b);
  917: 		buf = (u_char*) (rpc + 1);
  918: 		len = estlen;
  919: 
  920: 		c->cli_sock = TASK_FD(task);
  921: 
  922: 		/* armed timer for close stateless connection */
  923: 		schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL);
  924: 		schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  925: 				c, ts, c, 0);
  926: 	}
  927: 
  928: 	/* get next part of packet */
  929: 	memset(buf, 0, len);
  930: 	pfd.fd = TASK_FD(task);
  931: 	pfd.events = POLLIN | POLLPRI;
  932: 	for (; len > 0; len -= rlen, buf += rlen) {
  933: 		if ((rlen = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || 
  934: 				pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {
  935: 			if (rlen)
  936: 				LOGERR;
  937: 			else
  938: 				rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond");
  939: 			schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  940: 					c, 0, NULL, 0);
  941: 			goto end;
  942: 		}
  943: 		rlen = read(TASK_FD(task), buf, len);
  944: 		if (rlen == -1) {
  945: 			/* close connection */
  946: 			schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], 
  947: 					c, 0, NULL, 0);
  948: 			goto end;
  949: 		}
  950: 	}
  951: 	len = estlen;
  952: 
  953: 	noreply = RPC_CHK_NOREPLY(rpc);
  954: 
  955: 	/* check RPC packet session info */
  956: 	if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) {
  957: 		rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
  958: 
  959: 		rpc->call_argc ^= rpc->call_argc;
  960: 		rpc->call_rep.ret = RPC_ERROR(-1);
  961: 		rpc->call_rep.eno = RPC_ERROR(errno);
  962: 	} else {
  963: 		/* execute RPC call */
  964: 		schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
  965: 	}
  966: 
  967: 	/* send RPC reply */
  968: 	if (!noreply)
  969: 		schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], 
  970: 				c, TASK_FD(task), rpc, len);
  971: end:
  972: 	schedReadSelf(task);
  973: 	return NULL;
  974: }
  975: 
  976: /* ------------------------------------------------------ */
  977: 
  978: void
  979: rpc_freeBLOBCli(rpc_cli_t * __restrict c)
  980: {
  981: 	rpc_srv_t *s = c->cli_parent;
  982: 
  983: 	schedCancelby(s->srv_blob.root, taskMAX, CRITERIA_ARG, c, NULL);
  984: 
  985: 	/* free buffer */
  986: 	AIT_FREE_VAL(&c->cli_buf);
  987: 
  988: 	array_Del(s->srv_blob.clients, c->cli_id, 0);
  989: 	if (c)
  990: 		e_free(c);
  991: }
  992: 
  993: 
  994: static void *
  995: closeBLOBClient(sched_task_t *task)
  996: {
  997: 	int sock = ((rpc_cli_t*) TASK_ARG(task))->cli_sock;
  998: 
  999: 	rpc_freeBLOBCli(TASK_ARG(task));
 1000: 
 1001: 	/* close client socket */
 1002: 	shutdown(sock, SHUT_RDWR);
 1003: 	close(sock);
 1004: 	return NULL;
 1005: }
 1006: 
 1007: static void *
 1008: txBLOB(sched_task_t *task)
 1009: {
 1010: 	rpc_cli_t *c = TASK_ARG(task);
 1011: 	u_char *buf = AIT_GET_BUF(&c->cli_buf);
 1012: 	int wlen = sizeof(struct tagBLOBHdr);
 1013: 
 1014: 	/* send reply */
 1015: 	wlen = send(TASK_FD(task), buf, wlen, MSG_NOSIGNAL);
 1016: 	if (wlen == -1 || wlen != sizeof(struct tagBLOBHdr)) {
 1017: 		/* close blob connection */
 1018: 		schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);
 1019: 	}
 1020: 
 1021: 	return NULL;
 1022: }
 1023: 
 1024: static void *
 1025: rxBLOB(sched_task_t *task)
 1026: {
 1027: 	rpc_cli_t *c = TASK_ARG(task);
 1028: 	rpc_srv_t *s = c->cli_parent;
 1029: 	rpc_blob_t *b;
 1030: 	struct tagBLOBHdr blob;
 1031: 	int rlen;
 1032: 
 1033: 	memset(&blob, 0, sizeof blob);
 1034: 	rlen = recv(TASK_FD(task), &blob, sizeof blob, 0);
 1035: 	if (rlen < 1) {
 1036: 		/* close blob connection */
 1037: 		schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);
 1038: 		return NULL;
 1039: 	}
 1040: 
 1041: 	/* check BLOB packet */
 1042: 	if (rlen < sizeof(struct tagBLOBHdr)) {
 1043: 		rpc_SetErr(ERPCMISMATCH, "Short BLOB packet");
 1044: 
 1045: 		schedReadSelf(task);
 1046: 		return NULL;
 1047: 	}
 1048: 
 1049: 	/* check RPC packet session info */
 1050: 	if (rpc_chkPktSession(&blob.hdr_session, &s->srv_session)) {
 1051: 		rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
 1052: 		blob.hdr_cmd = error;
 1053: 		goto end;
 1054: 	}
 1055: 
 1056: 	/* Go to proceed packet ... */
 1057: 	switch (blob.hdr_cmd) {
 1058: 		case get:
 1059: 			if (!(b = rpc_srv_getBLOB(s, ntohl(blob.hdr_var)))) {
 1060: 				rpc_SetErr(EINVAL, "Var=%x not found", ntohl(blob.hdr_var));
 1061: 				blob.hdr_cmd = no;
 1062: 				blob.hdr_ret = RPC_ERROR(-1);
 1063: 				break;
 1064: 			} else
 1065: 				blob.hdr_len = htonl(b->blob_len);
 1066: 
 1067: 			if (rpc_srv_blobMap(s, b) != -1) {
 1068: 				/* deliver BLOB variable to client */
 1069: 				blob.hdr_ret = htonl(rpc_srv_sendBLOB(c, b));
 1070: 				rpc_srv_blobUnmap(b);
 1071: 			} else {
 1072: 				blob.hdr_cmd = error;
 1073: 				blob.hdr_ret = RPC_ERROR(-1);
 1074: 			}
 1075: 			break;
 1076: 		case set:
 1077: 			if ((b = rpc_srv_registerBLOB(s, ntohl(blob.hdr_len), 
 1078: 							ntohl(blob.hdr_ret)))) {
 1079: 				/* set new BLOB variable for reply :) */
 1080: 				blob.hdr_var = htonl(b->blob_var);
 1081: 
 1082: 				/* receive BLOB from client */
 1083: 				blob.hdr_ret = htonl(rpc_srv_recvBLOB(c, b));
 1084: 				rpc_srv_blobUnmap(b);
 1085: 			} else {
 1086: 				blob.hdr_cmd = error;
 1087: 				blob.hdr_ret = RPC_ERROR(-1);
 1088: 			}
 1089: 			break;
 1090: 		case unset:
 1091: 			if (rpc_srv_unregisterBLOB(s, ntohl(blob.hdr_var)) == -1) {
 1092: 				blob.hdr_cmd = error;
 1093: 				blob.hdr_ret = RPC_ERROR(-1);
 1094: 			}
 1095: 			break;
 1096: 		default:
 1097: 			rpc_SetErr(EPROCUNAVAIL, "Unsupported BLOB command %d", blob.hdr_cmd);
 1098: 			blob.hdr_cmd = error;
 1099: 			blob.hdr_ret = RPC_ERROR(-1);
 1100: 	}
 1101: 
 1102: end:
 1103: 	memcpy(AIT_ADDR(&c->cli_buf), &blob, sizeof blob);
 1104: 	schedWrite(TASK_ROOT(task), txBLOB, TASK_ARG(task), TASK_FD(task), NULL, 0);
 1105: 	schedReadSelf(task);
 1106: 	return NULL;
 1107: }
 1108: 
 1109: static void *
 1110: flushBLOB(sched_task_t *task)
 1111: {
 1112: 	uintptr_t sigArg = atomic_load_acq_ptr(&_glSigArg);
 1113: 	rpc_srv_t *srv = sigArg ? (void*) sigArg : TASK_ARG(task);
 1114: 	rpc_blob_t *b, *tmp;
 1115: 
 1116: 	TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) {
 1117: 		TAILQ_REMOVE(&srv->srv_blob.blobs, b, blob_node);
 1118: 
 1119: 		rpc_srv_blobFree(srv, b);
 1120: 		e_free(b);
 1121: 	}
 1122: 
 1123: 	if (!schedSignalSelf(task)) {
 1124: 		/* disabled kqueue support in libaitsched */
 1125: 		struct sigaction sa;
 1126: 
 1127: 		memset(&sa, 0, sizeof sa);
 1128: 		sigemptyset(&sa.sa_mask);
 1129: 		sa.sa_handler = (void (*)(int)) flushBLOB;
 1130: 		sa.sa_flags = SA_RESTART | SA_RESETHAND;
 1131: 		sigaction(SIGFBLOB, &sa, NULL);
 1132: 	}
 1133: 
 1134: 	return NULL;
 1135: }
 1136: 
 1137: static void *
 1138: acceptBLOBClients(sched_task_t *task)
 1139: {
 1140: 	rpc_srv_t *srv = TASK_ARG(task);
 1141: 	rpc_cli_t *c = NULL;
 1142: 	register int i;
 1143: 	socklen_t salen = sizeof(sockaddr_t);
 1144: 	int sock;
 1145: #ifdef TCP_NOPUSH
 1146: 	int n = 1;
 1147: #endif
 1148: 
 1149: 	/* check free slots for connect */
 1150: 	for (i = 0; i < array_Size(srv->srv_blob.clients) && 
 1151: 			(c = array(srv->srv_blob.clients, i, rpc_cli_t*)); i++);
 1152: 	if (c) {	/* no more free slots! */
 1153: 		EVERBOSE(1, "BLOB client quota exceeded! Connection will be shutdown!\n");
 1154: 		if ((sock = accept(TASK_FD(task), NULL, NULL)) != -1) {
 1155: 			shutdown(sock, SHUT_RDWR);
 1156: 			close(sock);
 1157: 		}
 1158: 		goto end;
 1159: 	}
 1160: 
 1161: 	c = e_malloc(sizeof(rpc_cli_t));
 1162: 	if (!c) {
 1163: 		LOGERR;
 1164: 		srv->srv_kill = srv->srv_blob.kill = 1;
 1165: 		return NULL;
 1166: 	} else {
 1167: 		memset(c, 0, sizeof(rpc_cli_t));
 1168: 		array_Set(srv->srv_blob.clients, i, c);
 1169: 		c->cli_id = i;
 1170: 		c->cli_parent = srv;
 1171: 	}
 1172: 
 1173: 	/* alloc empty buffer */
 1174: 	AIT_SET_BUFSIZ(&c->cli_buf, 0, srv->srv_netbuf);
 1175: 
 1176: 	/* accept client */
 1177: 	c->cli_sock = accept(TASK_FD(task), &c->cli_sa.sa, &salen);
 1178: 	if (c->cli_sock == -1) {
 1179: 		LOGERR;
 1180: 		AIT_FREE_VAL(&c->cli_buf);
 1181: 		array_Del(srv->srv_blob.clients, i, 42);
 1182: 		goto end;
 1183: 	} else {
 1184: #ifdef TCP_NOPUSH
 1185: 		setsockopt(c->cli_sock, IPPROTO_TCP, TCP_NOPUSH, &n, sizeof n);
 1186: #endif
 1187: 		fcntl(c->cli_sock, F_SETFL, fcntl(c->cli_sock, F_GETFL) | O_NONBLOCK);
 1188: 	}
 1189: 
 1190: 	schedRead(TASK_ROOT(task), rxBLOB, c, c->cli_sock, NULL, 0);
 1191: end:
 1192: 	schedReadSelf(task);
 1193: 	return NULL;
 1194: }
 1195: 
 1196: /* ------------------------------------------------------ */
 1197: 
 1198: /*
 1199:  * rpc_srv_initBLOBServer() - Init & create BLOB Server
 1200:  *
 1201:  * @srv = RPC server instance
 1202:  * @Port = Port for bind server, if Port == 0 default port is selected
 1203:  * @diskDir = Disk place for BLOB file objects
 1204:  * return: -1 == error or 0 bind and created BLOB server instance
 1205:  */
 1206: int
 1207: rpc_srv_initBLOBServer(rpc_srv_t * __restrict srv, u_short Port, const char *diskDir)
 1208: {
 1209: 	int n = 1;
 1210: 
 1211: 	if (!srv || srv->srv_kill) {
 1212: 		rpc_SetErr(EINVAL, "Invalid parameters can`t init BLOB server");
 1213: 		return -1;
 1214: 	}
 1215: 
 1216: 	memset(&srv->srv_blob, 0, sizeof srv->srv_blob);
 1217: 	if (access(diskDir, R_OK | W_OK) == -1) {
 1218: 		LOGERR;
 1219: 		return -1;
 1220: 	} else
 1221: 		AIT_SET_STR(&srv->srv_blob.dir, diskDir);
 1222: 
 1223: 	/* init blob list */
 1224: 	TAILQ_INIT(&srv->srv_blob.blobs);
 1225: 
 1226: 	srv->srv_blob.server.cli_parent = srv;
 1227: 
 1228: 	memcpy(&srv->srv_blob.server.cli_sa, &srv->srv_server.cli_sa, sizeof(sockaddr_t));
 1229: 	switch (srv->srv_blob.server.cli_sa.sa.sa_family) {
 1230: 		case AF_INET:
 1231: 			srv->srv_blob.server.cli_sa.sin.sin_port = 
 1232: 				htons(Port ? Port : ntohs(srv->srv_blob.server.cli_sa.sin.sin_port) + 1);
 1233: 			break;
 1234: 		case AF_INET6:
 1235: 			srv->srv_blob.server.cli_sa.sin6.sin6_port = 
 1236: 				htons(Port ? Port : ntohs(srv->srv_blob.server.cli_sa.sin6.sin6_port) + 1);
 1237: 			break;
 1238: 		case AF_LOCAL:
 1239: 			strlcat(srv->srv_blob.server.cli_sa.sun.sun_path, ".blob", 
 1240: 					sizeof srv->srv_blob.server.cli_sa.sun.sun_path);
 1241: 			break;
 1242: 		default:
 1243: 			AIT_FREE_VAL(&srv->srv_blob.dir);
 1244: 			return -1;
 1245: 	}
 1246: 
 1247: 	/* create BLOB server socket */
 1248: 	srv->srv_blob.server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family, SOCK_STREAM, 0);
 1249: 	if (srv->srv_blob.server.cli_sock == -1) {
 1250: 		LOGERR;
 1251: 		AIT_FREE_VAL(&srv->srv_blob.dir);
 1252: 		return -1;
 1253: 	}
 1254: 	if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
 1255: 		LOGERR;
 1256: 		close(srv->srv_blob.server.cli_sock);
 1257: 		AIT_FREE_VAL(&srv->srv_blob.dir);
 1258: 		return -1;
 1259: 	}
 1260: 	n = srv->srv_netbuf;
 1261: 	if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
 1262: 		LOGERR;
 1263: 		close(srv->srv_blob.server.cli_sock);
 1264: 		AIT_FREE_VAL(&srv->srv_blob.dir);
 1265: 		return -1;
 1266: 	}
 1267: 	if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
 1268: 		LOGERR;
 1269: 		close(srv->srv_blob.server.cli_sock);
 1270: 		AIT_FREE_VAL(&srv->srv_blob.dir);
 1271: 		return -1;
 1272: 	}
 1273: 	if (bind(srv->srv_blob.server.cli_sock, &srv->srv_blob.server.cli_sa.sa, 
 1274: 				srv->srv_blob.server.cli_sa.sa.sa_len) == -1) {
 1275: 		LOGERR;
 1276: 		close(srv->srv_blob.server.cli_sock);
 1277: 		AIT_FREE_VAL(&srv->srv_blob.dir);
 1278: 		return -1;
 1279: 	} else
 1280: 		fcntl(srv->srv_blob.server.cli_sock, F_SETFL, 
 1281: 				fcntl(srv->srv_blob.server.cli_sock, F_GETFL) | O_NONBLOCK);
 1282: 
 1283: 
 1284: 	/* allocate pool for concurent blob clients */
 1285: 	srv->srv_blob.clients = array_Init(array_Size(srv->srv_clients));
 1286: 	if (!srv->srv_blob.clients) {
 1287: 		rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
 1288: 		close(srv->srv_blob.server.cli_sock);
 1289: 		AIT_FREE_VAL(&srv->srv_blob.dir);
 1290: 		return -1;
 1291: 	}
 1292: 
 1293: 	/* init blob scheduler */
 1294: 	srv->srv_blob.root = schedBegin();
 1295: 	if (!srv->srv_blob.root) {
 1296: 		rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
 1297: 		array_Destroy(&srv->srv_blob.clients);
 1298: 		close(srv->srv_blob.server.cli_sock);
 1299: 		AIT_FREE_VAL(&srv->srv_blob.dir);
 1300: 		return -1;
 1301: 	}
 1302: 
 1303: 	return 0;
 1304: }
 1305: 
 1306: /*
 1307:  * rpc_srv_endBLOBServer() - Destroy BLOB server, close all opened sockets and free resources
 1308:  *
 1309:  * @srv = RPC Server instance
 1310:  * return: none
 1311:  */
 1312: void
 1313: rpc_srv_endBLOBServer(rpc_srv_t * __restrict srv)
 1314: {
 1315: 	if (!srv)
 1316: 		return;
 1317: 
 1318: 	srv->srv_blob.kill = 1;
 1319: 
 1320: 	schedEnd(&srv->srv_blob.root);
 1321: }
 1322: 
 1323: /*
 1324:  * rpc_srv_loopBLOBServer() - Execute Main BLOB server loop and wait for clients requests
 1325:  *
 1326:  * @srv = RPC Server instance
 1327:  * return: -1 error or 0 ok, infinite loop ...
 1328:  */
 1329: int
 1330: rpc_srv_loopBLOBServer(rpc_srv_t * __restrict srv)
 1331: {
 1332: 	rpc_cli_t *c;
 1333: 	register int i;
 1334: 	rpc_blob_t *b, *tmp;
 1335: 	struct timespec ts = { RPC_SCHED_POLLING, 0 };
 1336: 
 1337: 	if (!srv || srv->srv_kill) {
 1338: 		rpc_SetErr(EINVAL, "Invalid parameter can`t start BLOB server");
 1339: 		return -1;
 1340: 	}
 1341: 
 1342: 	if (listen(srv->srv_blob.server.cli_sock, array_Size(srv->srv_blob.clients)) == -1) {
 1343: 		LOGERR;
 1344: 		return -1;
 1345: 	}
 1346: 
 1347: 	if (!schedSignal(srv->srv_blob.root, flushBLOB, srv, SIGFBLOB, NULL, 0)) {
 1348: 		/* disabled kqueue support in libaitsched */
 1349: 		struct sigaction sa;
 1350: 
 1351: 		atomic_store_rel_ptr(&_glSigArg, (uintptr_t) srv);
 1352: 
 1353: 		memset(&sa, 0, sizeof sa);
 1354: 		sigemptyset(&sa.sa_mask);
 1355: 		sa.sa_handler = (void (*)(int)) flushBLOB;
 1356: 		sa.sa_flags = SA_RESTART | SA_RESETHAND;
 1357: 		sigaction(SIGFBLOB, &sa, NULL);
 1358: 	}
 1359: 
 1360: 	if (!schedRead(srv->srv_blob.root, acceptBLOBClients, srv, 
 1361: 				srv->srv_blob.server.cli_sock, NULL, 0)) {
 1362: 		rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
 1363: 		return -1;
 1364: 	}
 1365: 
 1366: 	schedPolling(srv->srv_blob.root, &ts, NULL);
 1367: 	/* main rpc loop */
 1368: 	schedRun(srv->srv_blob.root, &srv->srv_blob.kill);
 1369: 
 1370: 	/* detach blobs */
 1371: 	TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) {
 1372: 		TAILQ_REMOVE(&srv->srv_blob.blobs, b, blob_node);
 1373: 
 1374: 		rpc_srv_blobFree(srv, b);
 1375: 		e_free(b);
 1376: 	}
 1377: 
 1378: 	/* close all clients connections & server socket */
 1379: 	for (i = 0; i < array_Size(srv->srv_blob.clients); i++) {
 1380: 		c = array(srv->srv_blob.clients, i, rpc_cli_t*);
 1381: 		if (c) {
 1382: 			shutdown(c->cli_sock, SHUT_RDWR);
 1383: 			close(c->cli_sock);
 1384: 
 1385: 			schedCancelby(srv->srv_blob.root, taskMAX, CRITERIA_ARG, c, NULL);
 1386: 			AIT_FREE_VAL(&c->cli_buf);
 1387: 		}
 1388: 		array_Del(srv->srv_blob.clients, i, 42);
 1389: 	}
 1390: 	array_Destroy(&srv->srv_blob.clients);
 1391: 
 1392: 	close(srv->srv_blob.server.cli_sock);
 1393: 
 1394: 	AIT_FREE_VAL(&srv->srv_blob.dir);
 1395: 	return 0;
 1396: }
 1397: 
 1398: 
 1399: /*
 1400:  * rpc_srv_initServer() - Init & create RPC Server
 1401:  *
 1402:  * @InstID = Instance for authentication & recognition
 1403:  * @concurentClients = Concurent clients at same time to this server
 1404:  * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
 1405:  * @csHost = Host name or address for bind server, if NULL any address
 1406:  * @Port = Port for bind server, if Port == 0 default port is selected
 1407:  * @proto = Protocol, if == 0 choose SOCK_STREAM
 1408:  * return: NULL == error or !=NULL bind and created RPC server instance
 1409:  */
 1410: rpc_srv_t *
 1411: rpc_srv_initServer(u_char InstID, int concurentClients, int netBuf, 
 1412: 		const char *csHost, u_short Port, int proto)
 1413: {
 1414: 	int n = 1;
 1415: 	rpc_srv_t *srv = NULL;
 1416: 	sockaddr_t sa = E_SOCKADDR_INIT;
 1417: 
 1418: 	if (!concurentClients || (proto < 0 || proto > SOCK_RAW)) {
 1419: 		rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server");
 1420: 		return NULL;
 1421: 	}
 1422: 	if (!e_gethostbyname(csHost, Port, &sa))
 1423: 		return NULL;
 1424: 	if (!Port)
 1425: 		Port = RPC_DEFPORT;
 1426: 	if (!proto)
 1427: 		proto = SOCK_STREAM;
 1428: 	if (netBuf < RPC_MIN_BUFSIZ)
 1429: 		netBuf = BUFSIZ;
 1430: 	else
 1431: 		netBuf = E_ALIGN(netBuf, 2);	/* align netBuf length */
 1432: 
 1433: #ifdef HAVE_SRANDOMDEV
 1434: 	srandomdev();
 1435: #else
 1436: 	time_t tim;
 1437: 
 1438: 	srandom((time(&tim) ^ getpid()));
 1439: #endif
 1440: 
 1441: 	srv = e_malloc(sizeof(rpc_srv_t));
 1442: 	if (!srv) {
 1443: 		LOGERR;
 1444: 		return NULL;
 1445: 	} else
 1446: 		memset(srv, 0, sizeof(rpc_srv_t));
 1447: 
 1448: 	srv->srv_proto = proto;
 1449: 	srv->srv_netbuf = netBuf;
 1450: 	srv->srv_session.sess_version = RPC_VERSION;
 1451: 	srv->srv_session.sess_instance = InstID;
 1452: 
 1453: 	srv->srv_server.cli_parent = srv;
 1454: 	memcpy(&srv->srv_server.cli_sa, &sa, sizeof srv->srv_server.cli_sa);
 1455: 
 1456: 	/* init functions */
 1457: 	pthread_mutex_init(&srv->srv_funcs.mtx, NULL);
 1458: 	SLIST_INIT(&srv->srv_funcs);
 1459: 	AVL_INIT(&srv->srv_funcs);
 1460: 
 1461: 	/* init scheduler */
 1462: 	srv->srv_root = schedBegin();
 1463: 	if (!srv->srv_root) {
 1464: 		rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
 1465: 		pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1466: 		e_free(srv);
 1467: 		return NULL;
 1468: 	}
 1469: 
 1470: 	/* init pool for clients */
 1471: 	srv->srv_clients = array_Init(concurentClients);
 1472: 	if (!srv->srv_clients) {
 1473: 		rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
 1474: 		schedEnd(&srv->srv_root);
 1475: 		pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1476: 		e_free(srv);
 1477: 		return NULL;
 1478: 	}
 1479: 
 1480: 	/* create server socket */
 1481: 	srv->srv_server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family, srv->srv_proto, 0);
 1482: 	if (srv->srv_server.cli_sock == -1) {
 1483: 		LOGERR;
 1484: 		array_Destroy(&srv->srv_clients);
 1485: 		schedEnd(&srv->srv_root);
 1486: 		pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1487: 		e_free(srv);
 1488: 		return NULL;
 1489: 	}
 1490: 	if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
 1491: 		LOGERR;
 1492: 		goto err;
 1493: 	}
 1494: 	n = srv->srv_netbuf;
 1495: 	if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
 1496: 		LOGERR;
 1497: 		goto err;
 1498: 	}
 1499: 	if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
 1500: 		LOGERR;
 1501: 		goto err;
 1502: 	}
 1503: 	if (bind(srv->srv_server.cli_sock, &srv->srv_server.cli_sa.sa, 
 1504: 				srv->srv_server.cli_sa.sa.sa_len) == -1) {
 1505: 		LOGERR;
 1506: 		goto err;
 1507: 	} else
 1508: 		fcntl(srv->srv_server.cli_sock, F_SETFL, 
 1509: 				fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK);
 1510: 
 1511: 	rpc_register_srvPing(srv);
 1512: 
 1513: 	return srv;
 1514: err:	/* error condition */
 1515: 	close(srv->srv_server.cli_sock);
 1516: 	array_Destroy(&srv->srv_clients);
 1517: 	schedEnd(&srv->srv_root);
 1518: 	pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1519: 	e_free(srv);
 1520: 	return NULL;
 1521: }
 1522: 
 1523: /*
 1524:  * rpc_srv_endServer() - Destroy RPC server, close all opened sockets and free resources
 1525:  *
 1526:  * @psrv = RPC Server instance
 1527:  * return: none
 1528:  */
 1529: void
 1530: rpc_srv_endServer(rpc_srv_t ** __restrict psrv)
 1531: {
 1532: 	if (!psrv || !*psrv)
 1533: 		return;
 1534: 
 1535: 	/* if send kill to blob server */
 1536: 	rpc_srv_endBLOBServer(*psrv);
 1537: 
 1538: 	(*psrv)->srv_kill = 1;
 1539: 	sleep(RPC_SCHED_POLLING);
 1540: 
 1541: 	schedEnd(&(*psrv)->srv_root);
 1542: 
 1543: 	pthread_mutex_destroy(&(*psrv)->srv_funcs.mtx);
 1544: 	e_free(*psrv);
 1545: 	*psrv = NULL;
 1546: }
 1547: 
 1548: /*
 1549:  * rpc_srv_loopServer() - Execute Main server loop and wait for clients requests
 1550:  *
 1551:  * @srv = RPC Server instance
 1552:  * return: -1 error or 0 ok, infinite loop ...
 1553:  */
 1554: int
 1555: rpc_srv_loopServer(rpc_srv_t * __restrict srv)
 1556: {
 1557: 	rpc_cli_t *c;
 1558: 	register int i;
 1559: 	rpc_func_t *f;
 1560: 	struct timespec ts = { RPC_SCHED_POLLING, 0 };
 1561: 
 1562: 	if (!srv) {
 1563: 		rpc_SetErr(EINVAL, "Invalid parameter can`t start RPC server");
 1564: 		return -1;
 1565: 	}
 1566: 
 1567: 	if (srv->srv_proto == SOCK_STREAM)
 1568: 		if (listen(srv->srv_server.cli_sock, array_Size(srv->srv_clients)) == -1) {
 1569: 			LOGERR;
 1570: 			return -1;
 1571: 		}
 1572: 
 1573: 	if (!schedRead(srv->srv_root, cbProto[srv->srv_proto][CB_ACCEPTCLIENT], srv, 
 1574: 				srv->srv_server.cli_sock, NULL, 0)) {
 1575: 		rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
 1576: 		return -1;
 1577: 	}
 1578: 
 1579: 	schedPolling(srv->srv_root, &ts, NULL);
 1580: 	/* main rpc loop */
 1581: 	schedRun(srv->srv_root, &srv->srv_kill);
 1582: 
 1583: 	/* close all clients connections & server socket */
 1584: 	for (i = 0; i < array_Size(srv->srv_clients); i++) {
 1585: 		c = array(srv->srv_clients, i, rpc_cli_t*);
 1586: 		if (c) {
 1587: 			if (srv->srv_proto == SOCK_STREAM) {
 1588: 				shutdown(c->cli_sock, SHUT_RDWR);
 1589: 				close(c->cli_sock);
 1590: 			}
 1591: 
 1592: 			schedCancelby(srv->srv_root, taskMAX, CRITERIA_ARG, c, NULL);
 1593: 			ait_freeVars(&RPC_RETVARS(c));
 1594: 			AIT_FREE_VAL(&c->cli_buf);
 1595: 		}
 1596: 		array_Del(srv->srv_clients, i, 42);
 1597: 	}
 1598: 	array_Destroy(&srv->srv_clients);
 1599: 
 1600: 	if (srv->srv_proto != SOCK_EXT)
 1601: 		close(srv->srv_server.cli_sock);
 1602: 
 1603: 	/* detach exported calls */
 1604: 	RPC_FUNCS_LOCK(&srv->srv_funcs);
 1605: 	while ((f = SLIST_FIRST(&srv->srv_funcs))) {
 1606: 		SLIST_REMOVE_HEAD(&srv->srv_funcs, func_next);
 1607: 
 1608: 		AIT_FREE_VAL(&f->func_name);
 1609: 		e_free(f);
 1610: 	}
 1611: 	srv->srv_funcs.avlh_root = NULL;
 1612: 	RPC_FUNCS_UNLOCK(&srv->srv_funcs);
 1613: 
 1614: 	return 0;
 1615: }
 1616: 
 1617: 
 1618: /*
 1619:  * rpc_srv_execCall() Execute registered call from RPC server
 1620:  *
 1621:  * @cli = RPC client
 1622:  * @rpc = IN RPC call structure
 1623:  * @funcname = Execute RPC function
 1624:  * @args = IN RPC calling arguments from RPC client
 1625:  * return: -1 error, !=-1 ok
 1626:  */
 1627: int
 1628: rpc_srv_execCall(rpc_cli_t * __restrict cli, struct tagRPCCall * __restrict rpc, 
 1629: 		ait_val_t funcname, array_t * __restrict args)
 1630: {
 1631: 	rpc_callback_t func;
 1632: 
 1633: 	if (!cli || !rpc || !AIT_ADDR(&funcname)) {
 1634: 		rpc_SetErr(EINVAL, "Invalid parameter can`t exec function");
 1635: 		return -1;
 1636: 	}
 1637: 
 1638: 	func = AIT_GET_LIKE(&funcname, rpc_callback_t);
 1639: 	return func(cli, rpc, args);
 1640: }
 1641: 
 1642: 
 1643: /*
 1644:  * rpc_srv_initServer2() - Init & create layer2 RPC Server
 1645:  *
 1646:  * @InstID = Instance for authentication & recognition
 1647:  * @concurentClients = Concurent clients at same time to this server
 1648:  * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
 1649:  * @csIface = Interface name for bind server, if NULL first interface on host
 1650:  * return: NULL == error or !=NULL bind and created RPC server instance
 1651:  */
 1652: rpc_srv_t *
 1653: rpc_srv_initServer2(u_char InstID, int concurentClients, int netBuf, const char *csIface)
 1654: {
 1655: 	int n = 1;
 1656: 	rpc_srv_t *srv = NULL;
 1657: 	sockaddr_t sa = E_SOCKADDR_INIT;
 1658: 	char szIface[64], szStr[STRSIZ];
 1659: 	register int i;
 1660: 	struct ifreq ifr;
 1661: 	struct bpf_insn insns[] = {
 1662: 		BPF_STMT(BPF_LD + BPF_H + BPF_ABS, 12),
 1663: 		BPF_JUMP(BPF_JMP + BPF_JEQ + BPF_K, RPC_DEFPORT, 0, 1),
 1664: 		BPF_STMT(BPF_RET + BPF_K, -1),
 1665: 		BPF_STMT(BPF_RET + BPF_K, 0),
 1666: 	};
 1667: 	struct bpf_program fcode = { 
 1668: 		.bf_len = sizeof(insns) / sizeof(struct bpf_insn), 
 1669:        		.bf_insns = insns
 1670: 	};
 1671: 
 1672: 	if (!concurentClients) {
 1673: 		rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server");
 1674: 		return NULL;
 1675: 	}
 1676: 	if (!csIface) {
 1677: 		if (e_get1stiface(szIface, sizeof szIface))
 1678: 			return NULL;
 1679: 	} else
 1680: 		strlcpy(szIface, csIface, sizeof szIface);
 1681: 	if (!e_getifacebyname(szIface, &sa))
 1682: 		return NULL;
 1683: 
 1684: #ifdef HAVE_SRANDOMDEV
 1685: 	srandomdev();
 1686: #else
 1687: 	time_t tim;
 1688: 
 1689: 	srandom((time(&tim) ^ getpid()));
 1690: #endif
 1691: 
 1692: 	srv = e_malloc(sizeof(rpc_srv_t));
 1693: 	if (!srv) {
 1694: 		LOGERR;
 1695: 		return NULL;
 1696: 	} else
 1697: 		memset(srv, 0, sizeof(rpc_srv_t));
 1698: 
 1699: 	srv->srv_proto = SOCK_BPF;
 1700: 	srv->srv_netbuf = netBuf;
 1701: 	srv->srv_session.sess_version = RPC_VERSION;
 1702: 	srv->srv_session.sess_instance = InstID;
 1703: 
 1704: 	srv->srv_server.cli_parent = srv;
 1705: 	memcpy(&srv->srv_server.cli_sa, &sa, sizeof srv->srv_server.cli_sa);
 1706: 
 1707: 	/* init functions */
 1708: 	pthread_mutex_init(&srv->srv_funcs.mtx, NULL);
 1709: 	SLIST_INIT(&srv->srv_funcs);
 1710: 	AVL_INIT(&srv->srv_funcs);
 1711: 
 1712: 	/* init scheduler */
 1713: 	srv->srv_root = schedBegin();
 1714: 	if (!srv->srv_root) {
 1715: 		rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
 1716: 		pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1717: 		e_free(srv);
 1718: 		return NULL;
 1719: 	}
 1720: 
 1721: 	/* init pool for clients */
 1722: 	srv->srv_clients = array_Init(concurentClients);
 1723: 	if (!srv->srv_clients) {
 1724: 		rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
 1725: 		schedEnd(&srv->srv_root);
 1726: 		pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1727: 		e_free(srv);
 1728: 		return NULL;
 1729: 	}
 1730: 
 1731: 	/* create server handler */
 1732: 	for (i = 0; i < 10; i++) {
 1733: 		memset(szStr, 0, sizeof szStr);
 1734: 		snprintf(szStr, sizeof szStr, "/dev/bpf%d", i);
 1735: 		srv->srv_server.cli_sock = open(szStr, O_RDWR);
 1736: 		if (srv->srv_server.cli_sock > STDERR_FILENO)
 1737: 			break;
 1738: 	}
 1739: 	if (srv->srv_server.cli_sock < 3) {
 1740: 		LOGERR;
 1741: 		array_Destroy(&srv->srv_clients);
 1742: 		schedEnd(&srv->srv_root);
 1743: 		pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1744: 		e_free(srv);
 1745: 		return NULL;
 1746: 	}
 1747: 
 1748: 	if (ioctl(srv->srv_server.cli_sock, BIOCIMMEDIATE, &n) == -1) {
 1749: 		LOGERR;
 1750: 		goto err;
 1751: 	}
 1752: 	if (ioctl(srv->srv_server.cli_sock, BIOCSETF, &fcode) == -1) {
 1753: 		LOGERR;
 1754: 		goto err;
 1755: 	}
 1756: 	n = (netBuf < RPC_MIN_BUFSIZ) ? getpagesize() : E_ALIGN(netBuf, 2);
 1757: 	if (ioctl(srv->srv_server.cli_sock, BIOCSBLEN, &n) == -1) {
 1758: 		LOGERR;
 1759: 		goto err;
 1760: 	} else
 1761: 		srv->srv_netbuf = n;
 1762: 
 1763: 	memset(&ifr, 0, sizeof ifr);
 1764: 	strlcpy(ifr.ifr_name, szIface, sizeof ifr.ifr_name);
 1765: 	if (ioctl(srv->srv_server.cli_sock, BIOCSETIF, &ifr) == -1) {
 1766: 		LOGERR;
 1767: 		goto err;
 1768: 	} else
 1769: 		fcntl(srv->srv_server.cli_sock, F_SETFL, 
 1770: 				fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK);
 1771: 
 1772: 	rpc_register_srvPing(srv);
 1773: 
 1774: 	return srv;
 1775: err:	/* error condition */
 1776: 	close(srv->srv_server.cli_sock);
 1777: 	array_Destroy(&srv->srv_clients);
 1778: 	schedEnd(&srv->srv_root);
 1779: 	pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1780: 	e_free(srv);
 1781: 	return NULL;
 1782: }
 1783: 
 1784: /*
 1785:  * rpc_srv_initServerExt() - Init & create pipe RPC Server
 1786:  *
 1787:  * @InstID = Instance for authentication & recognition
 1788:  * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
 1789:  * @fd = File descriptor
 1790:  * return: NULL == error or !=NULL bind and created RPC server instance
 1791:  */
 1792: rpc_srv_t *
 1793: rpc_srv_initServerExt(u_char InstID, int netBuf, int fd)
 1794: {
 1795: 	rpc_srv_t *srv = NULL;
 1796: 
 1797: #ifdef HAVE_SRANDOMDEV
 1798: 	srandomdev();
 1799: #else
 1800: 	time_t tim;
 1801: 
 1802: 	srandom((time(&tim) ^ getpid()));
 1803: #endif
 1804: 
 1805: 	srv = e_malloc(sizeof(rpc_srv_t));
 1806: 	if (!srv) {
 1807: 		LOGERR;
 1808: 		return NULL;
 1809: 	} else
 1810: 		memset(srv, 0, sizeof(rpc_srv_t));
 1811: 
 1812: 	srv->srv_proto = SOCK_EXT;
 1813: 	srv->srv_netbuf = netBuf;
 1814: 	srv->srv_session.sess_version = RPC_VERSION;
 1815: 	srv->srv_session.sess_instance = InstID;
 1816: 
 1817: 	srv->srv_server.cli_parent = srv;
 1818: 	srv->srv_server.cli_sock = fd;
 1819: 
 1820: 	/* init functions */
 1821: 	pthread_mutex_init(&srv->srv_funcs.mtx, NULL);
 1822: 	SLIST_INIT(&srv->srv_funcs);
 1823: 	AVL_INIT(&srv->srv_funcs);
 1824: 
 1825: 	/* init scheduler */
 1826: 	srv->srv_root = schedBegin();
 1827: 	if (!srv->srv_root) {
 1828: 		rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
 1829: 		pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1830: 		e_free(srv);
 1831: 		return NULL;
 1832: 	}
 1833: 
 1834: 	/* init pool for clients */
 1835: 	srv->srv_clients = array_Init(1);
 1836: 	if (!srv->srv_clients) {
 1837: 		rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
 1838: 		schedEnd(&srv->srv_root);
 1839: 		pthread_mutex_destroy(&srv->srv_funcs.mtx);
 1840: 		e_free(srv);
 1841: 		return NULL;
 1842: 	}
 1843: 
 1844: 	fcntl(srv->srv_server.cli_sock, F_SETFL, 
 1845: 			fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK);
 1846: 
 1847: 	rpc_register_srvPing(srv);
 1848: 
 1849: 	return srv;
 1850: }

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>