Return to srv.c CVS log

Up to [ELWIX - Embedded LightWeight unIX -] / libaitrpc / src

release version 3.0

/*************************************************************************
* (C) 2010 AITNET ltd - Sofia/Bulgaria - <misho@aitbg.com>
*  by Michael Pounov <misho@openbsd-bg.org>
*
* $Author: misho $
* $Id: srv.c,v 1.7 2012/03/15 01:55:33 misho Exp $
*
**************************************************************************
The ELWIX and AITNET software is distributed under the following
terms:

All of the documentation and software included in the ELWIX and AITNET
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>

Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012
	by Michael Pounov <misho@elwix.org>.  All rights reserved.

Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions
are met:
1. Redistributions of source code must retain the above copyright
   notice, this list of conditions and the following disclaimer.
2. Redistributions in binary form must reproduce the above copyright
   notice, this list of conditions and the following disclaimer in the
   documentation and/or other materials provided with the distribution.
3. All advertising materials mentioning features or use of this software
   must display the following acknowledgement:
This product includes software developed by Michael Pounov <misho@elwix.org>
ELWIX - Embedded LightWeight unIX and its contributors.
4. Neither the name of AITNET nor the names of its contributors
   may be used to endorse or promote products derived from this software
   without specific prior written permission.

THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND
ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
SUCH DAMAGE.
*/
#include "global.h"


static void *rxPacket(sched_task_t*);
static void *rxBLOB(sched_task_t*);

static void *
txPacket(sched_task_t *task)
{
	rpc_cli_t *c = TASK_ARG(task);
	rpc_srv_t *s = c->cli_parent;
	rpc_func_t *f = NULL;
	u_char *buf = TASK_DATA(task);
	struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
	int ret, wlen = sizeof(struct tagRPCCall);
	array_t *arr = NULL;

	ioTRACE(RPC_TRACE_LEVEL);

	if (rpc->call_argc) {
		f = rpc_srv_getCall(s, ntohs(rpc->call_tag), ntohl(rpc->call_hash));
		if (!f) {
			rpc->call_argc ^= rpc->call_argc;
			rpc->call_rep.ret = RPC_ERROR(-1);
			rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
		} else {
			rpc->call_argc = htons(rpc_srv_getVars(f, &arr));
			/* Go Encapsulate variables */
			ret = io_vars2buffer(buf + wlen, TASK_DATLEN(task) - wlen, arr);
			io_clrVars(f->func_vars);
			if (ret == -1) {
				rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
				rpc->call_argc ^= rpc->call_argc;
				rpc->call_rep.ret = RPC_ERROR(-1);
				rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
			} else
				wlen += ret;
		}
	}

	/* calculate CRC */
	rpc->call_crc ^= rpc->call_crc;
	rpc->call_crc = htons(crcFletcher16((u_short*) buf, io_align(wlen, 1) / 2));

	/* send reply */
	ret = send(TASK_FD(task), buf, wlen, 0);
	if (ret == -1)
		LOGERR;
	else if (ret != wlen)
		rpc_SetErr(EPROCUNAVAIL, "RPC reply, should be send %d bytes, "
				"really sended %d bytes", wlen, ret);
	else
		ioDEBUG(RPC_DEBUG_LEVEL, "Sended %d bytes", ret);

	return NULL;
}

static void *
execCall(sched_task_t *task)
{
	rpc_cli_t *c = TASK_ARG(task);
	rpc_srv_t *s = c->cli_parent;
	rpc_func_t *f = NULL;
	array_t *arr = NULL;
	u_char *buf = TASK_DATA(task);
	struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
	int argc = ntohs(rpc->call_argc);

	ioTRACE(RPC_TRACE_LEVEL);

	/* Go decapsulate variables ... */
	if (!(rpc->call_req.flags & RPC_NOREPLY) && argc) {
		arr = io_buffer2vars(buf + sizeof(struct tagRPCCall), 
				TASK_DATLEN(task) - sizeof(struct tagRPCCall), argc, 1);
		if (!arr) {
			rpc_SetErr(ERPCMISMATCH, "#%d - %s", io_GetErrno(), io_GetError());
			rpc->call_argc ^= rpc->call_argc;
			rpc->call_rep.ret = RPC_ERROR(-1);
			rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
			return NULL;
		}
	}

	if (!(f = rpc_srv_getCall(s, ntohs(rpc->call_tag), ntohl(rpc->call_hash)))) {
		rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
		rpc->call_argc ^= rpc->call_argc;
		rpc->call_rep.ret = RPC_ERROR(-1);
		rpc->call_rep.eno = RPC_ERROR(rpc_Errno);
	} else {
		ioDEBUG(RPC_DEBUG_LEVEL, "RPC function %s from module %s", 
				AIT_GET_STR(&f->func_name), AIT_GET_LIKE(&f->func_file, char*));

		rpc->call_rep.ret = RPC_ERROR(rpc_srv_execCall(f, rpc, arr));
		if (rpc->call_rep.ret == htonl(-1)) {
			rpc->call_rep.eno = RPC_ERROR(errno);
			rpc->call_argc ^= rpc->call_argc;
		} else {
			rpc->call_rep.eno ^= rpc->call_rep.eno;
			rpc->call_argc = htons(rpc_srv_getVars(f, NULL));
		}
	}

	if (arr)
		io_arrayDestroy(&arr);
	return NULL;
}

