[BACK]Return to srv.c CVS log [TXT] [DIR] Up to [ELWIX - Embedded LightWeight unIX -] / libaitrpc / src

Diff for /libaitrpc/src/srv.c between versions 1.26.2.4 and 1.26.2.11

version 1.26.2.4, 2015/06/24 23:02:28 version 1.26.2.11, 2015/07/02 17:52:53
Line 70  static void *rxEXTPacket(sched_task_t *); Line 70  static void *rxEXTPacket(sched_task_t *);
 static void *txEXTPacket(sched_task_t *);  static void *txEXTPacket(sched_task_t *);
   
 static sched_task_func_t cbProto[SOCK_MAX_SUPPORT][4] = {  static sched_task_func_t cbProto[SOCK_MAX_SUPPORT][4] = {
        { acceptClients, closeClient, rxPacket, txPacket },     /* SOCK_STREAM */        { acceptClients, closeClient, rxPacket, txPacket },             /* SOCK_STREAM */
        { acceptClients, closeClient, rxPacket, txPacket },     /* SOCK_STREAM */        { acceptClients, closeClient, rxPacket, txPacket },             /* SOCK_STREAM */
        { rxUDPPacket, freeClient, rxUDPPacket, txUDPPacket },        /* SOCK_DGRAM */        { rxUDPPacket, freeClient, NULL /*rxUDPPacket*/, txUDPPacket },        /* SOCK_DGRAM */
        { rxRAWPacket, freeClient, rxRAWPacket, txRAWPacket },        /* SOCK_RAW */        { rxRAWPacket, freeClient, NULL /*rxRAWPacket*/, txRAWPacket },        /* SOCK_RAW */
        { rxBPFPacket, freeClient, rxBPFPacket, txBPFPacket },        /* SOCK_BPF */        { rxBPFPacket, freeClient, NULL /*rxBPFPacket*/, txBPFPacket },        /* SOCK_BPF */
        { rxEXTPacket, freeClient, rxEXTPacket, txEXTPacket } /* SOCK_EXT */        { rxEXTPacket, freeClient, NULL /*rxEXTPacket*/, txEXTPacket } /* SOCK_EXT */
 };  };
   
 /* Global Signal Argument when kqueue support disabled */  /* Global Signal Argument when kqueue support disabled */
Line 158  freeClient(sched_task_t *task) Line 158  freeClient(sched_task_t *task)
 {  {
         rpc_freeCli(TASK_ARG(task));          rpc_freeCli(TASK_ARG(task));
   
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 171  closeClient(sched_task_t *task) Line 171  closeClient(sched_task_t *task)
         /* close client socket */          /* close client socket */
         shutdown(sock, SHUT_RDWR);          shutdown(sock, SHUT_RDWR);
         close(sock);          close(sock);
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 182  txPacket(sched_task_t *task) Line 182  txPacket(sched_task_t *task)
         rpc_func_t *f = NULL;          rpc_func_t *f = NULL;
         u_char *buf = AIT_GET_BUF(&c->cli_buf);          u_char *buf = AIT_GET_BUF(&c->cli_buf);
         struct tagRPCCall *rpc = (struct tagRPCCall*) buf;          struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
        int ret, estlen, wlen = sizeof(struct tagRPCCall);        int ret, wlen = sizeof(struct tagRPCCall);
        struct pollfd pfd; 
 #ifdef TCP_SESSION_TIMEOUT  #ifdef TCP_SESSION_TIMEOUT
         struct timespec ts = { DEF_RPC_TIMEOUT, 0 };          struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
   
Line 198  txPacket(sched_task_t *task) Line 197  txPacket(sched_task_t *task)
                         rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");                          rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
   
                         rpc->call_argc ^= rpc->call_argc;                          rpc->call_argc ^= rpc->call_argc;
                        rpc->call_rep.ret = RPC_ERROR(-1);                        RPC_SET_RETURN(rpc, -1);
                        rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                        RPC_SET_ERRNO(rpc, rpc_Errno);
                } else {                } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
                        /* calc estimated length */                        rpc_SetErr(EMSGSIZE, "Message too long");
                        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->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));                          rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
                         /* Go Encapsulate variables */                          /* Go Encapsulate variables */
                         ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,                           ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
                                         RPC_RETVARS(c));                                          RPC_RETVARS(c));
                         /* Free return values */  
                         ait_freeVars(&c->cli_vars);  
                         if (ret == -1) {                          if (ret == -1) {
                                 rpc_SetErr(EBADRPC, "Prepare RPC packet failed");                                  rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
   
                                 rpc->call_argc ^= rpc->call_argc;                                  rpc->call_argc ^= rpc->call_argc;
                                rpc->call_rep.ret = RPC_ERROR(-1);                                RPC_SET_RETURN(rpc, -1);
                                rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                                RPC_SET_ERRNO(rpc, rpc_Errno);
                         } else                          } else
                                 wlen += ret;                                  wlen += ret;
                 }                  }
         }          }
   
           /* Free return values */
           ait_freeVars(&c->cli_vars);
   
         rpc->call_len = htonl(wlen);          rpc->call_len = htonl(wlen);
         rpc->call_io = RPC_ACK;          rpc->call_io = RPC_ACK;
   
Line 235  txPacket(sched_task_t *task) Line 234  txPacket(sched_task_t *task)
 #endif  #endif
   
         /* send reply */          /* send reply */
        pfd.fd = TASK_FD(task);        ret = send(TASK_FD(task), buf, wlen, MSG_NOSIGNAL);
        pfd.events = POLLOUT;        if (ret == -1) {
        for (; wlen > 0; wlen -= ret, buf += ret) {                /* close connection */
                if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 ||                 schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
                                pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {                                TASK_ARG(task), 0, NULL, 0);
                        if (ret) 
                                LOGERR; 
                        else 
                                rpc_SetErr(ETIMEDOUT, "Timeout reached! Client 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; 
                } 
         }          }
   
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 280  execCall(sched_task_t *task) Line 263  execCall(sched_task_t *task)
                         rpc_SetErr(ERPCMISMATCH, "#%d - %s", elwix_GetErrno(), elwix_GetError());                          rpc_SetErr(ERPCMISMATCH, "#%d - %s", elwix_GetErrno(), elwix_GetError());
   
                         rpc->call_argc ^= rpc->call_argc;                          rpc->call_argc ^= rpc->call_argc;
                        rpc->call_rep.ret = RPC_ERROR(-1);                        RPC_SET_RETURN(rpc, -1);
                        rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                        RPC_SET_ERRNO(rpc, rpc_Errno);
                        return NULL;                        taskExit(task, NULL);
                 }                  }
         } else          } else
                 arr = NULL;                  arr = NULL;
