--- libaitrpc/src/srv.c 2014/01/28 14:05:43 1.23 +++ libaitrpc/src/srv.c 2014/11/17 23:51:26 1.23.6.2 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ -* $Id: srv.c,v 1.23 2014/01/28 14:05:43 misho Exp $ +* $Id: srv.c,v 1.23.6.2 2014/11/17 23:51:26 misho Exp $ * ************************************************************************** The ELWIX and AITNET software is distributed under the following @@ -59,11 +59,16 @@ static void *txUDPPacket(sched_task_t *); /* SOCK_RAW */ -static sched_task_func_t cbProto[SOCK_RAW + 1][4] = { +/* SOCK_BPF */ +static void *rxBPFPacket(sched_task_t *); +static void *txBPFPacket(sched_task_t *); + +static sched_task_func_t cbProto[SOCK_BPF + 1][4] = { { acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */ { acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */ { rxUDPPacket, freeClient, rxUDPPacket, txUDPPacket }, /* SOCK_DGRAM */ - { NULL, NULL, NULL, NULL } /* SOCK_RAW */ + { NULL, NULL, NULL, NULL }, /* SOCK_RAW */ + { rxBPFPacket, freeClient, rxBPFPacket, txBPFPacket } /* SOCK_BPF */ }; /* Global Signal Argument when kqueue support disabled */ @@ -1289,4 +1294,189 @@ rpc_srv_execCall(rpc_cli_t * __restrict cli, struct ta func = AIT_GET_LIKE(&funcname, rpc_callback_t); return func(cli, rpc, args); +} + + +/* + * rpc_srv_initServer2() - Init & create layer2 RPC Server + * + * @InstID = Instance for authentication & recognition + * @concurentClients = Concurent clients at same time to this server + * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet) + * @csIface = Interface name for bind server, if NULL first interface on host + * return: NULL == error or !=NULL bind and created RPC server instance + */ +rpc_srv_t * +rpc_srv_initServer2(u_char InstID, int concurentClients, int netBuf, const char *csIface) +{ + int n = 1; + rpc_srv_t *srv = NULL; + sockaddr_t sa = E_SOCKADDR_INIT; + char szIface[64], szStr[STRSIZ]; + register int i; + struct ifreq ifr; + + if (!concurentClients) { + rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server"); + return NULL; + } + if (!csIface) { + if (e_get1stiface(szIface, sizeof szIface)) + return NULL; + } else + strlcpy(szIface, csIface, sizeof szIface); + if (e_getifacebyname(szIface, &sa)) + return NULL; + +#ifdef HAVE_SRANDOMDEV + srandomdev(); +#else + time_t tim; + + srandom((time(&tim) ^ getpid())); +#endif + + srv = e_malloc(sizeof(rpc_srv_t)); + if (!srv) { + LOGERR; + return NULL; + } else + memset(srv, 0, sizeof(rpc_srv_t)); + + srv->srv_proto = SOCK_BPF; + srv->srv_netbuf = netBuf; + srv->srv_session.sess_version = RPC_VERSION; + srv->srv_session.sess_instance = InstID; + + srv->srv_server.cli_parent = srv; + memcpy(&srv->srv_server.cli_sa, &sa, sizeof srv->srv_server.cli_sa); + + /* init functions */ + pthread_mutex_init(&srv->srv_funcs.mtx, NULL); + SLIST_INIT(&srv->srv_funcs); + AVL_INIT(&srv->srv_funcs); + + /* init scheduler */ + srv->srv_root = schedBegin(); + if (!srv->srv_root) { + rpc_SetErr(sched_GetErrno(), "%s", sched_GetError()); + pthread_mutex_destroy(&srv->srv_funcs.mtx); + e_free(srv); + return NULL; + } + + /* init pool for clients */ + srv->srv_clients = array_Init(concurentClients); + if (!srv->srv_clients) { + rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError()); + schedEnd(&srv->srv_root); + pthread_mutex_destroy(&srv->srv_funcs.mtx); + e_free(srv); + return NULL; + } + + /* create server handler */ + for (i = 0; i < 10; i++) { + memset(szStr, 0, sizeof szStr); + snprintf(szStr, sizeof szStr, "/dev/bpf%d", i); + srv->srv_server.cli_sock = open(szStr, O_RDWR); + if (srv->srv_server.cli_sock > STDERR_FILENO) + break; + } + if (srv->srv_server.cli_sock < 3) { + LOGERR; + array_Destroy(&srv->srv_clients); + schedEnd(&srv->srv_root); + pthread_mutex_destroy(&srv->srv_funcs.mtx); + e_free(srv); + return NULL; + } + + if (ioctl(srv->srv_server.cli_sock, BIOCIMMEDIATE, &n) == -1) { + LOGERR; + goto err; + } + n = (netBuf < RPC_MIN_BUFSIZ) ? getpagesize() : E_ALIGN(netBuf, 2); + if (ioctl(srv->srv_server.cli_sock, BIOCSBLEN, &n) == -1) { + LOGERR; + goto err; + } else + srv->srv_netbuf = n; + + memset(&ifr, 0, sizeof ifr); + strlcpy(ifr.ifr_name, szIface, sizeof ifr.ifr_name); + if (ioctl(srv->srv_server.cli_sock, BIOCSETIF, &ifr) == -1) { + LOGERR; + goto err; + } else + fcntl(srv->srv_server.cli_sock, F_SETFL, + fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK); + + rpc_register_srvPing(srv); + + return srv; +err: /* error condition */ + close(srv->srv_server.cli_sock); + array_Destroy(&srv->srv_clients); + schedEnd(&srv->srv_root); + pthread_mutex_destroy(&srv->srv_funcs.mtx); + e_free(srv); + return NULL; +} + +/* + * rpc_srv_loopServer2() - Execute Main layer2 server loop and wait for clients requests + * + * @srv = RPC Server instance + * return: -1 error or 0 ok, infinite loop ... + */ +int +rpc_srv_loopServer2(rpc_srv_t * __restrict srv) +{ + rpc_cli_t *c; + register int i; + rpc_func_t *f; + struct timespec ts = { RPC_SCHED_POLLING, 0 }; + + if (!srv) { + rpc_SetErr(EINVAL, "Invalid parameter can`t start RPC server"); + return -1; + } + + if (!schedRead(srv->srv_root, cbProto[srv->srv_proto][CB_ACCEPTCLIENT], srv, + srv->srv_server.cli_sock, NULL, 0)) { + rpc_SetErr(sched_GetErrno(), "%s", sched_GetError()); + return -1; + } + + schedPolling(srv->srv_root, &ts, NULL); + /* main rpc loop */ + schedRun(srv->srv_root, &srv->srv_kill); + + /* close all clients connections & server socket */ + for (i = 0; i < array_Size(srv->srv_clients); i++) { + c = array(srv->srv_clients, i, rpc_cli_t*); + if (c) { + schedCancelby(srv->srv_root, taskMAX, CRITERIA_ARG, c, NULL); + ait_freeVars(&RPC_RETVARS(c)); + AIT_FREE_VAL(&c->cli_buf); + } + array_Del(srv->srv_clients, i, 42); + } + array_Destroy(&srv->srv_clients); + + close(srv->srv_server.cli_sock); + + /* detach exported calls */ + RPC_FUNCS_LOCK(&srv->srv_funcs); + while ((f = SLIST_FIRST(&srv->srv_funcs))) { + SLIST_REMOVE_HEAD(&srv->srv_funcs, func_next); + + AIT_FREE_VAL(&f->func_name); + e_free(f); + } + srv->srv_funcs.avlh_root = NULL; + RPC_FUNCS_UNLOCK(&srv->srv_funcs); + + return 0; }