static void *
rxPacket(sched_task_t *task)
{
	rpc_cli_t *c = TASK_ARG(task);
	rpc_srv_t *s = c->cli_parent;
	u_char *buf = TASK_DATA(task);
	int rlen;
	u_short crc;
	struct tagRPCCall *rpc;
	struct timespec ts;

	ioTRACE(RPC_TRACE_LEVEL);

	memset(buf, 0, TASK_DATLEN(task));
	rlen = recv(TASK_FD(task), buf, TASK_DATLEN(task), 0);
	if (rlen == -1) {
		LOGERR;
		s->srv_kill = s->srv_blob.state = kill;
		return NULL;
	} else if (!rlen) {	/* receive EOF */
		s->srv_kill = s->srv_blob.state = kill;
		return NULL;
	} else
		ioDEBUG(RPC_DEBUG_LEVEL, "Readed %d bytes", rlen);

	if (rlen < sizeof(struct tagRPCCall)) {
		rpc_SetErr(ERPCMISMATCH, "Too short RPC packet");

		schedRead(TASK_ROOT(task), rxPacket, TASK_ARG(task), TASK_FD(task), 
				TASK_DATA(task), TASK_DATLEN(task));
		return NULL;
	} else
		rpc = (struct tagRPCCall*) buf;

	/* check integrity of packet */
	crc = ntohs(rpc->call_crc);
	rpc->call_crc ^= rpc->call_crc;
	if (crc != crcFletcher16((u_short*) buf, io_align(rlen, 1) / 2)) {
		rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");

		schedRead(TASK_ROOT(task), rxPacket, TASK_ARG(task), TASK_FD(task), 
				TASK_DATA(task), TASK_DATLEN(task));
		return NULL;
	}

	/* check RPC packet session info */
	if (rpc_chkPktSession(&rpc->call_session, &s->srv_session)) {
		rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
		rpc->call_argc ^= rpc->call_argc;
		rpc->call_rep.ret = RPC_ERROR(-1);
		rpc->call_rep.eno = RPC_ERROR(errno);
		goto end;
	} else {
		/* change socket timeout from last packet */
		ts.tv_sec = rpc->call_session.sess_timeout;
		ts.tv_nsec = 0;
		schedPolling(TASK_ROOT(task), &ts, NULL);
	}

	/* execute RPC call */
	schedEvent(TASK_ROOT(task), execCall, TASK_ARG(task), 0, 
			TASK_DATA(task), TASK_DATLEN(task));

end:
	/* send RPC reply */
	if (!(rpc->call_req.flags & RPC_NOREPLY))
		schedWrite(TASK_ROOT(task), txPacket, TASK_ARG(task), TASK_FD(task), 
				TASK_DATA(task), TASK_DATLEN(task));
	/* lets get next packet */
	schedRead(TASK_ROOT(task), rxPacket, TASK_ARG(task), TASK_FD(task), 
			TASK_DATA(task), TASK_DATLEN(task));
	return NULL;
}

static void *
rpc_srv_dispatchCall(void *arg)
{
	rpc_cli_t *c = arg;
	rpc_srv_t *s;
	u_char *buf;
	sched_root_task_t *root;
	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };

	ioTRACE(RPC_TRACE_LEVEL);

	if (!arg) {
		rpc_SetErr(EINVAL, "Invalid parameter can`t procced RPC client");
		return NULL;
	} else
		s = c->cli_parent;

	/* allocate net buffer */
	buf = malloc(s->srv_netbuf);
	if (!buf) {
		LOGERR;
		return NULL;
	}

	root = schedBegin();
	if (!root) {
		rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
		free(buf);
		return NULL;
	} else {
		schedTermCondition(root, kill);
		schedPolling(root, &ts, NULL);
	}

	schedRead(root, rxPacket, c, c->cli_sock, buf, s->srv_netbuf);

	schedRun(root, (void*) &s->srv_kill);
	schedEnd(&root);

	shutdown(c->cli_sock, SHUT_RDWR);
	close(c->cli_sock);
	memset(c, 0, sizeof(rpc_cli_t));
	free(buf);
	return NULL;
}