Line 291  execCall(sched_task_t *task) Line 274  execCall(sched_task_t *task)
                 rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");                  rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
   
                 rpc->call_argc ^= rpc->call_argc;                  rpc->call_argc ^= rpc->call_argc;
                rpc->call_rep.ret = RPC_ERROR(-1);                RPC_SET_RETURN(rpc, -1);
                rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                RPC_SET_ERRNO(rpc, rpc_Errno);
         } else {          } else {
                 /* if client doesn't want reply */                  /* if client doesn't want reply */
                argc = RPC_CHK_NOREPLY(rpc);                RPC_SET_RETURN(rpc, rpc_srv_execCall(c, rpc, f->func_name, arr));
                rpc->call_rep.ret = RPC_ERROR(rpc_srv_execCall(c, rpc, f->func_name, arr)); 
                 if (rpc->call_rep.ret == htonl(-1)) {                  if (rpc->call_rep.ret == htonl(-1)) {
                         if (!rpc->call_rep.eno) {                          if (!rpc->call_rep.eno) {
                                 LOGERR;                                  LOGERR;
                                rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                                RPC_SET_ERRNO(rpc, rpc_Errno);
                         }                          }
                         rpc->call_argc ^= rpc->call_argc;                          rpc->call_argc ^= rpc->call_argc;
                           ait_freeVars(&c->cli_vars);
                 } else {                  } else {
                         rpc->call_rep.eno ^= rpc->call_rep.eno;                          rpc->call_rep.eno ^= rpc->call_rep.eno;
                        if (argc) {                        rpc->call_argc ^= rpc->call_argc;
                         if (TASK_VAL(task)) {
                                 /* without reply */                                  /* without reply */
                                 ait_freeVars(&c->cli_vars);                                  ait_freeVars(&c->cli_vars);
                                 rpc->call_argc ^= rpc->call_argc;  
                         } else {                          } else {
                                 /* reply */                                  /* reply */
                                 rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));                                  rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
Line 317  execCall(sched_task_t *task) Line 300  execCall(sched_task_t *task)
         }          }
   
         array_Destroy(&arr);          array_Destroy(&arr);
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 325  rxPacket(sched_task_t *task) Line 308  rxPacket(sched_task_t *task)
 {  {
         rpc_cli_t *c = TASK_ARG(task);          rpc_cli_t *c = TASK_ARG(task);
         rpc_srv_t *s = c->cli_parent;          rpc_srv_t *s = c->cli_parent;
        int len, rlen, noreply, estlen;        int len, noreply = 0, rlen = AIT_LEN(&c->cli_buf);
 #if 0  #if 0
         u_short crc;          u_short crc;
 #endif  #endif
         u_char *buf = AIT_GET_BUF(&c->cli_buf);          u_char *buf = AIT_GET_BUF(&c->cli_buf);
           u_char b[sizeof(struct tagRPCCall)];
         struct tagRPCCall *rpc = (struct tagRPCCall*) buf;          struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
         struct pollfd pfd;  
 #ifdef TCP_SESSION_TIMEOUT  #ifdef TCP_SESSION_TIMEOUT
         struct timespec ts = { DEF_RPC_TIMEOUT, 0 };          struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
   
Line 340  rxPacket(sched_task_t *task) Line 323  rxPacket(sched_task_t *task)
                          TASK_ARG(task), ts, TASK_ARG(task), 0);                           TASK_ARG(task), ts, TASK_ARG(task), 0);
 #endif  #endif
   
        memset(buf, 0, sizeof(struct tagRPCCall));        /* prepare rx */
        rlen = recv(TASK_FD(task), rpc, sizeof(struct tagRPCCall), MSG_PEEK);        len = recv(TASK_FD(task), b, sizeof b, MSG_PEEK);
        if (rlen < sizeof(struct tagRPCCall)) {        if (len == sizeof b)
                 rlen = ntohl(((struct tagRPCCall*) b)->call_len);
 
         rlen = recv(TASK_FD(task), buf, rlen, 0);
         if (rlen == -1) {
                 /* close connection */                  /* close connection */
                 schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],                   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);
        } 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; 
         }          }
           if (rlen < sizeof(struct tagRPCCall)) {
                   rpc_SetErr(ERPCMISMATCH, "Short RPC packet");
   
        /* get next part of packet */                rpc->call_argc ^= rpc->call_argc;
        memset(buf, 0, len);                RPC_SET_RETURN(rpc, -1);
        pfd.fd = TASK_FD(task);                RPC_SET_ERRNO(rpc, rpc_Errno);
        pfd.events = POLLIN | POLLPRI;                goto err;
        for (; len > 0; len -= rlen, buf += rlen) {        } else
                if ((rlen = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 ||                 len = ntohl(rpc->call_len);
                                pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {        if (rlen < len || len > AIT_LEN(&c->cli_buf)) {
                        if (rlen)                rpc_SetErr(ERPCMISMATCH, "Short RPC packet");
                                LOGERR;
                        else                rpc->call_argc ^= rpc->call_argc;
                                rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond");                RPC_SET_RETURN(rpc, -1);
                        schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],                 RPC_SET_ERRNO(rpc, rpc_Errno);
                                        TASK_ARG(task), 0, NULL, 0);                goto err;
                        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; 
                } 
         }          }
         len = estlen;  
   
         /* skip loop packet */          /* skip loop packet */
         if (rpc->call_io & RPC_ACK) {          if (rpc->call_io & RPC_ACK) {
                 schedReadSelf(task);                  schedReadSelf(task);
                return NULL;                taskExit(task, NULL);
         }          }
   
 #if 0  #if 0
