--- libaitrpc/src/srv.c 2013/11/14 21:44:14 1.21 +++ libaitrpc/src/srv.c 2015/07/02 22:28:15 1.27 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ -* $Id: srv.c,v 1.21 2013/11/14 21:44:14 misho Exp $ +* $Id: srv.c,v 1.27 2015/07/02 22:28:15 misho Exp $ * ************************************************************************** The ELWIX and AITNET software is distributed under the following @@ -12,7 +12,7 @@ terms: All of the documentation and software included in the ELWIX and AITNET Releases is copyrighted by ELWIX - Sofia/Bulgaria -Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013 +Copyright 2004 - 2015 by Michael Pounov . All rights reserved. Redistribution and use in source and binary forms, with or without @@ -58,15 +58,30 @@ static void *rxUDPPacket(sched_task_t *); static void *txUDPPacket(sched_task_t *); /* SOCK_RAW */ +static void *rxRAWPacket(sched_task_t *); +static void *txRAWPacket(sched_task_t *); -static sched_task_func_t cbProto[SOCK_RAW + 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 */ +/* SOCK_BPF */ +static void *rxBPFPacket(sched_task_t *); +static void *txBPFPacket(sched_task_t *); + +/* SOCK_EXT */ +static void *rxEXTPacket(sched_task_t *); +static void *txEXTPacket(sched_task_t *); + +static sched_task_func_t cbProto[SOCK_MAX_SUPPORT][4] = { + { acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */ + { acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */ + { rxUDPPacket, freeClient, NULL /*rxUDPPacket*/, txUDPPacket }, /* SOCK_DGRAM */ + { rxRAWPacket, freeClient, NULL /*rxRAWPacket*/, txRAWPacket }, /* SOCK_RAW */ + { rxBPFPacket, freeClient, NULL /*rxBPFPacket*/, txBPFPacket }, /* SOCK_BPF */ + { rxEXTPacket, freeClient, NULL /*rxEXTPacket*/, txEXTPacket } /* SOCK_EXT */ }; +/* Global Signal Argument when kqueue support disabled */ +static volatile uintptr_t _glSigArg = 0; + void rpc_freeCli(rpc_cli_t * __restrict c) { @@ -107,7 +122,10 @@ _allocClient(rpc_srv_t * __restrict srv, sockaddr_t * rpc_cli_t *c = NULL; int n; - n = _check4freeslot(srv, sa); + if (srv->srv_proto != SOCK_EXT) + n = _check4freeslot(srv, sa); + else + n = 0; if (n == -1) return NULL; else @@ -139,7 +157,7 @@ freeClient(sched_task_t *task) { rpc_freeCli(TASK_ARG(task)); - return NULL; + taskExit(task, NULL); } static void * @@ -152,7 +170,7 @@ closeClient(sched_task_t *task) /* close client socket */ shutdown(sock, SHUT_RDWR); close(sock); - return NULL; + taskExit(task, NULL); } static void * @@ -163,8 +181,7 @@ txPacket(sched_task_t *task) rpc_func_t *f = NULL; u_char *buf = AIT_GET_BUF(&c->cli_buf); struct tagRPCCall *rpc = (struct tagRPCCall*) buf; - int ret, estlen, wlen = sizeof(struct tagRPCCall); - struct pollfd pfd; + int ret, wlen = sizeof(struct tagRPCCall); #ifdef TCP_SESSION_TIMEOUT struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; @@ -179,34 +196,35 @@ txPacket(sched_task_t *task) 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 { - /* calc estimated length */ - estlen = ait_resideVars(RPC_RETVARS(c)) + wlen; - if (estlen > AIT_LEN(&c->cli_buf)) - AIT_RE_BUF(&c->cli_buf, estlen); - buf = AIT_GET_BUF(&c->cli_buf); - rpc = (struct tagRPCCall*) buf; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) { + rpc_SetErr(EMSGSIZE, "Message too long"); - rpc->call_argc = htons(array_Size(RPC_RETVARS(c))); + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else { + rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); /* Go Encapsulate variables */ ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, RPC_RETVARS(c)); - /* Free return values */ - ait_freeVars(&c->cli_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); + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); } else wlen += ret; } } + /* Free return values */ + ait_freeVars(&c->cli_vars); + rpc->call_len = htonl(wlen); + rpc->call_io = RPC_ACK; #if 0 /* calculate CRC */ @@ -215,30 +233,14 @@ txPacket(sched_task_t *task) #endif /* send reply */ - pfd.fd = TASK_FD(task); - pfd.events = POLLOUT; - for (; wlen > 0; wlen -= ret, buf += ret) { - if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || - pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { - if (ret) - LOGERR; - else - rpc_SetErr(ETIMEDOUT, "Timeout reached! Server not respond"); - /* close connection */ - schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], - TASK_ARG(task), 0, NULL, 0); - return NULL; - } - ret = send(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf), MSG_NOSIGNAL); - if (ret == -1) { - /* close connection */ - schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], - TASK_ARG(task), 0, NULL, 0); - return NULL; - } + ret = send(TASK_FD(task), buf, wlen, MSG_NOSIGNAL); + if (ret == -1) { + /* close connection */ + schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], + TASK_ARG(task), 0, NULL, 0); } - return NULL; + taskExit(task, NULL); } static void * @@ -250,7 +252,7 @@ execCall(sched_task_t *task) array_t *arr = NULL; u_char *buf = AIT_GET_BUF(&c->cli_buf); struct tagRPCCall *rpc = (struct tagRPCCall*) buf; - int argc = ntohs(rpc->call_argc); + int argc = rpc->call_argc; /* Go decapsulate variables ... */ if (argc) { @@ -260,9 +262,9 @@ execCall(sched_task_t *task) rpc_SetErr(ERPCMISMATCH, "#%d - %s", elwix_GetErrno(), elwix_GetError()); rpc->call_argc ^= rpc->call_argc; - rpc->call_rep.ret = RPC_ERROR(-1); - rpc->call_rep.eno = RPC_ERROR(rpc_Errno); - return NULL; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + taskExit(task, NULL); } } else arr = NULL; @@ -271,33 +273,33 @@ execCall(sched_task_t *task) 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); + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); } else { /* if client doesn't want reply */ - argc = RPC_CHK_NOREPLY(rpc); - rpc->call_rep.ret = RPC_ERROR(rpc_srv_execCall(c, rpc, f->func_name, arr)); + RPC_SET_RETURN(rpc, rpc_srv_execCall(c, rpc, f->func_name, arr)); if (rpc->call_rep.ret == htonl(-1)) { if (!rpc->call_rep.eno) { LOGERR; - rpc->call_rep.eno = RPC_ERROR(rpc_Errno); + RPC_SET_ERRNO(rpc, rpc_Errno); } rpc->call_argc ^= rpc->call_argc; + ait_freeVars(&c->cli_vars); } else { rpc->call_rep.eno ^= rpc->call_rep.eno; - if (argc) { + rpc->call_argc ^= rpc->call_argc; + if (TASK_VAL(task)) { /* without reply */ ait_freeVars(&c->cli_vars); - rpc->call_argc ^= rpc->call_argc; } else { /* reply */ - rpc->call_argc = htons(array_Size(RPC_RETVARS(c))); + rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); } } } array_Destroy(&arr); - return NULL; + taskExit(task, NULL); } static void * @@ -305,13 +307,13 @@ rxPacket(sched_task_t *task) { rpc_cli_t *c = TASK_ARG(task); rpc_srv_t *s = c->cli_parent; - int len, rlen, noreply, estlen; + int len, noreply = 0, rlen = AIT_LEN(&c->cli_buf); #if 0 u_short crc; #endif u_char *buf = AIT_GET_BUF(&c->cli_buf); + u_char b[sizeof(struct tagRPCCall)]; struct tagRPCCall *rpc = (struct tagRPCCall*) buf; - struct pollfd pfd; #ifdef TCP_SESSION_TIMEOUT struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; @@ -320,70 +322,71 @@ rxPacket(sched_task_t *task) TASK_ARG(task), ts, TASK_ARG(task), 0); #endif - memset(buf, 0, sizeof(struct tagRPCCall)); - rlen = recv(TASK_FD(task), rpc, sizeof(struct tagRPCCall), MSG_PEEK); - if (rlen < sizeof(struct tagRPCCall)) { + /* prepare rx */ + len = recv(TASK_FD(task), b, sizeof b, MSG_PEEK); + if (len == sizeof b) + rlen = ntohl(((struct tagRPCCall*) b)->call_len); + + rlen = recv(TASK_FD(task), buf, rlen, 0); + if (rlen == -1) { /* close connection */ schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], TASK_ARG(task), 0, NULL, 0); - return NULL; - } else { - estlen = ntohl(rpc->call_len); - if (estlen > AIT_LEN(&c->cli_buf)) - AIT_RE_BUF(&c->cli_buf, estlen); - rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf); - buf = AIT_GET_BUF(&c->cli_buf); - len = estlen; + taskExit(task, NULL); } + if (rlen < sizeof(struct tagRPCCall)) { + rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); - /* get next part of packet */ - memset(buf, 0, len); - pfd.fd = TASK_FD(task); - pfd.events = POLLIN | POLLPRI; - for (; len > 0; len -= rlen, buf += rlen) { - if ((rlen = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || - pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { - if (rlen) - LOGERR; - else - rpc_SetErr(ETIMEDOUT, "Timeout reached! Server not respond"); - schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], - TASK_ARG(task), 0, NULL, 0); - return NULL; - } - rlen = recv(TASK_FD(task), buf, len, 0); - if (rlen == -1) { - /* close connection */ - schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], - TASK_ARG(task), 0, NULL, 0); - return NULL; - } + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + goto err; + } else + len = ntohl(rpc->call_len); + if (rlen < len || len > AIT_LEN(&c->cli_buf)) { + rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + goto err; } + /* skip loop packet */ + if (rpc->call_io & RPC_ACK) { + schedReadSelf(task); + taskExit(task, NULL); + } + #if 0 /* check integrity of packet */ crc = ntohs(rpc->call_crc); rpc->call_crc ^= rpc->call_crc; if (crc != crcFletcher16((u_short*) rpc, len / 2)) { rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet"); - return NULL; + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + goto err; } #endif - noreply = RPC_CHK_NOREPLY(rpc); - /* 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); - } else { - /* execute RPC call */ - schedEvent(TASK_ROOT(task), execCall, TASK_ARG(task), (int) noreply, rpc, len); + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + goto err; } + noreply = RPC_CHK_NOREPLY(rpc); + + /* execute RPC call */ + schedEvent(TASK_ROOT(task), execCall, TASK_ARG(task), (int) noreply, rpc, len); +err: /* send RPC reply */ if (!noreply) schedWrite(TASK_ROOT(task), cbProto[s->srv_proto][CB_TXPACKET], @@ -391,7 +394,7 @@ rxPacket(sched_task_t *task) /* lets get next packet */ schedReadSelf(task); - return NULL; + taskExit(task, NULL); } static void * @@ -435,7 +438,7 @@ acceptClients(sched_task_t *task) c->cli_sock, NULL, 0); end: schedReadSelf(task); - return NULL; + taskExit(task, NULL); } @@ -458,27 +461,37 @@ txUDPPacket(sched_task_t *task) f = rpc_srv_getCall(s, ntohs(rpc->call_tag)); if (!f) { 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); + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) { + rpc_SetErr(EMSGSIZE, "Message too long"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); } else { - rpc->call_argc = htons(array_Size(RPC_RETVARS(c))); + rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); /* Go Encapsulate variables */ ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, RPC_RETVARS(c)); - /* Free return values */ - ait_freeVars(&c->cli_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); + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); } else wlen += ret; } } + /* Free return values */ + ait_freeVars(&c->cli_vars); + rpc->call_len = htonl(wlen); + rpc->call_io = RPC_ACK; /* calculate CRC */ rpc->call_crc ^= rpc->call_crc; @@ -487,13 +500,13 @@ txUDPPacket(sched_task_t *task) /* send reply */ ret = sendto(TASK_FD(task), buf, wlen, MSG_NOSIGNAL, &c->cli_sa.sa, c->cli_sa.sa.sa_len); - if (ret == -1 || ret != wlen) { + if (ret == -1) { /* close connection */ schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], - TASK_ARG(task), 0, NULL, 0); + TASK_ARG(task), 0, NULL, 0); } - return NULL; + taskExit(task, NULL); } static void * @@ -501,90 +514,523 @@ rxUDPPacket(sched_task_t *task) { rpc_srv_t *srv = TASK_ARG(task); rpc_cli_t *c = NULL; - int len, rlen, noreply; - u_short crc, off = 0; - u_char buf[USHRT_MAX + 1]; - struct tagRPCCall *rpc = (struct tagRPCCall*) buf; + int len, noreply = 0, rlen; + u_short crc; + struct tagRPCCall *rpc; sockaddr_t sa; socklen_t salen; struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; + ait_val_t b = AIT_VAL_INIT; /* receive connect packet */ + AIT_SET_BUF(&b, NULL, srv->srv_netbuf); salen = sa.ss.ss_len = sizeof(sockaddr_t); - rlen = recvfrom(TASK_FD(task), buf, sizeof buf, 0, &sa.sa, &salen); - if (rlen < 1) + rlen = recvfrom(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b), 0, &sa.sa, &salen); + rpc = (struct tagRPCCall*) AIT_GET_BUF(&b); + if (rlen < sizeof(struct tagRPCCall)) goto end; + else + len = ntohl(rpc->call_len); + if (rlen < len || len > srv->srv_netbuf) + goto end; + /* skip loop packet */ + if (rpc->call_io & RPC_ACK) + goto end; + + /* check integrity of packet */ + crc = ntohs(rpc->call_crc); + rpc->call_crc ^= rpc->call_crc; + if (crc != crcFletcher16((u_short*) rpc, len / 2)) + goto end; + + /* check RPC packet session info */ + if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) + goto end; + c = _allocClient(srv, &sa); - if (!c) + if (!c) { + EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n"); + usleep(2000); /* blocked client delay */ goto end; - else { + } else { + memcpy(AIT_GET_BUF(&c->cli_buf), AIT_GET_BUF(&b), len); + rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf); + c->cli_sock = TASK_FD(task); memcpy(&c->cli_sa, &sa, sizeof c->cli_sa); - memcpy(AIT_GET_BUF(&c->cli_buf), buf, AIT_LEN(&c->cli_buf)); + /* armed timer for close stateless connection */ schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL); schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], c, ts, c, 0); } - do { - /* check RPC packet */ - if (rlen < sizeof(struct tagRPCCall)) { - rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); - break; - } else - rpc = (struct tagRPCCall*) (AIT_GET_BUF(&c->cli_buf) + off); + noreply = RPC_CHK_NOREPLY(rpc); - len = ntohl(rpc->call_len); - rlen -= len; + /* execute RPC call */ + schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len); - /* check RPC packet lengths */ - if (rlen < 0 || len < sizeof(struct tagRPCCall)) { - rpc_SetErr(ERPCMISMATCH, "Broken RPC packet length"); - /* skip entire packet */ - break; + /* send RPC reply */ + if (!noreply) + schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], + c, TASK_FD(task), rpc, len); +end: + AIT_FREE_VAL(&b); + schedReadSelf(task); + taskExit(task, NULL); +} + + +static void * +txRAWPacket(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 = AIT_GET_BUF(&c->cli_buf); + struct tagRPCCall *rpc = (struct tagRPCCall*) buf; + int ret, wlen = sizeof(struct tagRPCCall); + struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; + + schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL); + schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], + TASK_ARG(task), ts, TASK_ARG(task), 0); + + if (rpc->call_argc) { + f = rpc_srv_getCall(s, ntohs(rpc->call_tag)); + if (!f) { + rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) { + rpc_SetErr(EMSGSIZE, "Message too long"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else { + rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); + /* Go Encapsulate variables */ + ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, + RPC_RETVARS(c)); + if (ret == -1) { + rpc_SetErr(EBADRPC, "Prepare RPC packet failed"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else + wlen += ret; } + } - /* check integrity of packet */ - crc = ntohs(rpc->call_crc); - rpc->call_crc ^= rpc->call_crc; - if (crc != crcFletcher16((u_short*) rpc, len / 2)) { - rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet"); + /* Free return values */ + ait_freeVars(&c->cli_vars); - off += len; - /* try next packet remaining into buffer */ - continue; + rpc->call_len = htonl(wlen); + rpc->call_io = RPC_ACK; + + /* calculate CRC */ + rpc->call_crc ^= rpc->call_crc; + rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2)); + + /* send reply */ + ret = sendto(TASK_FD(task), buf, wlen, MSG_NOSIGNAL, + &c->cli_sa.sa, c->cli_sa.sa.sa_len); + if (ret == -1) { + /* close connection */ + schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], + TASK_ARG(task), 0, NULL, 0); + } + + taskExit(task, NULL); +} + +static void * +rxRAWPacket(sched_task_t *task) +{ + rpc_srv_t *srv = TASK_ARG(task); + rpc_cli_t *c = NULL; + int len, noreply = 0, rlen; + u_short crc; + struct tagRPCCall *rpc; + sockaddr_t sa; + socklen_t salen; + struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; + ait_val_t b = AIT_VAL_INIT; + + /* receive connect packet */ + AIT_SET_BUF(&b, NULL, srv->srv_netbuf); + salen = sa.ss.ss_len = sizeof(sockaddr_t); + rlen = recvfrom(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b), 0, &sa.sa, &salen); + if (sa.sa.sa_family == AF_INET) { + struct ip *h; + h = (struct ip*) AIT_GET_BUF(&b); + if (rlen < ntohs(h->ip_len) || h->ip_p != IPPROTO_ERPC) + goto end; + else { + rlen -= sizeof(struct ip); + rpc = (struct tagRPCCall*) (h + 1); } + } else { + struct ip6_hdr *h; + h = (struct ip6_hdr*) AIT_GET_BUF(&b); + if (rlen < (ntohs(h->ip6_plen) + sizeof(struct ip6_hdr)) || + h->ip6_nxt != IPPROTO_ERPC) + goto end; + else { + rlen -= sizeof(struct ip6_hdr); + rpc = (struct tagRPCCall*) (h + 1); + } + } + if (rlen < sizeof(struct tagRPCCall)) + goto end; + else + len = ntohl(rpc->call_len); + if (rlen < len || len > srv->srv_netbuf) + goto end; - noreply = RPC_CHK_NOREPLY(rpc); + /* skip loop packet */ + if (rpc->call_io & RPC_ACK) + goto end; - /* check RPC packet session info */ - if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) { - rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session"); + /* check integrity of packet */ + crc = ntohs(rpc->call_crc); + rpc->call_crc ^= rpc->call_crc; + if (crc != crcFletcher16((u_short*) rpc, len / 2)) + goto end; + /* check RPC packet session info */ + if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) + goto end; + + c = _allocClient(srv, &sa); + if (!c) { + EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n"); + usleep(2000); /* blocked client delay */ + goto end; + } else { + memcpy(AIT_GET_BUF(&c->cli_buf), rpc, len); + rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf); + + c->cli_sock = TASK_FD(task); + memcpy(&c->cli_sa, &sa, sizeof c->cli_sa); + + /* armed timer for close stateless connection */ + schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL); + schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], + c, ts, c, 0); + } + + noreply = RPC_CHK_NOREPLY(rpc); + + /* execute RPC call */ + schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len); + + /* send RPC reply */ + if (!noreply) + schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], + c, TASK_FD(task), rpc, len); +end: + AIT_FREE_VAL(&b); + schedReadSelf(task); + taskExit(task, NULL); +} + + +static void * +txBPFPacket(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 = AIT_GET_BUF(&c->cli_buf); + struct tagRPCCall *rpc = (struct tagRPCCall*) buf; + int ret, wlen = sizeof(struct tagRPCCall); + struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; + struct ether_header *eh; + ait_val_t b = AIT_VAL_INIT; + + schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL); + schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], + TASK_ARG(task), ts, TASK_ARG(task), 0); + + if (rpc->call_argc) { + f = rpc_srv_getCall(s, ntohs(rpc->call_tag)); + if (!f) { + 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(errno); + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) { + rpc_SetErr(EMSGSIZE, "Message too long"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); } else { - /* execute RPC call */ - schedEvent(TASK_ROOT(task), execCall, c, - (int) noreply, rpc, len); + rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); + /* Go Encapsulate variables */ + ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, + RPC_RETVARS(c)); + if (ret == -1) { + rpc_SetErr(EBADRPC, "Prepare RPC packet failed"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else + wlen += ret; } + } - /* send RPC reply */ - if (!noreply) - schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], - c, TASK_FD(task), rpc, len); + /* Free return values */ + ait_freeVars(&RPC_RETVARS(c)); - off += len; - } while (rlen > 0); + rpc->call_len = htonl(wlen); + rpc->call_io = RPC_ACK; + /* calculate CRC */ + rpc->call_crc ^= rpc->call_crc; + rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2)); + + /* send reply */ + AIT_SET_BUF(&b, NULL, wlen + ETHER_HDR_LEN); + eh = (struct ether_header*) AIT_GET_BUF(&b); + memcpy(eh->ether_dhost, LLADDR(&c->cli_sa.sdl), ETHER_ADDR_LEN); + eh->ether_type = htons(RPC_DEFPORT); + memcpy(eh + 1, buf, wlen); + + ret = write(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b)); + AIT_FREE_VAL(&b); + if (ret == -1) { + /* close connection */ + schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], + TASK_ARG(task), 0, NULL, 0); + } + + taskExit(task, NULL); +} + +static void * +rxBPFPacket(sched_task_t *task) +{ + rpc_srv_t *srv = TASK_ARG(task); + rpc_cli_t *c = NULL; + int len, rlen, noreply; + u_short crc; + struct tagRPCCall *rpc; + sockaddr_t sa; + struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; + struct bpf_hdr *h; + struct ether_header *eh; + ait_val_t b = AIT_VAL_INIT; + + /* receive connect packet */ + AIT_SET_BUF(&b, NULL, srv->srv_netbuf); + rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b)); + h = (struct bpf_hdr*) AIT_GET_BUF(&b); + rlen -= h->bh_hdrlen; + if (rlen < h->bh_datalen || h->bh_caplen != h->bh_datalen || + rlen < ETHER_HDR_LEN + sizeof(struct tagRPCCall)) + goto end; + else { + rlen = h->bh_caplen; + eh = (struct ether_header*) (AIT_GET_BUF(&b) + h->bh_hdrlen); + rlen -= ETHER_HDR_LEN; + rpc = (struct tagRPCCall*) (eh + 1); + + if (eh->ether_type != ntohs(RPC_DEFPORT)) + goto end; + else + e_getlinkbymac((const ether_addr_t*) eh->ether_shost, &sa); + } + if (rlen < sizeof(struct tagRPCCall)) + goto end; + else + len = ntohl(rpc->call_len); + if (rlen < len || len > srv->srv_netbuf) + goto end; + +#ifdef CHECK_ETHACK + /* skip loop packet */ + if (rpc->call_io & RPC_ACK) + goto end; +#endif + + /* check integrity of packet */ + crc = ntohs(rpc->call_crc); + rpc->call_crc ^= rpc->call_crc; + if (crc != crcFletcher16((u_short*) rpc, len / 2)) + goto end; + + /* check RPC packet session info */ + if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) + goto end; + + c = _allocClient(srv, &sa); + if (!c) { + EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n"); + usleep(2000); /* blocked client delay */ + goto end; + } else { + memcpy(AIT_GET_BUF(&c->cli_buf), rpc, len); + rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf); + + c->cli_sock = TASK_FD(task); + memcpy(&c->cli_sa, &sa, sizeof c->cli_sa); + + /* armed timer for close stateless connection */ + schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL); + schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], + c, ts, c, 0); + } + + noreply = RPC_CHK_NOREPLY(rpc); + + /* execute RPC call */ + schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len); + + /* send RPC reply */ + if (!noreply) + schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], + c, TASK_FD(task), rpc, len); end: + AIT_FREE_VAL(&b); schedReadSelf(task); - return NULL; + taskExit(task, NULL); } + +static void * +txEXTPacket(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 = AIT_GET_BUF(&c->cli_buf); + struct tagRPCCall *rpc = (struct tagRPCCall*) buf; + int ret, wlen = sizeof(struct tagRPCCall); + struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; + + schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL); + schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], + TASK_ARG(task), ts, TASK_ARG(task), 0); + + if (rpc->call_argc) { + f = rpc_srv_getCall(s, ntohs(rpc->call_tag)); + if (!f) { + rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) { + rpc_SetErr(EMSGSIZE, "Message too long"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else { + rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); + /* Go Encapsulate variables */ + ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, + RPC_RETVARS(c)); + if (ret == -1) { + rpc_SetErr(EBADRPC, "Prepare RPC packet failed"); + + rpc->call_argc ^= rpc->call_argc; + RPC_SET_RETURN(rpc, -1); + RPC_SET_ERRNO(rpc, rpc_Errno); + } else + wlen += ret; + } + } + + /* Free return values */ + ait_freeVars(&RPC_RETVARS(c)); + + rpc->call_len = htonl(wlen); + rpc->call_io = RPC_ACK; + + /* send reply */ + ret = write(TASK_FD(task), buf, wlen); + if (ret == -1) { + /* close connection */ + schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], + TASK_ARG(task), 0, NULL, 0); + } + + taskExit(task, NULL); +} + +static void * +rxEXTPacket(sched_task_t *task) +{ + rpc_srv_t *srv = TASK_ARG(task); + rpc_cli_t *c = NULL; + int len, noreply = 0, rlen = AIT_LEN(&c->cli_buf); + struct tagRPCCall *rpc; + struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; + sockaddr_t sa; + ait_val_t b = AIT_VAL_INIT; + + memset(&sa, 0, sizeof sa); + /* receive connect packet */ + AIT_SET_BUF(&b, NULL, srv->srv_netbuf); + rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b)); + rpc = (struct tagRPCCall*) AIT_GET_BUF(&b); + if (rlen < sizeof(struct tagRPCCall)) + goto end; + else + len = ntohl(rpc->call_len); + if (rlen < len || len > srv->srv_netbuf) + goto end; + + /* skip loop packet */ + if (rpc->call_io & RPC_ACK) + goto end; + + /* check RPC packet session info */ + if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) + goto end; + + c = _allocClient(srv, &sa); + if (!c) { + EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n"); + usleep(2000); /* blocked client delay */ + goto end; + } else { + memcpy(AIT_GET_BUF(&c->cli_buf), AIT_GET_BUF(&b), len); + rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf); + + c->cli_sock = TASK_FD(task); + + /* armed timer for close stateless connection */ + schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL); + schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], + c, ts, c, 0); + } + + noreply = RPC_CHK_NOREPLY(rpc); + + /* execute RPC call */ + schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len); + + /* send RPC reply */ + if (!noreply) + schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], + c, TASK_FD(task), rpc, len); +end: + AIT_FREE_VAL(&b); + schedReadSelf(task); + taskExit(task, NULL); +} + /* ------------------------------------------------------ */ void @@ -613,7 +1059,7 @@ closeBLOBClient(sched_task_t *task) /* close client socket */ shutdown(sock, SHUT_RDWR); close(sock); - return NULL; + taskExit(task, NULL); } static void * @@ -630,7 +1076,7 @@ txBLOB(sched_task_t *task) schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0); } - return NULL; + taskExit(task, NULL); } static void * @@ -647,7 +1093,7 @@ rxBLOB(sched_task_t *task) if (rlen < 1) { /* close blob connection */ schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0); - return NULL; + taskExit(task, NULL); } /* check BLOB packet */ @@ -655,7 +1101,7 @@ rxBLOB(sched_task_t *task) rpc_SetErr(ERPCMISMATCH, "Short BLOB packet"); schedReadSelf(task); - return NULL; + taskExit(task, NULL); } /* check RPC packet session info */ @@ -671,7 +1117,7 @@ rxBLOB(sched_task_t *task) 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); + RPC_SET_BLOB_RET(&blob, -1); break; } else blob.hdr_len = htonl(b->blob_len); @@ -682,7 +1128,7 @@ rxBLOB(sched_task_t *task) rpc_srv_blobUnmap(b); } else { blob.hdr_cmd = error; - blob.hdr_ret = RPC_ERROR(-1); + RPC_SET_BLOB_RET(&blob, -1); } break; case set: @@ -696,32 +1142,33 @@ rxBLOB(sched_task_t *task) rpc_srv_blobUnmap(b); } else { blob.hdr_cmd = error; - blob.hdr_ret = RPC_ERROR(-1); + RPC_SET_BLOB_RET(&blob, -1); } break; case unset: if (rpc_srv_unregisterBLOB(s, ntohl(blob.hdr_var)) == -1) { blob.hdr_cmd = error; - blob.hdr_ret = RPC_ERROR(-1); + RPC_SET_BLOB_RET(&blob, -1); } break; default: rpc_SetErr(EPROCUNAVAIL, "Unsupported BLOB command %d", blob.hdr_cmd); blob.hdr_cmd = error; - blob.hdr_ret = RPC_ERROR(-1); + RPC_SET_BLOB_RET(&blob, -1); } end: memcpy(AIT_ADDR(&c->cli_buf), &blob, sizeof blob); schedWrite(TASK_ROOT(task), txBLOB, TASK_ARG(task), TASK_FD(task), NULL, 0); schedReadSelf(task); - return NULL; + taskExit(task, NULL); } static void * flushBLOB(sched_task_t *task) { - rpc_srv_t *srv = TASK_ARG(task); + uintptr_t sigArg = atomic_load_acq_ptr(&_glSigArg); + rpc_srv_t *srv = sigArg ? (void*) sigArg : TASK_ARG(task); rpc_blob_t *b, *tmp; TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) { @@ -731,8 +1178,18 @@ flushBLOB(sched_task_t *task) e_free(b); } - schedSignalSelf(task); - return NULL; + if (!schedSignalSelf(task)) { + /* disabled kqueue support in libaitsched */ + struct sigaction sa; + + memset(&sa, 0, sizeof sa); + sigemptyset(&sa.sa_mask); + sa.sa_handler = (void (*)(int)) flushBLOB; + sa.sa_flags = SA_RESTART | SA_RESETHAND; + sigaction(SIGFBLOB, &sa, NULL); + } + + taskExit(task, NULL); } static void * @@ -763,7 +1220,7 @@ acceptBLOBClients(sched_task_t *task) if (!c) { LOGERR; srv->srv_kill = srv->srv_blob.kill = 1; - return NULL; + taskExit(task, NULL); } else { memset(c, 0, sizeof(rpc_cli_t)); array_Set(srv->srv_blob.clients, i, c); @@ -791,7 +1248,7 @@ acceptBLOBClients(sched_task_t *task) schedRead(TASK_ROOT(task), rxBLOB, c, c->cli_sock, NULL, 0); end: schedReadSelf(task); - return NULL; + taskExit(task, NULL); } /* ------------------------------------------------------ */ @@ -919,6 +1376,9 @@ rpc_srv_endBLOBServer(rpc_srv_t * __restrict srv) srv->srv_blob.kill = 1; schedEnd(&srv->srv_blob.root); + + if (srv->srv_blob.server.cli_sa.sa.sa_family == AF_LOCAL) + unlink(srv->srv_blob.server.cli_sa.sun.sun_path); } /* @@ -945,7 +1405,19 @@ rpc_srv_loopBLOBServer(rpc_srv_t * __restrict srv) return -1; } - schedSignal(srv->srv_blob.root, flushBLOB, srv, SIGFBLOB, NULL, 0); + if (!schedSignal(srv->srv_blob.root, flushBLOB, srv, SIGFBLOB, NULL, 0)) { + /* disabled kqueue support in libaitsched */ + struct sigaction sa; + + atomic_store_rel_ptr(&_glSigArg, (uintptr_t) srv); + + memset(&sa, 0, sizeof sa); + sigemptyset(&sa.sa_mask); + sa.sa_handler = (void (*)(int)) flushBLOB; + sa.sa_flags = SA_RESTART | SA_RESETHAND; + sigaction(SIGFBLOB, &sa, NULL); + } + if (!schedRead(srv->srv_blob.root, acceptBLOBClients, srv, srv->srv_blob.server.cli_sock, NULL, 0)) { rpc_SetErr(sched_GetErrno(), "%s", sched_GetError()); @@ -1004,14 +1476,14 @@ rpc_srv_initServer(u_char InstID, int concurentClients rpc_srv_t *srv = NULL; sockaddr_t sa = E_SOCKADDR_INIT; - if (!concurentClients || (proto < 0 || proto > SOCK_DGRAM)) { + if (!concurentClients || (proto < 0 || proto > SOCK_RAW)) { rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server"); return NULL; } + if (!Port && proto < SOCK_RAW) + Port = RPC_DEFPORT; if (!e_gethostbyname(csHost, Port, &sa)) return NULL; - if (!Port) - Port = RPC_DEFPORT; if (!proto) proto = SOCK_STREAM; if (netBuf < RPC_MIN_BUFSIZ) @@ -1067,7 +1539,8 @@ rpc_srv_initServer(u_char InstID, int concurentClients } /* create server socket */ - srv->srv_server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family, srv->srv_proto, 0); + srv->srv_server.cli_sock = socket(srv->srv_server.cli_sa.sa.sa_family, + srv->srv_proto, srv->srv_proto == SOCK_RAW ? IPPROTO_ERPC : 0); if (srv->srv_server.cli_sock == -1) { LOGERR; array_Destroy(&srv->srv_clients); @@ -1080,6 +1553,8 @@ rpc_srv_initServer(u_char InstID, int concurentClients LOGERR; goto err; } + if (srv->srv_proto == SOCK_STREAM) + setsockopt(srv->srv_server.cli_sock, IPPROTO_TCP, TCP_NODELAY, &n, sizeof n); n = srv->srv_netbuf; if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) { LOGERR; @@ -1129,6 +1604,9 @@ rpc_srv_endServer(rpc_srv_t ** __restrict psrv) schedEnd(&(*psrv)->srv_root); + if ((*psrv)->srv_server.cli_sa.sa.sa_family == AF_LOCAL) + unlink((*psrv)->srv_server.cli_sa.sun.sun_path); + pthread_mutex_destroy(&(*psrv)->srv_funcs.mtx); e_free(*psrv); *psrv = NULL; @@ -1173,8 +1651,10 @@ rpc_srv_loopServer(rpc_srv_t * __restrict srv) for (i = 0; i < array_Size(srv->srv_clients); i++) { c = array(srv->srv_clients, i, rpc_cli_t*); if (c) { - shutdown(c->cli_sock, SHUT_RDWR); - close(c->cli_sock); + if (srv->srv_proto == SOCK_STREAM) { + shutdown(c->cli_sock, SHUT_RDWR); + close(c->cli_sock); + } schedCancelby(srv->srv_root, taskMAX, CRITERIA_ARG, c, NULL); ait_freeVars(&RPC_RETVARS(c)); @@ -1184,7 +1664,8 @@ rpc_srv_loopServer(rpc_srv_t * __restrict srv) } array_Destroy(&srv->srv_clients); - close(srv->srv_server.cli_sock); + if (srv->srv_proto != SOCK_EXT) + close(srv->srv_server.cli_sock); /* detach exported calls */ RPC_FUNCS_LOCK(&srv->srv_funcs); @@ -1223,4 +1704,215 @@ 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; + struct bpf_insn insns[] = { + BPF_STMT(BPF_LD + BPF_H + BPF_ABS, 12), + BPF_JUMP(BPF_JMP + BPF_JEQ + BPF_K, RPC_DEFPORT, 0, 1), + BPF_STMT(BPF_RET + BPF_K, -1), + BPF_STMT(BPF_RET + BPF_K, 0), + }; + struct bpf_program fcode = { + .bf_len = sizeof(insns) / sizeof(struct bpf_insn), + .bf_insns = insns + }; + + 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; + } + if (ioctl(srv->srv_server.cli_sock, BIOCSETF, &fcode) == -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_initServerExt() - Init & create pipe RPC Server + * + * @InstID = Instance for authentication & recognition + * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet) + * @fd = File descriptor + * return: NULL == error or !=NULL bind and created RPC server instance + */ +rpc_srv_t * +rpc_srv_initServerExt(u_char InstID, int netBuf, int fd) +{ + rpc_srv_t *srv = 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_EXT; + srv->srv_netbuf = (netBuf < RPC_MIN_BUFSIZ) ? + getpagesize() : E_ALIGN(netBuf, 2); + srv->srv_session.sess_version = RPC_VERSION; + srv->srv_session.sess_instance = InstID; + + srv->srv_server.cli_parent = srv; + srv->srv_server.cli_sock = fd; + + /* 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(1); + 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; + } + + fcntl(srv->srv_server.cli_sock, F_SETFL, + fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK); + + rpc_register_srvPing(srv); + + return srv; }