static void *
txBLOB(sched_task_t *task)
{
	u_char *buf = TASK_DATA(task);
	struct tagBLOBHdr *blob = (struct tagBLOBHdr *) buf;
	int wlen = sizeof(struct tagBLOBHdr);

	ioTRACE(RPC_TRACE_LEVEL);

	/* calculate CRC */
	blob->hdr_crc ^= blob->hdr_crc;
	blob->hdr_crc = htons(crcFletcher16((u_short*) buf, io_align(wlen, 1) / 2));

	/* send reply */
	wlen = send(TASK_FD(task), buf, wlen, 0);
	if (wlen == -1)
		LOGERR;
	else if (wlen != sizeof(struct tagBLOBHdr))
		rpc_SetErr(EPROCUNAVAIL, "RPC reply, should be send %d bytes, "
				"really sended %d bytes", sizeof(struct tagBLOBHdr), wlen);
	else
		ioDEBUG(RPC_DEBUG_LEVEL, "Sended %d bytes", wlen);

	return NULL;
}

static void *
rxBLOB(sched_task_t *task)
{
	rpc_cli_t *c = TASK_ARG(task);
	rpc_srv_t *s = c->cli_parent;
	rpc_blob_t *b;
	u_char *buf = TASK_DATA(task);
	struct tagBLOBHdr *blob = (struct tagBLOBHdr *) buf;
	int rlen;
	u_short crc;
	struct timespec ts;

	ioTRACE(RPC_TRACE_LEVEL);

	/* check for disable service at this moment? */
	if (s->srv_blob.state == disable) {
		usleep(100000);
#ifdef HAVE_PTHREAD_YIELD
		pthread_yield();
#endif
		schedRead(TASK_ROOT(task), rxBLOB, TASK_ARG(task), TASK_FD(task), 
				TASK_DATA(task), TASK_DATLEN(task));
		return NULL;
	}

	memset(buf, 0, TASK_DATLEN(task));
	rlen = recv(TASK_FD(task), buf, TASK_DATLEN(task), 0);
	if (rlen == -1) {
		LOGERR;
		s->srv_blob.state = kill;
		return NULL;
	} else if (!rlen || s->srv_kill == kill) { /* receive EOF */
		s->srv_blob.state = kill;
		return NULL;
	} else
		ioDEBUG(RPC_DEBUG_LEVEL, "Readed %d bytes", rlen);

	if (rlen < sizeof(struct tagBLOBHdr)) {
		rpc_SetErr(ERPCMISMATCH, "Too short BLOB packet");
		schedRead(TASK_ROOT(task), rxBLOB, TASK_ARG(task), TASK_FD(task), 
				TASK_DATA(task), TASK_DATLEN(task));
		return NULL;
	}

	/* check integrity of packet */
	crc = ntohs(blob->hdr_crc);
	blob->hdr_crc ^= blob->hdr_crc;
	if (crc != crcFletcher16((u_short*) buf, io_align(rlen, 1) / 2)) {
		rpc_SetErr(ERPCMISMATCH, "Bad CRC BLOB packet");
		schedRead(TASK_ROOT(task), rxBLOB, TASK_ARG(task), TASK_FD(task), 
				TASK_DATA(task), TASK_DATLEN(task));
		return NULL;
	}

	/* check RPC packet session info */
	if ((crc = rpc_chkPktSession(&blob->hdr_session, &s->srv_session))) {
		rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
		blob->hdr_cmd = error;
		goto end;
	} else {
		/* change socket timeout from last packet */
		ts.tv_sec = blob->hdr_session.sess_timeout;
		ts.tv_nsec = 0;
		schedPolling(TASK_ROOT(task), &ts, NULL);
	}

	/* Go to proceed packet ... */
	switch (blob->hdr_cmd) {
		case get:
			if (!(b = rpc_srv_getBLOB(s, ntohl(blob->hdr_var)))) {
				rpc_SetErr(EINVAL, "Var=%x not found", ntohl(blob->hdr_var));
				blob->hdr_cmd = no;
				blob->hdr_ret = RPC_ERROR(-1);
				break;
			} else
				blob->hdr_len = htonl(b->blob_len);

			if (rpc_srv_blobMap(s, b) != -1) {
				/* deliver BLOB variable to client */
				blob->hdr_ret = htonl(rpc_srv_sendBLOB(c, b));
				rpc_srv_blobUnmap(b);
			} else {
				blob->hdr_cmd = error;
				blob->hdr_ret = RPC_ERROR(-1);
			}
			break;
		case set:
			if ((b = rpc_srv_registerBLOB(s, ntohl(blob->hdr_len)))) {
				/* set new BLOB variable for reply :) */
				blob->hdr_var = htonl(b->blob_var);

				/* receive BLOB from client */
				blob->hdr_ret = htonl(rpc_srv_recvBLOB(c, b));
				rpc_srv_blobUnmap(b);
			} else {
				blob->hdr_cmd = error;
				blob->hdr_ret = RPC_ERROR(-1);
			}
			break;
		case unset:
			if (rpc_srv_unregisterBLOB(s, blob->hdr_var) == -1) {
				blob->hdr_cmd = error;
				blob->hdr_ret = RPC_ERROR(-1);
			}
			break;
		default:
			rpc_SetErr(EPROCUNAVAIL, "Unsupported BLOB command %d", blob->hdr_cmd);
			blob->hdr_cmd = error;
			blob->hdr_ret = RPC_ERROR(-1);
	}

end:
	schedWrite(TASK_ROOT(task), txBLOB, TASK_ARG(task), TASK_FD(task), 
			TASK_DATA(task), TASK_DATLEN(task));
	schedRead(TASK_ROOT(task), rxBLOB, TASK_ARG(task), TASK_FD(task), 
			TASK_DATA(task), TASK_DATLEN(task));
	return NULL;
}