Line 393  rxPacket(sched_task_t *task) Line 365  rxPacket(sched_task_t *task)
         rpc->call_crc ^= rpc->call_crc;          rpc->call_crc ^= rpc->call_crc;
         if (crc != crcFletcher16((u_short*) rpc, len / 2)) {          if (crc != crcFletcher16((u_short*) rpc, len / 2)) {
                 rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");                  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  #endif
   
         noreply = RPC_CHK_NOREPLY(rpc);  
   
         /* check RPC packet session info */          /* check RPC packet session info */
         if (rpc_chkPktSession(&rpc->call_session, &s->srv_session)) {          if (rpc_chkPktSession(&rpc->call_session, &s->srv_session)) {
                 rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");                  rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
   
                 rpc->call_argc ^= rpc->call_argc;                  rpc->call_argc ^= rpc->call_argc;
                rpc->call_rep.ret = RPC_ERROR(-1);                RPC_SET_RETURN(rpc, -1);
                rpc->call_rep.eno = RPC_ERROR(errno);                RPC_SET_ERRNO(rpc, rpc_Errno);
        } else {                goto err;
                /* execute RPC call */ 
                schedEvent(TASK_ROOT(task), execCall, TASK_ARG(task), (int) noreply, rpc, len); 
         }          }
   
           noreply = RPC_CHK_NOREPLY(rpc);
   
           /* execute RPC call */
           schedEvent(TASK_ROOT(task), execCall, TASK_ARG(task), (int) noreply, rpc, len);
   err:
         /* send RPC reply */          /* send RPC reply */
         if (!noreply)          if (!noreply)
                 schedWrite(TASK_ROOT(task), cbProto[s->srv_proto][CB_TXPACKET],                   schedWrite(TASK_ROOT(task), cbProto[s->srv_proto][CB_TXPACKET], 
Line 418  rxPacket(sched_task_t *task) Line 395  rxPacket(sched_task_t *task)
   
         /* lets get next packet */          /* lets get next packet */
         schedReadSelf(task);          schedReadSelf(task);
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 462  acceptClients(sched_task_t *task) Line 439  acceptClients(sched_task_t *task)
                         c->cli_sock, NULL, 0);                          c->cli_sock, NULL, 0);
 end:  end:
         schedReadSelf(task);          schedReadSelf(task);
        return NULL;        taskExit(task, NULL);
 }  }
   
   
Line 474  txUDPPacket(sched_task_t *task) Line 451  txUDPPacket(sched_task_t *task)
         rpc_func_t *f = NULL;          rpc_func_t *f = NULL;
         u_char *buf = AIT_GET_BUF(&c->cli_buf);          u_char *buf = AIT_GET_BUF(&c->cli_buf);
         struct tagRPCCall *rpc = (struct tagRPCCall*) buf;          struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
        int ret, estlen, wlen = sizeof(struct tagRPCCall);        int ret, wlen = sizeof(struct tagRPCCall);
         struct timespec ts = { DEF_RPC_TIMEOUT, 0 };          struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
         struct pollfd pfd;  
   
         schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);          schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
         schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],           schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
Line 486  txUDPPacket(sched_task_t *task) Line 462  txUDPPacket(sched_task_t *task)
                 f = rpc_srv_getCall(s, ntohs(rpc->call_tag));                  f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
                 if (!f) {                  if (!f) {
                         rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");                          rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
   
                         rpc->call_argc ^= rpc->call_argc;                          rpc->call_argc ^= rpc->call_argc;
                        rpc->call_rep.ret = RPC_ERROR(-1);                        RPC_SET_RETURN(rpc, -1);
                        rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                        RPC_SET_ERRNO(rpc, rpc_Errno);
                } else {                } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
                        /* calc estimated length */                        rpc_SetErr(EMSGSIZE, "Message too long");
                        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->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));                          rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
                         /* Go Encapsulate variables */                          /* Go Encapsulate variables */
                         ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,                           ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
                                         RPC_RETVARS(c));                                          RPC_RETVARS(c));
                         /* Free return values */  
                         ait_freeVars(&c->cli_vars);  
                         if (ret == -1) {                          if (ret == -1) {
                                 rpc_SetErr(EBADRPC, "Prepare RPC packet failed");                                  rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
   
                                 rpc->call_argc ^= rpc->call_argc;                                  rpc->call_argc ^= rpc->call_argc;
                                rpc->call_rep.ret = RPC_ERROR(-1);                                RPC_SET_RETURN(rpc, -1);
                                rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                                RPC_SET_ERRNO(rpc, rpc_Errno);
                         } else                          } else
                                 wlen += ret;                                  wlen += ret;
                 }                  }
         }          }
   
           /* Free return values */
           ait_freeVars(&c->cli_vars);
   
         rpc->call_len = htonl(wlen);          rpc->call_len = htonl(wlen);
         rpc->call_io = RPC_ACK;          rpc->call_io = RPC_ACK;
   
