--- libaitrpc/src/aitrpc.c 2013/08/23 13:53:15 1.11 +++ libaitrpc/src/aitrpc.c 2015/01/15 01:42:37 1.16 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ -* $Id: aitrpc.c,v 1.11 2013/08/23 13:53:15 misho Exp $ +* $Id: aitrpc.c,v 1.16 2015/01/15 01:42:37 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 - 2014 by Michael Pounov . All rights reserved. Redistribution and use in source and binary forms, with or without @@ -149,7 +149,7 @@ rpc_addPktSession(rpc_sess_t *p, rpc_sess_t *s) * @sa = check client address, if you use udp protocol * @buf = buffer * @blen = buffer length - * return: -1 error or >-1 readed bytes into buffer + * return: -1 error, 0 EOF or or >0 readed bytes into buffer */ ssize_t rpc_Read(int sock, int type, int flags, sockaddr_t * __restrict sa, @@ -158,48 +158,108 @@ rpc_Read(int sock, int type, int flags, sockaddr_t * _ struct pollfd pfd; sockaddr_t sa2; socklen_t salen; - int ret = 0, len; + int ret = 0, len, cx = 0; + ait_val_t v = AIT_VAL_INIT; + struct ether_header *eh; + struct bpf_hdr *h; + ether_addr_t bcst = {{ [0 ... sizeof bcst - 1] = 0xff }}; + if (type == SOCK_BPF && sa) { + AIT_SET_BUF(&v, NULL, blen); + h = (struct bpf_hdr*) AIT_GET_BUF(&v); + } + pfd.fd = sock; pfd.events = POLLIN | POLLPRI; memset(buf, 0, blen); memset(&sa2, 0, sizeof sa2); salen = sa2.ss.ss_len = sizeof(sockaddr_t); - if (type == SOCK_STREAM) { - for (len = blen; len > 0; len -= ret, buf += ret) { - if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || - pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { + for (len = blen; len > 0; len -= ret, buf += ret) { + if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || + pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { + if (ret) LOGERR; - return -1; - } else - ret = recv(sock, buf, len, flags); - if (ret == -1) { - LOGERR; - return -1; - } + else + rpc_SetErr(ETIMEDOUT, "Timeout reached! Server not respond"); + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); + return -1; } - if (ret > -1) - ret = blen - len; - } else { - do { - if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || - pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { - LOGERR; - return -1; - } else - ret = recvfrom(sock, buf, blen, flags, &sa2.sa, &salen); - if (ret < 0) { - LOGERR; - return -1; + if (type == SOCK_STREAM) + ret = recv(sock, buf, len, flags); + else if (type == SOCK_BPF && sa) { + ret = read(sock, AIT_GET_BUF(&v), AIT_LEN(&v)); + if (ret > 0) { + ret -= h->bh_hdrlen; + if (ret < h->bh_caplen || h->bh_caplen != h->bh_datalen || + ret < ETHER_HDR_LEN + sizeof(struct tagRPCCall)) { + if (cx < 3) { + cx++; + ret ^= ret; + continue; /* wait for known address */ + } else { + AIT_FREE_VAL(&v); + return -1; + } + } + ret = h->bh_caplen; + eh = (struct ether_header*) (AIT_GET_BUF(&v) + h->bh_hdrlen); + ret -= ETHER_HDR_LEN; + if (eh->ether_type != ntohs(RPC_DEFPORT)) { + if (cx < 3) { + cx++; + ret ^= ret; + continue; /* wait for known address */ + } else { + AIT_FREE_VAL(&v); + return -1; + } + } +#if 0 + else + e_getlinkbymac((const ether_addr_t*) eh->ether_shost, &sa2); + if (sa && e_addrcmp(sa, &sa2, 0)) { +#else + if (!memcmp(bcst.octet, eh->ether_dhost, sizeof bcst) || + !memcmp(bcst.octet, eh->ether_shost, sizeof bcst)) { +#endif + if (cx < 3) { + cx++; + ret ^= ret; + continue; /* wait for known address */ + } else { + AIT_FREE_VAL(&v); + return -1; + } + } + memcpy(buf, (u_char*) (eh + 1), MIN(ret, len)); + AIT_FREE_VAL(&v); + return ret; } - if (e_addrcmp(sa, &sa2, 42)) - rpc_SetErr(ERPCMISMATCH, "Received RPC response from unknown address"); - else - break; - } while (42); + } else { + ret = recvfrom(sock, buf, len, flags, &sa2.sa, &salen); + if (ret > -1 && sa && e_addrcmp(sa, &sa2, 42)) { + ret ^= ret; + continue; /* wait for known address */ + } + } + if (ret == -1) { + LOGERR; + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); + return -1; + } + if (!ret) { /* EOF */ + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); + return 0; + } } + ret = blen - len; + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); return ret; } @@ -212,7 +272,7 @@ rpc_Read(int sock, int type, int flags, sockaddr_t * _ * @sa = send to client address, if you use udp protocol * @buf = buffer * @blen = buffer length - * return: -1 error or >-1 written bytes into buffer + * return: -1 error, 0 EOF or >0 written bytes into buffer */ ssize_t rpc_Write(int sock, int type, int flags, sockaddr_t * __restrict sa, @@ -220,44 +280,69 @@ rpc_Write(int sock, int type, int flags, sockaddr_t * { struct pollfd pfd; int ret = 0, len = 0; + ait_val_t v = AIT_VAL_INIT; + struct ether_header *eh; + if (type == SOCK_BPF && sa) { + AIT_SET_BUF(&v, NULL, blen + sizeof(struct ether_header)); + eh = (struct ether_header*) AIT_GET_BUF(&v); + memcpy(eh->ether_dhost, LLADDR(&sa->sdl), ETHER_ADDR_LEN); + eh->ether_type = htons(RPC_DEFPORT); + memcpy(eh + 1, buf, blen); + blen += sizeof(struct ether_header); + } + pfd.fd = sock; pfd.events = POLLOUT; - - if (type == SOCK_STREAM) { - for (len = blen; len > 0; len -= ret, buf += ret) { - if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || - pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { - LOGERR; - return -1; - } else - ret = send(sock, buf, len, flags); - if (ret == -1) { - LOGERR; - return -1; - } - } - if (ret > -1) - ret = blen - len; - } else if (sa) { + for (len = blen; len > 0; len -= ret, buf += ret) { if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { +#if 0 + if (!ret) + continue; +#endif + if (ret > 0) + rpc_SetErr(EPIPE, "Disconnected RPC session\n"); + else + LOGERR; + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); + return -1; + } + if (type == SOCK_STREAM) + ret = send(sock, buf, len, flags); + else if (type == SOCK_BPF && sa) { + ret = write(sock, AIT_GET_BUF(&v), AIT_LEN(&v)); + } else if (sa) + ret = sendto(sock, buf, len, flags, &sa->sa, sa->sa.sa_len); + else { + rpc_SetErr(EINVAL, "Invalid argument(s)!"); + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); + return -1; + } + if (ret == -1) { LOGERR; + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); return -1; - } else - ret = sendto(sock, buf, blen, flags, &sa->sa, sa->sa.sa_len); - } else { - rpc_SetErr(EINVAL, "Invalid argument(s)!"); - return -1; + } + if (!ret) { /* EOF */ + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); + return 0; + } } - if (ret == -1) { - LOGERR; - return -1; - } else if (ret != blen) { + ret = blen - len; + if (ret != blen) { rpc_SetErr(EPROCUNAVAIL, "RPC request, should be send %d bytes, " - "really sended %d bytes", len, ret); + "really sended %d bytes", blen, ret); + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); return -1; } + if (type == SOCK_BPF) + AIT_FREE_VAL(&v); return ret; }