static void *
rpc_srv_dispatchVars(void *arg)
{
	rpc_cli_t *c = arg;
	rpc_srv_t *s;
	sched_root_task_t *root;
	u_char *buf;
	struct timespec ts = { DEF_RPC_TIMEOUT, 0 };

	ioTRACE(RPC_TRACE_LEVEL);

	if (!arg) {
		rpc_SetErr(EINVAL, "Invalid parameter can`t procced BLOB");
		return NULL;
	} else
		s = c->cli_parent;

	/* allocate net buffer */
	buf = malloc(sizeof(struct tagBLOBHdr));
	if (!buf) {
		LOGERR;
		return NULL;
	}

	root = schedBegin();
	if (!root) {
		rpc_SetErr(sched_GetErrno(), "%s", sched_GetError());
		free(buf);
		return NULL;
	} else {
		schedTermCondition(root, kill);
		schedPolling(root, &ts, NULL);
	}

	schedRead(root, rxBLOB, c, c->cli_sock, buf, sizeof(struct tagBLOBHdr));

	schedRun(root, (void*) &s->srv_blob.state);
	schedEnd(&root);

	shutdown(c->cli_sock, SHUT_RDWR);
	close(c->cli_sock);
	memset(c, 0, sizeof(rpc_cli_t));
	free(buf);
	return NULL;
}

// -------------------------------------------------

/*
 * rpc_srv_initBLOBServer() - Init & create BLOB Server
 *
 * @srv = RPC server instance
 * @Port = Port for bind server, if Port == 0 default port is selected
 * @diskDir = Disk place for BLOB file objects
 * return: -1 == error or 0 bind and created BLOB server instance
 */