Line 521  txUDPPacket(sched_task_t *task) Line 499  txUDPPacket(sched_task_t *task)
         rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));          rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
   
         /* send reply */          /* send reply */
        pfd.fd = TASK_FD(task);        ret = sendto(TASK_FD(task), buf, wlen, MSG_NOSIGNAL, 
        pfd.events = POLLOUT;                        &c->cli_sa.sa, c->cli_sa.sa.sa_len);
        for (; wlen > 0; wlen -= ret, buf += ret) {        if (ret == -1) {
                if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 ||                 /* close connection */
                                pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) {                schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
                        if (ret)                                TASK_ARG(task), 0, NULL, 0);
                                LOGERR; 
                        else 
                                rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond"); 
                        /* close connection */ 
                        schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],  
                                        TASK_ARG(task), 0, NULL, 0); 
                        return NULL; 
                } 
                ret = sendto(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf), 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); 
                        return NULL; 
                } 
         }          }
   
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 553  rxUDPPacket(sched_task_t *task) Line 515  rxUDPPacket(sched_task_t *task)
 {  {
         rpc_srv_t *srv = TASK_ARG(task);          rpc_srv_t *srv = TASK_ARG(task);
         rpc_cli_t *c = NULL;          rpc_cli_t *c = NULL;
        int len, rlen, noreply, estlen;        int len, noreply = 0, rlen;
         u_short crc;          u_short crc;
        u_char *buf, b[sizeof(struct tagRPCCall)];        struct tagRPCCall *rpc;
        struct tagRPCCall *rpc = (struct tagRPCCall*) b; 
         sockaddr_t sa;          sockaddr_t sa;
         socklen_t salen;          socklen_t salen;
         struct timespec ts = { DEF_RPC_TIMEOUT, 0 };          struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
        struct pollfd pfd;        ait_val_t b = AIT_VAL_INIT;
   
         /* receive connect packet */          /* receive connect packet */
           AIT_SET_BUF(&b, NULL, srv->srv_netbuf);
         salen = sa.ss.ss_len = sizeof(sockaddr_t);          salen = sa.ss.ss_len = sizeof(sockaddr_t);
        rlen = recvfrom(TASK_FD(task), b, sizeof b, MSG_PEEK, &sa.sa, &salen);        rlen = recvfrom(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b), 0, &sa.sa, &salen);
        if (rlen < sizeof(struct tagRPCCall)) {        rpc = (struct tagRPCCall*) AIT_GET_BUF(&b);
                rpc_SetErr(ERPCMISMATCH, "Short RPC packet");        if (rlen < sizeof(struct tagRPCCall))
                 goto end;                  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);          c = _allocClient(srv, &sa);
         if (!c) {          if (!c) {
                 EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");                  EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
                 usleep(2000);   /* blocked client delay */                  usleep(2000);   /* blocked client delay */
                 goto end;                  goto end;
         } else {          } else {
                estlen = ntohl(rpc->call_len);                memcpy(AIT_GET_BUF(&c->cli_buf), AIT_GET_BUF(&b), len);
                if (estlen > AIT_LEN(&c->cli_buf)) 
                        AIT_RE_BUF(&c->cli_buf, estlen); 
                 rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);                  rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
                 buf = AIT_GET_BUF(&c->cli_buf);  
                 len = estlen;  
   
                 c->cli_sock = TASK_FD(task);                  c->cli_sock = TASK_FD(task);
                 memcpy(&c->cli_sa, &sa, sizeof c->cli_sa);                  memcpy(&c->cli_sa, &sa, sizeof c->cli_sa);
Line 592  rxUDPPacket(sched_task_t *task) Line 567  rxUDPPacket(sched_task_t *task)
                                 c, ts, c, 0);                                  c, ts, c, 0);
         }          }
   
         /* 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! Client not respond");  
                         schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],   
                                         c, 0, NULL, 0);  
                         goto end;  
                 }  
                 salen = sa.ss.ss_len = sizeof(sockaddr_t);  
                 rlen = recvfrom(TASK_FD(task), buf, len, 0, &sa.sa, &salen);  
                 if (rlen == -1) {  
                         /* close connection */  
                         schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],   
                                         c, 0, NULL, 0);  
                         goto end;  
                 }  
                 if (e_addrcmp(&c->cli_sa, &sa, 42))  
                         rlen ^= rlen;   /* skip if arrive from different address */  
         }  
         len = estlen;  
   
         /* 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)) {  
                 rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");  
                 /* close connection */  
                 schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],   
                                 c, 0, NULL, 0);  
                 goto end;  
         }  
   
         noreply = RPC_CHK_NOREPLY(rpc);          noreply = RPC_CHK_NOREPLY(rpc);
   
        /* check RPC packet session info */        /* execute RPC call */
        if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) {        schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
                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, c, (int) noreply, rpc, len);  
         }  
   
         /* send RPC reply */          /* send RPC reply */
         if (!noreply)          if (!noreply)
                 schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],                   schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], 
                                 c, TASK_FD(task), rpc, len);                                  c, TASK_FD(task), rpc, len);
 end:  end:
           AIT_FREE_VAL(&b);
         schedReadSelf(task);          schedReadSelf(task);
        return NULL;        taskExit(task, NULL);
 }  }
   
   
Line 667  txRAWPacket(sched_task_t *task) Line 591  txRAWPacket(sched_task_t *task)
         rpc_func_t *f = NULL;          rpc_func_t *f = NULL;
         u_char *buf = AIT_GET_BUF(&c->cli_buf);          u_char *buf = AIT_GET_BUF(&c->cli_buf);
         struct tagRPCCall *rpc = (struct tagRPCCall*) buf;          struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
        int ret, estlen, wlen = sizeof(struct tagRPCCall);        int ret, wlen = sizeof(struct tagRPCCall);
         struct timespec ts = { DEF_RPC_TIMEOUT, 0 };          struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
   
         schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);          schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
Line 678  txRAWPacket(sched_task_t *task) Line 602  txRAWPacket(sched_task_t *task)
                 f = rpc_srv_getCall(s, ntohs(rpc->call_tag));                  f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
                 if (!f) {                  if (!f) {
                         rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");                          rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
   
                         rpc->call_argc ^= rpc->call_argc;                          rpc->call_argc ^= rpc->call_argc;
                        rpc->call_rep.ret = RPC_ERROR(-1);                        RPC_SET_RETURN(rpc, -1);
                        rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                        RPC_SET_ERRNO(rpc, rpc_Errno);
                } else {                } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
                        /* calc estimated length */                        rpc_SetErr(EMSGSIZE, "Message too long");
                        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->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));                          rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
                         /* Go Encapsulate variables */                          /* Go Encapsulate variables */
                         ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,                           ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
                                         RPC_RETVARS(c));                                          RPC_RETVARS(c));
                         /* Free return values */  
                         ait_freeVars(&c->cli_vars);  
                         if (ret == -1) {                          if (ret == -1) {
                                 rpc_SetErr(EBADRPC, "Prepare RPC packet failed");                                  rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
   
                                 rpc->call_argc ^= rpc->call_argc;                                  rpc->call_argc ^= rpc->call_argc;
                                rpc->call_rep.ret = RPC_ERROR(-1);                                RPC_SET_RETURN(rpc, -1);
                                rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                                RPC_SET_ERRNO(rpc, rpc_Errno);
                         } else                          } else
                                 wlen += ret;                                  wlen += ret;
                 }                  }
         }          }
   
           /* Free return values */
           ait_freeVars(&c->cli_vars);
   
         rpc->call_len = htonl(wlen);          rpc->call_len = htonl(wlen);
         rpc->call_io = RPC_ACK;          rpc->call_io = RPC_ACK;
   