int
rpc_srv_initBLOBServer(rpc_srv_t * __restrict srv, u_short Port, const char *diskDir)
{
	int n = 1;
	io_sockaddr_t sa;

	ioTRACE(RPC_TRACE_LEVEL);

	if (!srv) {
		rpc_SetErr(EINVAL, "Invalid parameters can`t init BLOB server");
		return -1;
	}
	if (srv->srv_blob.state) {
		rpc_SetErr(EPERM, "Already started BLOB server!");
		return 0;
	}

	memset(&srv->srv_blob, 0, sizeof srv->srv_blob);
	if (access(diskDir, R_OK | W_OK) == -1) {
		LOGERR;
		return -1;
	} else
		AIT_SET_STR(&srv->srv_blob.dir, diskDir);

	srv->srv_blob.server.cli_tid = pthread_self();
	srv->srv_blob.server.cli_parent = srv;

	memcpy(&sa, &srv->srv_server.cli_sa, sizeof sa);
	switch (sa.sa.sa_family) {
		case AF_INET:
			sa.sin.sin_port = htons(Port ? Port : ntohs(sa.sin.sin_port) + 1);
			break;
		case AF_INET6:
			sa.sin6.sin6_port = htons(Port ? Port : ntohs(sa.sin6.sin6_port) + 1);
			break;
		case AF_LOCAL:
			strlcat(sa.sun.sun_path, ".blob", sizeof sa.sun.sun_path);
			break;
		default:
			AIT_FREE_VAL(&srv->srv_blob.dir);
			return -1;
	}
	memcpy(&srv->srv_blob.server.cli_sa, &sa, sizeof sa);

	/* create BLOB server socket */
	srv->srv_blob.server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family, SOCK_STREAM, 0);
	if (srv->srv_blob.server.cli_sock == -1) {
		LOGERR;
		AIT_FREE_VAL(&srv->srv_blob.dir);
		return -1;
	}
	if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
		LOGERR;
		close(srv->srv_blob.server.cli_sock);
		AIT_FREE_VAL(&srv->srv_blob.dir);
		return -1;
	}
	n = srv->srv_netbuf;
	if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
		LOGERR;
		close(srv->srv_blob.server.cli_sock);
		AIT_FREE_VAL(&srv->srv_blob.dir);
		return -1;
	}
	if (setsockopt(srv->srv_blob.server.cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
		LOGERR;
		close(srv->srv_blob.server.cli_sock);
		AIT_FREE_VAL(&srv->srv_blob.dir);
		return -1;
	}
	if (bind(srv->srv_blob.server.cli_sock, &srv->srv_blob.server.cli_sa.sa, 
				srv->srv_blob.server.cli_sa.sa.sa_len) == -1) {
		LOGERR;
		close(srv->srv_blob.server.cli_sock);
		AIT_FREE_VAL(&srv->srv_blob.dir);
		return -1;
	}

	/* allocate pool for concurent clients */
	srv->srv_blob.clients = calloc(srv->srv_numcli, sizeof(rpc_cli_t));
	if (!srv->srv_blob.clients) {
		LOGERR;
		close(srv->srv_blob.server.cli_sock);
		AIT_FREE_VAL(&srv->srv_blob.dir);
		return -1;
	} else
		memset(srv->srv_blob.clients, 0, srv->srv_numcli * sizeof(rpc_cli_t));

	pthread_mutex_init(&srv->srv_blob.mtx, NULL);

	rpc_srv_registerCall(srv, NULL, CALL_BLOBSHUTDOWN, 0);
	rpc_srv_registerCall(srv, NULL, CALL_BLOBCLIENTS, 1);
	rpc_srv_registerCall(srv, NULL, CALL_BLOBVARS, 1);
	rpc_srv_registerCall(srv, NULL, CALL_BLOBSTATE, 0);

	srv->srv_blob.state = enable;	/* enable BLOB */
	return 0;
}

/*
 * rpc_srv_endBLOBServer() - Destroy BLOB server, close all opened sockets and free resources
 *
 * @srv = RPC Server instance
 * return: none
 */
void
rpc_srv_endBLOBServer(rpc_srv_t * __restrict srv)
{
	rpc_cli_t *c;
	register int i;
	rpc_blob_t *f;

	ioTRACE(RPC_TRACE_LEVEL);

	if (!srv) {
		rpc_SetErr(EINVAL, "Can`t destroy server because parameter is null!");
		return;
	} else
		srv->srv_blob.state = kill;

	rpc_srv_unregisterCall(srv, NULL, CALL_BLOBSHUTDOWN);
	rpc_srv_unregisterCall(srv, NULL, CALL_BLOBCLIENTS);
	rpc_srv_unregisterCall(srv, NULL, CALL_BLOBVARS);
	rpc_srv_unregisterCall(srv, NULL, CALL_BLOBSTATE);

	/* close all clients connections & server socket */
	for (i = 0, c = srv->srv_blob.clients; i < srv->srv_numcli && c; i++, c++)
		if (c->cli_sa.sa.sa_family)
			shutdown(c->cli_sock, SHUT_RDWR);
	close(srv->srv_blob.server.cli_sock);

	pthread_mutex_lock(&srv->srv_blob.mtx);
	if (srv->srv_blob.clients) {
		free(srv->srv_blob.clients);
		srv->srv_blob.clients = NULL;
	}

	/* detach blobs */
	while ((f = srv->srv_blob.blobs)) {
		srv->srv_blob.blobs = f->blob_next;
		rpc_srv_blobFree(srv, f);
		free(f);
	}
	pthread_mutex_unlock(&srv->srv_blob.mtx);

	AIT_FREE_VAL(&srv->srv_blob.dir);

	while (pthread_mutex_trylock(&srv->srv_blob.mtx) == EBUSY);
	pthread_mutex_destroy(&srv->srv_blob.mtx);
}