Line 713  txRAWPacket(sched_task_t *task) Line 639  txRAWPacket(sched_task_t *task)
         rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));          rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
   
         /* send reply */          /* send reply */
        ret = sendto(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf), MSG_NOSIGNAL,         ret = sendto(TASK_FD(task), buf, wlen, MSG_NOSIGNAL, 
                         &c->cli_sa.sa, c->cli_sa.sa.sa_len);                          &c->cli_sa.sa, c->cli_sa.sa.sa_len);
         if (ret == -1) {          if (ret == -1) {
                 /* close connection */                  /* close connection */
                 schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],                   schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
                                 TASK_ARG(task), 0, NULL, 0);                                  TASK_ARG(task), 0, NULL, 0);
                 return NULL;  
         }          }
   
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 730  rxRAWPacket(sched_task_t *task) Line 655  rxRAWPacket(sched_task_t *task)
 {  {
         rpc_srv_t *srv = TASK_ARG(task);          rpc_srv_t *srv = TASK_ARG(task);
         rpc_cli_t *c = NULL;          rpc_cli_t *c = NULL;
        int len, rlen, noreply;        int len, noreply = 0, rlen;
         u_short crc;          u_short crc;
         struct tagRPCCall *rpc;          struct tagRPCCall *rpc;
         sockaddr_t sa;          sockaddr_t sa;
Line 749  rxRAWPacket(sched_task_t *task) Line 674  rxRAWPacket(sched_task_t *task)
                         goto end;                          goto end;
                 else {                  else {
                         rlen -= sizeof(struct ip);                          rlen -= sizeof(struct ip);
                        rpc = (struct tagRPCCall*)                         rpc = (struct tagRPCCall*) (h + 1);
                                (AIT_GET_BUF(&b) + sizeof(struct ip)); 
                 }                  }
         } else {          } else {
                 struct ip6_hdr *h;                  struct ip6_hdr *h;
Line 760  rxRAWPacket(sched_task_t *task) Line 684  rxRAWPacket(sched_task_t *task)
                         goto end;                          goto end;
                 else {                  else {
                         rlen -= sizeof(struct ip6_hdr);                          rlen -= sizeof(struct ip6_hdr);
                        rpc = (struct tagRPCCall*)                         rpc = (struct tagRPCCall*) (h + 1);
                                (AIT_GET_BUF(&b) + sizeof(struct ip6_hdr)); 
                 }                  }
         }          }
        if (rlen < sizeof(struct tagRPCCall)) {        if (rlen < sizeof(struct tagRPCCall))
                rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); 
                 goto end;                  goto end;
        }        else
                 len = ntohl(rpc->call_len);
         if (rlen < len || len > srv->srv_netbuf)
                 goto end;
   
         /* skip loop packet */          /* skip loop packet */
         if (rpc->call_io & RPC_ACK)          if (rpc->call_io & RPC_ACK)
                 goto end;                  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);          c = _allocClient(srv, &sa);
         if (!c) {          if (!c) {
                 EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");                  EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
                 usleep(2000);   /* blocked client delay */                  usleep(2000);   /* blocked client delay */
                 goto end;                  goto end;
         } else {          } else {
                 len = ntohl(rpc->call_len);  
                 if (len > AIT_LEN(&c->cli_buf))  
                         AIT_RE_BUF(&c->cli_buf, len);  
                 memcpy(AIT_GET_BUF(&c->cli_buf), rpc, len);                  memcpy(AIT_GET_BUF(&c->cli_buf), rpc, len);
                 rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);                  rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
   
Line 794  rxRAWPacket(sched_task_t *task) Line 726  rxRAWPacket(sched_task_t *task)
                                 c, ts, c, 0);                                  c, ts, c, 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");  
                 /* close connection */  
                 schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],   
                                 c, 0, NULL, 0);  
                 goto end;  
         }  
   
         noreply = RPC_CHK_NOREPLY(rpc);          noreply = RPC_CHK_NOREPLY(rpc);
   
        /* check RPC packet session info */        /* execute RPC call */
        if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) {        schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
                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, c, (int) noreply, rpc, len);  
         }  
   
         /* send RPC reply */          /* send RPC reply */
         if (!noreply)          if (!noreply)
                 schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],                   schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], 
Line 826  rxRAWPacket(sched_task_t *task) Line 738  rxRAWPacket(sched_task_t *task)
 end:  end:
         AIT_FREE_VAL(&b);          AIT_FREE_VAL(&b);
         schedReadSelf(task);          schedReadSelf(task);
        return NULL;        taskExit(task, NULL);
 }  }
   
   
Line 838  txBPFPacket(sched_task_t *task) Line 750  txBPFPacket(sched_task_t *task)
         rpc_func_t *f = NULL;          rpc_func_t *f = NULL;
         u_char *buf = AIT_GET_BUF(&c->cli_buf);          u_char *buf = AIT_GET_BUF(&c->cli_buf);
         struct tagRPCCall *rpc = (struct tagRPCCall*) buf;          struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
        int ret, len, wlen = sizeof(struct tagRPCCall);        int ret, wlen = sizeof(struct tagRPCCall);
         struct timespec ts = { DEF_RPC_TIMEOUT, 0 };          struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
         struct ether_header *eh;          struct ether_header *eh;
         ait_val_t b = AIT_VAL_INIT;          ait_val_t b = AIT_VAL_INIT;
Line 851  txBPFPacket(sched_task_t *task) Line 763  txBPFPacket(sched_task_t *task)
                 f = rpc_srv_getCall(s, ntohs(rpc->call_tag));                  f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
                 if (!f) {                  if (!f) {
                         rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");                          rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
   
                         rpc->call_argc ^= rpc->call_argc;                          rpc->call_argc ^= rpc->call_argc;
                        rpc->call_rep.ret = RPC_ERROR(-1);                        RPC_SET_RETURN(rpc, -1);
                        rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                        RPC_SET_ERRNO(rpc, rpc_Errno);
                } else {                } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
                        /* calc estimated length */                        rpc_SetErr(EMSGSIZE, "Message too long");
                        len = ait_resideVars(RPC_RETVARS(c)) + wlen; 
                        if (len > AIT_LEN(&c->cli_buf)) 
                                AIT_RE_BUF(&c->cli_buf, len); 
                        buf = AIT_GET_BUF(&c->cli_buf); 
                        rpc = (struct tagRPCCall*) buf; 
   
                           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));                          rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
                         /* Go Encapsulate variables */                          /* Go Encapsulate variables */
                         ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,                           ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
                                         RPC_RETVARS(c));                                          RPC_RETVARS(c));
                         /* Free return values */  
                         ait_freeVars(&RPC_RETVARS(c));  
                         if (ret == -1) {                          if (ret == -1) {
                                 rpc_SetErr(EBADRPC, "Prepare RPC packet failed");                                  rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
   
                                 rpc->call_argc ^= rpc->call_argc;                                  rpc->call_argc ^= rpc->call_argc;
                                rpc->call_rep.ret = RPC_ERROR(-1);                                RPC_SET_RETURN(rpc, -1);
                                rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                                RPC_SET_ERRNO(rpc, rpc_Errno);
                         } else                          } else
                                 wlen += ret;                                  wlen += ret;
                 }                  }
         }          }
   
           /* Free return values */
           ait_freeVars(&RPC_RETVARS(c));
   
         rpc->call_len = htonl(wlen);          rpc->call_len = htonl(wlen);
         rpc->call_io = RPC_ACK;          rpc->call_io = RPC_ACK;
   