/*
 * rpc_srv_loopBLOB() - Execute Main BLOB server loop and wait for clients requests
 *
 * @srv = RPC Server instance
 * return: -1 error or 0 ok, infinite loop ...
 */
int
rpc_srv_loopBLOB(rpc_srv_t * __restrict srv)
{
	socklen_t salen = sizeof(io_sockaddr_t);
	register int i;
	rpc_cli_t *c;
	fd_set fds;
	int ret;
	struct timeval tv = { DEF_RPC_TIMEOUT, 0 };
	pthread_attr_t attr;

	ioTRACE(RPC_TRACE_LEVEL);

	if (!srv || srv->srv_blob.state == kill) {
		rpc_SetErr(EINVAL, "Invalid parameter can`t start BLOB server");
		return -1;
	}

	tv.tv_sec = srv->srv_session.sess_timeout;

	if (listen(srv->srv_blob.server.cli_sock, SOMAXCONN) == -1) {
		LOGERR;
		return -1;
	}

	pthread_attr_init(&attr);
	pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);

	/* main BLOB loop */
	while (srv->srv_blob.state != kill && srv->srv_kill != kill) {
		for (c = srv->srv_blob.clients, i = 0; i < srv->srv_numcli && c; i++, c++)
			if (!c->cli_sa.sa.sa_family)
				break;
		if (i >= srv->srv_numcli) {
#ifdef HAVE_PTHREAD_YIELD
			pthread_yield();
#else
			usleep(1000000);
#endif
			continue;
		}

		FD_ZERO(&fds);
		FD_SET(srv->srv_blob.server.cli_sock, &fds);
		ret = select(srv->srv_blob.server.cli_sock + 1, &fds, NULL, NULL, &tv);
		if (ret == -1) {
			LOGERR;
			ret = 1;
			break;
		}
		if (!ret)
			continue;

		c->cli_sock = accept(srv->srv_blob.server.cli_sock, &c->cli_sa.sa, &salen);
		if (c->cli_sock == -1) {
			LOGERR;
			continue;
		} else
			c->cli_parent = srv;

		/* spawn dispatch thread for BLOB client */
		if (pthread_create(&c->cli_tid, &attr, rpc_srv_dispatchVars, c)) {
			LOGERR;
			continue;
		}
	}

	srv->srv_blob.state = kill;

	pthread_attr_destroy(&attr);
	return 0;
}


/*
 * rpc_srv_initServer() - Init & create RPC Server
 *
 * @regProgID = ProgramID for authentication & recognition
 * @regProcID = ProcessID for authentication & recognition
 * @concurentClients = Concurent clients at same time to this server
 * @netBuf = Network buffer length, if =0 == BUFSIZ (also meaning max RPC packet)
 * @family = Family type, AF_INET, AF_INET6 or AF_LOCAL
 * @csHost = Host name or address for bind server, if NULL any address
 * @Port = Port for bind server, if Port == 0 default port is selected
 * return: NULL == error or !=NULL bind and created RPC server instance
 */