Line 886  txBPFPacket(sched_task_t *task) Line 800  txBPFPacket(sched_task_t *task)
         rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));          rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2));
   
         /* send reply */          /* send reply */
        AIT_SET_BUF(&b, NULL, MIN(wlen, s->srv_netbuf) + ETHER_HDR_LEN);        AIT_SET_BUF(&b, NULL, wlen + ETHER_HDR_LEN);
         eh = (struct ether_header*) AIT_GET_BUF(&b);          eh = (struct ether_header*) AIT_GET_BUF(&b);
         memcpy(eh->ether_dhost, LLADDR(&c->cli_sa.sdl), ETHER_ADDR_LEN);          memcpy(eh->ether_dhost, LLADDR(&c->cli_sa.sdl), ETHER_ADDR_LEN);
         eh->ether_type = htons(RPC_DEFPORT);          eh->ether_type = htons(RPC_DEFPORT);
        memcpy(eh + 1, buf, MIN(wlen, s->srv_netbuf));        memcpy(eh + 1, buf, wlen);
   
         ret = write(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));          ret = write(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));
         AIT_FREE_VAL(&b);          AIT_FREE_VAL(&b);
Line 898  txBPFPacket(sched_task_t *task) Line 812  txBPFPacket(sched_task_t *task)
                 /* close connection */                  /* close connection */
                 schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],                   schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
                                 TASK_ARG(task), 0, NULL, 0);                                  TASK_ARG(task), 0, NULL, 0);
                 return NULL;  
         }          }
   
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 924  rxBPFPacket(sched_task_t *task) Line 837  rxBPFPacket(sched_task_t *task)
         h = (struct bpf_hdr*) AIT_GET_BUF(&b);          h = (struct bpf_hdr*) AIT_GET_BUF(&b);
         rlen -= h->bh_hdrlen;          rlen -= h->bh_hdrlen;
         if (rlen < h->bh_datalen || h->bh_caplen != h->bh_datalen ||           if (rlen < h->bh_datalen || h->bh_caplen != h->bh_datalen || 
                        rlen < ETHER_HDR_LEN + sizeof(struct tagRPCCall)) {                        rlen < ETHER_HDR_LEN + sizeof(struct tagRPCCall))
                rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); 
                 goto end;                  goto end;
        } else {        else {
                 rlen = h->bh_caplen;                  rlen = h->bh_caplen;
                 eh = (struct ether_header*) (AIT_GET_BUF(&b) + h->bh_hdrlen);                  eh = (struct ether_header*) (AIT_GET_BUF(&b) + h->bh_hdrlen);
                 rlen -= ETHER_HDR_LEN;                  rlen -= ETHER_HDR_LEN;
                 rpc = (struct tagRPCCall*) (eh + 1);                  rpc = (struct tagRPCCall*) (eh + 1);
   
 #if 0  
                 /* skip loop packet */  
                 if (rpc->call_io & RPC_ACK)  
                         goto end;  
 #endif  
   
                 if (eh->ether_type != ntohs(RPC_DEFPORT))                  if (eh->ether_type != ntohs(RPC_DEFPORT))
                         goto end;                          goto end;
                 else                  else
                         e_getlinkbymac((const ether_addr_t*) eh->ether_shost, &sa);                          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);          c = _allocClient(srv, &sa);
         if (!c) {          if (!c) {
                 EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");                  EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
                 usleep(2000);   /* blocked client delay */                  usleep(2000);   /* blocked client delay */
                 goto end;                  goto end;
         } else {          } else {
                 len = ntohl(rpc->call_len);  
                 if (len > AIT_LEN(&c->cli_buf))  
                         AIT_RE_BUF(&c->cli_buf, len);  
                 memcpy(AIT_GET_BUF(&c->cli_buf), rpc, len);                  memcpy(AIT_GET_BUF(&c->cli_buf), rpc, len);
                 rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);                  rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
   
Line 966  rxBPFPacket(sched_task_t *task) Line 891  rxBPFPacket(sched_task_t *task)
                                 c, ts, c, 0);                                  c, ts, c, 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");  
                 /* close connection */  
                 schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT],   
                                 c, 0, NULL, 0);  
                 goto end;  
         }  
   
         noreply = RPC_CHK_NOREPLY(rpc);          noreply = RPC_CHK_NOREPLY(rpc);
   
        /* check RPC packet session info */        /* execute RPC call */
        if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) {        schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
                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, c, (int) noreply, rpc, len);  
         }  
   
         /* send RPC reply */          /* send RPC reply */
         if (!noreply)          if (!noreply)
                 schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],                   schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], 
Line 998  rxBPFPacket(sched_task_t *task) Line 903  rxBPFPacket(sched_task_t *task)
 end:  end:
         AIT_FREE_VAL(&b);          AIT_FREE_VAL(&b);
         schedReadSelf(task);          schedReadSelf(task);
        return NULL;        taskExit(task, NULL);
 }  }
   
   
Line 1010  txEXTPacket(sched_task_t *task) Line 915  txEXTPacket(sched_task_t *task)
         rpc_func_t *f = NULL;          rpc_func_t *f = NULL;
         u_char *buf = AIT_GET_BUF(&c->cli_buf);          u_char *buf = AIT_GET_BUF(&c->cli_buf);
         struct tagRPCCall *rpc = (struct tagRPCCall*) buf;          struct tagRPCCall *rpc = (struct tagRPCCall*) buf;
        int ret, len, wlen = sizeof(struct tagRPCCall);        int ret, wlen = sizeof(struct tagRPCCall);
         struct timespec ts = { DEF_RPC_TIMEOUT, 0 };          struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
   
         schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);          schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL);
Line 1021  txEXTPacket(sched_task_t *task) Line 926  txEXTPacket(sched_task_t *task)
                 f = rpc_srv_getCall(s, ntohs(rpc->call_tag));                  f = rpc_srv_getCall(s, ntohs(rpc->call_tag));
                 if (!f) {                  if (!f) {
                         rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");                          rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server");
   
                         rpc->call_argc ^= rpc->call_argc;                          rpc->call_argc ^= rpc->call_argc;
                        rpc->call_rep.ret = RPC_ERROR(-1);                        RPC_SET_RETURN(rpc, -1);
                        rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                        RPC_SET_ERRNO(rpc, rpc_Errno);
                } else {                } else if (rpc_pktFreeSpace(c) > s->srv_netbuf) {
                        /* calc estimated length */                        rpc_SetErr(EMSGSIZE, "Message too long");
                        len = ait_resideVars(RPC_RETVARS(c)) + wlen; 
                        if (len > AIT_LEN(&c->cli_buf)) 
                                AIT_RE_BUF(&c->cli_buf, len); 
                        buf = AIT_GET_BUF(&c->cli_buf); 
                        rpc = (struct tagRPCCall*) buf; 
   
                           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));                          rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c));
                         /* Go Encapsulate variables */                          /* Go Encapsulate variables */
                         ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen,                           ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, 
                                         RPC_RETVARS(c));                                          RPC_RETVARS(c));
                         /* Free return values */  
                         ait_freeVars(&RPC_RETVARS(c));  
                         if (ret == -1) {                          if (ret == -1) {
                                 rpc_SetErr(EBADRPC, "Prepare RPC packet failed");                                  rpc_SetErr(EBADRPC, "Prepare RPC packet failed");
   
                                 rpc->call_argc ^= rpc->call_argc;                                  rpc->call_argc ^= rpc->call_argc;
                                rpc->call_rep.ret = RPC_ERROR(-1);                                RPC_SET_RETURN(rpc, -1);
                                rpc->call_rep.eno = RPC_ERROR(rpc_Errno);                                RPC_SET_ERRNO(rpc, rpc_Errno);
                         } else                          } else
                                 wlen += ret;                                  wlen += ret;
                 }                  }
         }          }
   
           /* Free return values */
           ait_freeVars(&RPC_RETVARS(c));
   
         rpc->call_len = htonl(wlen);          rpc->call_len = htonl(wlen);
         rpc->call_io = RPC_ACK;          rpc->call_io = RPC_ACK;
   
         /* send reply */          /* send reply */
        ret = write(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf));        ret = write(TASK_FD(task), buf, wlen);
         if (ret == -1) {          if (ret == -1) {
                 /* close connection */                  /* close connection */
                 schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT],                   schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], 
                                 TASK_ARG(task), 0, NULL, 0);                                  TASK_ARG(task), 0, NULL, 0);
                 return NULL;  
         }          }
   
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 1068  rxEXTPacket(sched_task_t *task) Line 974  rxEXTPacket(sched_task_t *task)
 {  {
         rpc_srv_t *srv = TASK_ARG(task);          rpc_srv_t *srv = TASK_ARG(task);
         rpc_cli_t *c = NULL;          rpc_cli_t *c = NULL;
        int len, rlen, noreply;        int len, noreply = 0, rlen = AIT_LEN(&c->cli_buf);
         struct tagRPCCall *rpc;          struct tagRPCCall *rpc;
         struct timespec ts = { DEF_RPC_TIMEOUT, 0 };          struct timespec ts = { DEF_RPC_TIMEOUT, 0 };
         ait_val_t b = AIT_VAL_INIT;  
         sockaddr_t sa;          sockaddr_t sa;
           ait_val_t b = AIT_VAL_INIT;
   
         memset(&sa, 0, sizeof sa);          memset(&sa, 0, sizeof sa);
         /* receive connect packet */          /* receive connect packet */
         AIT_SET_BUF(&b, NULL, srv->srv_netbuf);          AIT_SET_BUF(&b, NULL, srv->srv_netbuf);
         rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));          rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b));
        if (rlen < sizeof(struct tagRPCCall)) {        rpc = (struct tagRPCCall*) AIT_GET_BUF(&b);
                rpc_SetErr(ERPCMISMATCH, "Short RPC packet");        if (rlen < sizeof(struct tagRPCCall))
                 goto end;                  goto end;
        } else {        else
                rpc = (struct tagRPCCall*) AIT_GET_BUF(&b);                len = ntohl(rpc->call_len);
         if (rlen < len || len > srv->srv_netbuf)
                 goto end;
   
                /* skip loop packet */        /* skip loop packet */
                if (rpc->call_io & RPC_ACK)        if (rpc->call_io & RPC_ACK)
                        goto end;                goto end;
        } 
   
           /* check RPC packet session info */
           if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session))
                   goto end;
   
         c = _allocClient(srv, &sa);          c = _allocClient(srv, &sa);
         if (!c) {          if (!c) {
                 EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");                  EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n");
                 usleep(2000);   /* blocked client delay */                  usleep(2000);   /* blocked client delay */
                 goto end;                  goto end;
         } else {          } else {
                len = ntohl(rpc->call_len);                memcpy(AIT_GET_BUF(&c->cli_buf), AIT_GET_BUF(&b), len);
                if (len > AIT_LEN(&c->cli_buf)) 
                        AIT_RE_BUF(&c->cli_buf, len); 
                memcpy(AIT_GET_BUF(&c->cli_buf), rpc, AIT_LEN(&c->cli_buf)); 
                 rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);                  rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf);
   
                 c->cli_sock = TASK_FD(task);                  c->cli_sock = TASK_FD(task);
Line 1111  rxEXTPacket(sched_task_t *task) Line 1019  rxEXTPacket(sched_task_t *task)
   
         noreply = RPC_CHK_NOREPLY(rpc);          noreply = RPC_CHK_NOREPLY(rpc);
   
        /* check RPC packet session info */        /* execute RPC call */
        if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) {        schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len);
                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, c, (int) noreply, rpc, len);  
         }  
   
         /* send RPC reply */          /* send RPC reply */
         if (!noreply)          if (!noreply)
                 schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET],                   schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], 
Line 1130  rxEXTPacket(sched_task_t *task) Line 1029  rxEXTPacket(sched_task_t *task)
 end:  end:
         AIT_FREE_VAL(&b);          AIT_FREE_VAL(&b);
         schedReadSelf(task);          schedReadSelf(task);
        return NULL;        taskExit(task, NULL);
 }  }
   
 /* ------------------------------------------------------ */  /* ------------------------------------------------------ */