rpc_srv_t *
rpc_srv_initServer(u_int regProgID, u_int regProcID, int concurentClients, 
		int netBuf, u_short family, const char *csHost, u_short Port)
{
	rpc_srv_t *srv = NULL;
	int n = 1;
	struct hostent *host = NULL;
	io_sockaddr_t sa;

	ioTRACE(RPC_TRACE_LEVEL);

	if (!concurentClients || !regProgID || 
			(family != AF_INET && family != AF_INET6 && family != AF_LOCAL)) {
		rpc_SetErr(EINVAL, "Error:: Invalid parameters can`t init RPC server ...\n");
		return NULL;
	}
	if (!Port)
		Port = RPC_DEFPORT;
	if (!netBuf)
		netBuf = BUFSIZ;
	else
		netBuf = io_align(netBuf, 1);	/* align netBuf length */
	if (csHost && family != AF_LOCAL) {
		host = gethostbyname2(csHost, family);
		if (!host) {
			rpc_SetErr(h_errno, "Error:: %s\n", hstrerror(h_errno));
			return NULL;
		}
	}
	memset(&sa, 0, sizeof sa);
	sa.sa.sa_family = family;
	switch (family) {
		case AF_INET:
			sa.sin.sin_len = sizeof(struct sockaddr_in);
			sa.sin.sin_port = htons(Port);
			if (csHost)
				memcpy(&sa.sin.sin_addr, host->h_addr, host->h_length);
			break;
		case AF_INET6:
			sa.sin6.sin6_len = sizeof(struct sockaddr_in6);
			sa.sin6.sin6_port = htons(Port);
			if (csHost)
				memcpy(&sa.sin6.sin6_addr, host->h_addr, host->h_length);
			break;
		case AF_LOCAL:
			sa.sun.sun_len = sizeof(struct sockaddr_un);
			if (csHost)
				strlcpy(sa.sun.sun_path, csHost, sizeof sa.sun.sun_path);
			unlink(sa.sun.sun_path);
			break;
		default:
			rpc_SetErr(EINVAL, "Error:: Invalid parameters can`t start RPC server ...\n");
			return NULL;
	}

	srv = malloc(sizeof(rpc_srv_t));
	if (!srv) {
		LOGERR;
		return NULL;
	} else
		memset(srv, 0, sizeof(rpc_srv_t));

	srv->srv_netbuf = netBuf;
	srv->srv_numcli = concurentClients;
	srv->srv_session.sess_version = RPC_VERSION;
	srv->srv_session.sess_timeout = DEF_RPC_TIMEOUT;
	srv->srv_session.sess_program = regProgID;
	srv->srv_session.sess_process = regProcID;

	srv->srv_server.cli_tid = pthread_self();
	srv->srv_server.cli_parent = srv;
	memcpy(&srv->srv_server.cli_sa, &sa, sizeof sa);

	/* create server socket */
	srv->srv_server.cli_sock = socket(family, SOCK_STREAM, 0);
	if (srv->srv_server.cli_sock == -1) {
		LOGERR;
		free(srv);
		return NULL;
	}
	if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
		LOGERR;
		close(srv->srv_server.cli_sock);
		free(srv);
		return NULL;
	}
	n = srv->srv_netbuf;
	if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
		LOGERR;
		close(srv->srv_server.cli_sock);
		free(srv);
		return NULL;
	}
	if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
		LOGERR;
		close(srv->srv_server.cli_sock);
		free(srv);
		return NULL;
	}
	if (bind(srv->srv_server.cli_sock, &srv->srv_server.cli_sa.sa, 
				srv->srv_server.cli_sa.sa.sa_len) == -1) {
		LOGERR;
		close(srv->srv_server.cli_sock);
		free(srv);
		return NULL;
	}

	/* allocate pool for concurent clients */
	srv->srv_clients = calloc(srv->srv_numcli, sizeof(rpc_cli_t));
	if (!srv->srv_clients) {
		LOGERR;
		close(srv->srv_server.cli_sock);
		free(srv);
		return NULL;
	} else
		memset(srv->srv_clients, 0, srv->srv_numcli * sizeof(rpc_cli_t));

	pthread_mutex_init(&srv->srv_mtx, NULL);

	rpc_srv_registerCall(srv, NULL, CALL_SRVSHUTDOWN, 0);
	rpc_srv_registerCall(srv, NULL, CALL_SRVCLIENTS, 1);
	rpc_srv_registerCall(srv, NULL, CALL_SRVSESSIONS, 4);
	rpc_srv_registerCall(srv, NULL, CALL_SRVCALLS, 1);
	return srv;
}

/*
 * rpc_srv_endServer() - Destroy RPC server, close all opened sockets and free resources
 *
 * @psrv = RPC Server instance
 * return: none
 */
void
rpc_srv_endServer(rpc_srv_t ** __restrict psrv)
{
	rpc_cli_t *c;
	register int i;
	rpc_func_t *f;

	ioTRACE(RPC_TRACE_LEVEL);

	if (!psrv || !*psrv) {
		rpc_SetErr(EINVAL, "Error:: Can`t destroy server because parameter is null!\n");
		return;
	}

	rpc_srv_endBLOBServer(*psrv);

	/* close all clients connections & server socket */
	for (i = 0, c = (*psrv)->srv_clients; i < (*psrv)->srv_numcli && c; i++, c++)
		if (c->cli_sa.sa.sa_family) {
			shutdown(c->cli_sock, SHUT_RDWR);
			close(c->cli_sock);
		}
	close((*psrv)->srv_server.cli_sock);

	if ((*psrv)->srv_clients) {
		free((*psrv)->srv_clients);
		(*psrv)->srv_clients = NULL;
		(*psrv)->srv_numcli = 0;
	}

	/* detach exported calls */
	pthread_mutex_lock(&(*psrv)->srv_mtx);
	while ((f = (*psrv)->srv_funcs)) {
		(*psrv)->srv_funcs = f->func_next;
		io_freeVars(&f->func_vars);
		AIT_FREE_VAL(&f->func_name);
		AIT_FREE_VAL(&f->func_file);
		free(f);
	}
	pthread_mutex_unlock(&(*psrv)->srv_mtx);

	while (pthread_mutex_trylock(&(*psrv)->srv_mtx) == EBUSY);
	pthread_mutex_destroy(&(*psrv)->srv_mtx);

	free(*psrv);
	*psrv = NULL;
}

/*
 * rpc_srv_loopServer() - Execute Main server loop and wait for clients requests
 *
 * @srv = RPC Server instance
 * return: -1 error or 0 ok, infinite loop ...
 */
int
rpc_srv_loopServer(rpc_srv_t * __restrict srv)
{
	socklen_t salen = sizeof(io_sockaddr_t);
	register int i;
	rpc_cli_t *c;
	fd_set fds;
	int ret;
	struct timeval tv = { DEF_RPC_TIMEOUT, 0 };
	pthread_attr_t attr;

	ioTRACE(RPC_TRACE_LEVEL);

	if (!srv) {
		rpc_SetErr(EINVAL, "Error:: Invalid parameter can`t start RPC server ...\n");
		return -1;
	}

	tv.tv_sec = srv->srv_session.sess_timeout;

	/* activate BLOB server worker if srv->srv_blob.state == enable */
	rpc_srv_execBLOBServer(srv);

	if (listen(srv->srv_server.cli_sock, SOMAXCONN) == -1) {
		LOGERR;
		return -1;
	}

	pthread_attr_init(&attr);
	pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);

	/* main rpc loop */
	while (srv->srv_kill != kill) {
		for (c = srv->srv_clients, i = 0; i < srv->srv_numcli && c; i++, c++)
			if (!c->cli_sa.sa.sa_family)
				break;
		if (i >= srv->srv_numcli) {
#ifdef HAVE_PTHREAD_YIELD
			pthread_yield();
#else
			usleep(1000000);
#endif
			continue;
		}

		FD_ZERO(&fds);
		FD_SET(srv->srv_server.cli_sock, &fds);
		ret = select(srv->srv_server.cli_sock + 1, &fds, NULL, NULL, &tv);
		if (ret == -1) {
			LOGERR;
			ret = 1;
			break;
		}
		if (!ret)
			continue;

		c->cli_sock = accept(srv->srv_server.cli_sock, &c->cli_sa.sa, &salen);
		if (c->cli_sock == -1) {
			LOGERR;
			continue;
		} else
			c->cli_parent = srv;

		/* spawn rpc client dispatcher */
		if (pthread_create(&c->cli_tid, &attr, rpc_srv_dispatchCall, c)) {
			LOGERR;
			continue;
		}
	}

	pthread_attr_destroy(&attr);
	return 0;
}

// ---------------------------------------------------------

/*
 * rpc_srv_execCall() Execute registered call from RPC server
 *
 * @call = Register RPC call
 * @rpc = IN RPC call structure
 * @args = IN RPC calling arguments from RPC client
 * return: -1 error, !=-1 ok
 */
int
rpc_srv_execCall(rpc_func_t * __restrict call, struct tagRPCCall * __restrict rpc, 
		array_t * __restrict args)
{
	void *dl;
	rpc_callback_t func;
	int ret;

	ioTRACE(RPC_TRACE_LEVEL);

	if (!call || !rpc || !call->func_parent) {
		rpc_SetErr(EINVAL, "Invalid parameter can`t exec function");
		return -1;
	}

	dl = dlopen(AIT_VOID(&call->func_file), RTLD_NOW);
	if (!dl) {
		rpc_SetErr(ENOENT, "Can`t attach module %s!", dlerror());
		return -1;
	}

	func = dlsym(dl, (const char*) AIT_GET_STR(&call->func_name));
	if (func)
		ret = func(call, ntohs(rpc->call_argc), args);
	else {
		rpc_SetErr(ENOEXEC, "Can`t find function %s!", dlerror());
		ret = -1;
	}

	dlclose(dl);
	return ret;
}