Line 1161  closeBLOBClient(sched_task_t *task) Line 1060  closeBLOBClient(sched_task_t *task)
         /* close client socket */          /* close client socket */
         shutdown(sock, SHUT_RDWR);          shutdown(sock, SHUT_RDWR);
         close(sock);          close(sock);
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 1178  txBLOB(sched_task_t *task) Line 1077  txBLOB(sched_task_t *task)
                 schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);                  schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);
         }          }
   
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 1195  rxBLOB(sched_task_t *task) Line 1094  rxBLOB(sched_task_t *task)
         if (rlen < 1) {          if (rlen < 1) {
                 /* close blob connection */                  /* close blob connection */
                 schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);                  schedEvent(TASK_ROOT(task), closeBLOBClient, c, 42, NULL, 0);
                return NULL;                taskExit(task, NULL);
         }          }
   
         /* check BLOB packet */          /* check BLOB packet */
Line 1203  rxBLOB(sched_task_t *task) Line 1102  rxBLOB(sched_task_t *task)
                 rpc_SetErr(ERPCMISMATCH, "Short BLOB packet");                  rpc_SetErr(ERPCMISMATCH, "Short BLOB packet");
   
                 schedReadSelf(task);                  schedReadSelf(task);
                return NULL;                taskExit(task, NULL);
         }          }
   
         /* check RPC packet session info */          /* check RPC packet session info */
Line 1219  rxBLOB(sched_task_t *task) Line 1118  rxBLOB(sched_task_t *task)
                         if (!(b = rpc_srv_getBLOB(s, ntohl(blob.hdr_var)))) {                          if (!(b = rpc_srv_getBLOB(s, ntohl(blob.hdr_var)))) {
                                 rpc_SetErr(EINVAL, "Var=%x not found", ntohl(blob.hdr_var));                                  rpc_SetErr(EINVAL, "Var=%x not found", ntohl(blob.hdr_var));
                                 blob.hdr_cmd = no;                                  blob.hdr_cmd = no;
                                blob.hdr_ret = RPC_ERROR(-1);                                RPC_SET_BLOB_RET(&blob, -1);
                                 break;                                  break;
                         } else                          } else
                                 blob.hdr_len = htonl(b->blob_len);                                  blob.hdr_len = htonl(b->blob_len);
Line 1230  rxBLOB(sched_task_t *task) Line 1129  rxBLOB(sched_task_t *task)
                                 rpc_srv_blobUnmap(b);                                  rpc_srv_blobUnmap(b);
                         } else {                          } else {
                                 blob.hdr_cmd = error;                                  blob.hdr_cmd = error;
                                blob.hdr_ret = RPC_ERROR(-1);                                RPC_SET_BLOB_RET(&blob, -1);
                         }                          }
                         break;                          break;
                 case set:                  case set:
Line 1244  rxBLOB(sched_task_t *task) Line 1143  rxBLOB(sched_task_t *task)
                                 rpc_srv_blobUnmap(b);                                  rpc_srv_blobUnmap(b);
                         } else {                          } else {
                                 blob.hdr_cmd = error;                                  blob.hdr_cmd = error;
                                blob.hdr_ret = RPC_ERROR(-1);                                RPC_SET_BLOB_RET(&blob, -1);
                         }                          }
                         break;                          break;
                 case unset:                  case unset:
                         if (rpc_srv_unregisterBLOB(s, ntohl(blob.hdr_var)) == -1) {                          if (rpc_srv_unregisterBLOB(s, ntohl(blob.hdr_var)) == -1) {
                                 blob.hdr_cmd = error;                                  blob.hdr_cmd = error;
                                blob.hdr_ret = RPC_ERROR(-1);                                RPC_SET_BLOB_RET(&blob, -1);
                         }                          }
                         break;                          break;
                 default:                  default:
                         rpc_SetErr(EPROCUNAVAIL, "Unsupported BLOB command %d", blob.hdr_cmd);                          rpc_SetErr(EPROCUNAVAIL, "Unsupported BLOB command %d", blob.hdr_cmd);
                         blob.hdr_cmd = error;                          blob.hdr_cmd = error;
                        blob.hdr_ret = RPC_ERROR(-1);                        RPC_SET_BLOB_RET(&blob, -1);
         }          }
   
 end:  end:
         memcpy(AIT_ADDR(&c->cli_buf), &blob, sizeof blob);          memcpy(AIT_ADDR(&c->cli_buf), &blob, sizeof blob);
         schedWrite(TASK_ROOT(task), txBLOB, TASK_ARG(task), TASK_FD(task), NULL, 0);          schedWrite(TASK_ROOT(task), txBLOB, TASK_ARG(task), TASK_FD(task), NULL, 0);
         schedReadSelf(task);          schedReadSelf(task);
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 1291  flushBLOB(sched_task_t *task) Line 1190  flushBLOB(sched_task_t *task)
                 sigaction(SIGFBLOB, &sa, NULL);                  sigaction(SIGFBLOB, &sa, NULL);
         }          }
   
        return NULL;        taskExit(task, NULL);
 }  }
   
 static void *  static void *
Line 1322  acceptBLOBClients(sched_task_t *task) Line 1221  acceptBLOBClients(sched_task_t *task)
         if (!c) {          if (!c) {
                 LOGERR;                  LOGERR;
                 srv->srv_kill = srv->srv_blob.kill = 1;                  srv->srv_kill = srv->srv_blob.kill = 1;
                return NULL;                taskExit(task, NULL);
         } else {          } else {
                 memset(c, 0, sizeof(rpc_cli_t));                  memset(c, 0, sizeof(rpc_cli_t));
                 array_Set(srv->srv_blob.clients, i, c);                  array_Set(srv->srv_blob.clients, i, c);
Line 1350  acceptBLOBClients(sched_task_t *task) Line 1249  acceptBLOBClients(sched_task_t *task)
         schedRead(TASK_ROOT(task), rxBLOB, c, c->cli_sock, NULL, 0);          schedRead(TASK_ROOT(task), rxBLOB, c, c->cli_sock, NULL, 0);
 end:  end:
         schedReadSelf(task);          schedReadSelf(task);
        return NULL;        taskExit(task, NULL);
 }  }
   
 /* ------------------------------------------------------ */  /* ------------------------------------------------------ */
Line 1655  rpc_srv_initServer(u_char InstID, int concurentClients Line 1554  rpc_srv_initServer(u_char InstID, int concurentClients
                 LOGERR;                  LOGERR;
                 goto err;                  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;          n = srv->srv_netbuf;
         if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {          if (setsockopt(srv->srv_server.cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
                 LOGERR;                  LOGERR;
Removed from v.1.26.2.4  
changed lines
  Added in v.1.26.2.11

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