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

Diff for /ansh/src/utils.c between versions 1.1.1.1.2.5 and 1.1.1.1.2.11

version 1.1.1.1.2.5, 2011/10/13 11:01:37 version 1.1.1.1.2.11, 2011/10/14 12:03:10
Line 5 Line 5
  * $Author$   * $Author$
  * $Id$   * $Id$
  *   *
 *************************************************************************/ *************************************************************************
 The ELWIX and AITNET software is distributed under the following
 terms:
 
 All of the documentation and software included in the ELWIX and AITNET
 Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
 
 Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011
         by Michael Pounov <misho@elwix.org>.  All rights reserved.
 
 Redistribution and use in source and binary forms, with or without
 modification, are permitted provided that the following conditions
 are met:
 1. Redistributions of source code must retain the above copyright
    notice, this list of conditions and the following disclaimer.
 2. Redistributions in binary form must reproduce the above copyright
    notice, this list of conditions and the following disclaimer in the
    documentation and/or other materials provided with the distribution.
 3. All advertising materials mentioning features or use of this software
    must display the following acknowledgement:
 This product includes software developed by Michael Pounov <misho@elwix.org>
 ELWIX - Embedded LightWeight unIX and its contributors.
 4. Neither the name of AITNET nor the names of its contributors
    may be used to endorse or promote products derived from this software
    without specific prior written permission.
 
 THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND
 ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 SUCH DAMAGE.
 */
 #include "global.h"  #include "global.h"
   
   
Line 60  PrepareL2(const char *psDev, int *bpflen) Line 97  PrepareL2(const char *psDev, int *bpflen)
                 close(h);                  close(h);
                 return -1;                  return -1;
         }          }
           n = USHRT_MAX + 1;
           if (ioctl(h, BIOCSBLEN, &n) == -1) {
                   printf("Error:: set buffer interface %s buffer length #%d - %s\n", psDev, errno, strerror(errno));
                   close(h);
                   return -1;
           }
         strlcpy(ifr.ifr_name, psDev, sizeof ifr.ifr_name);          strlcpy(ifr.ifr_name, psDev, sizeof ifr.ifr_name);
         if (ioctl(h, BIOCSETIF, &ifr) == -1) {          if (ioctl(h, BIOCSETIF, &ifr) == -1) {
                 printf("Error:: bind interface %s to bpf #%d - %s\n", psDev, errno, strerror(errno));                  printf("Error:: bind interface %s to bpf #%d - %s\n", psDev, errno, strerror(errno));
Line 72  PrepareL2(const char *psDev, int *bpflen) Line 115  PrepareL2(const char *psDev, int *bpflen)
                 return -1;                  return -1;
         }          }
         if (ioctl(h, BIOCGBLEN, bpflen) == -1) {          if (ioctl(h, BIOCGBLEN, bpflen) == -1) {
                printf("Error:: get interface %s buffer length #%d - %s\n", psDev, errno, strerror(errno));                printf("Error:: get buffer interface %s buffer length #%d - %s\n", psDev, errno, strerror(errno));
                 close(h);                  close(h);
                 return -1;                  return -1;
         }          }
   
         /*  
         n = fcntl(h, F_GETFL);          n = fcntl(h, F_GETFL);
         fcntl(h, F_SETFL, n | O_NONBLOCK);          fcntl(h, F_SETFL, n | O_NONBLOCK);
         */  
   
         VERB(3) LOG("Openned device handle %d with bpf buflen %d", h, *bpflen);          VERB(3) LOG("Openned device handle %d with bpf buflen %d", h, *bpflen);
         return h;          return h;
Line 121  PrepareL3(const struct sockaddr *sa, int *bpflen) Line 162  PrepareL3(const struct sockaddr *sa, int *bpflen)
 }  }
   
 char  char
icmpRecv(int s, u_short * __restrict id, u_int * __restrict crypted, u_char * __restrict data, icmpRecv(int s, u_int * __restrict seq, u_short * __restrict id, u_int * __restrict crypted, 
                int * __restrict datlen, struct sockaddr *sa, socklen_t *salen)                u_char * __restrict data, int * __restrict datlen, struct sockaddr *sa, socklen_t *salen)
 {  {
         int ret = 0;          int ret = 0;
         struct icmp *icmp;          struct icmp *icmp;
Line 185  icmpRecv(int s, u_short * __restrict id, u_int * __res Line 226  icmpRecv(int s, u_short * __restrict id, u_int * __res
                 memcpy(data, buf + sizeof(struct ip) + sizeof(struct icmp) + sizeof(struct ansh_hdr), *datlen);                  memcpy(data, buf + sizeof(struct ip) + sizeof(struct icmp) + sizeof(struct ansh_hdr), *datlen);
         }          }
   
           if (seq)
                   *seq = ntohl(hdr->ansh_seq);
         if (id)          if (id)
                 *id = ntohs(icmp->icmp_id);                  *id = ntohs(icmp->icmp_id);
         return hdr->ansh_flg;          return hdr->ansh_flg;
 }  }
   
 int  int
icmpSend(int s, u_short id, char flg, u_int crypted, u_char *data, int datlen, struct sockaddr *sa, socklen_t salen)icmpSend(int s, u_int seq, u_short id, char flg, u_int crypted, u_char *data, int datlen, 
                 struct sockaddr *sa, socklen_t salen)
 {  {
         u_char *pos, buf[USHRT_MAX] = { 0 };          u_char *pos, buf[USHRT_MAX] = { 0 };
         struct icmp *icmp;          struct icmp *icmp;
Line 212  icmpSend(int s, u_short id, char flg, u_int crypted, u Line 256  icmpSend(int s, u_short id, char flg, u_int crypted, u
         hdr->ansh_flg = flg;          hdr->ansh_flg = flg;
         hdr->ansh_len = htons(datlen + sizeof(struct ansh_hdr));          hdr->ansh_len = htons(datlen + sizeof(struct ansh_hdr));
         hdr->ansh_nonce = htonl(crypted);          hdr->ansh_nonce = htonl(crypted);
           hdr->ansh_seq = htonl(seq);
         hdr->ansh_crc = 0;          hdr->ansh_crc = 0;
         hdr->ansh_crc = htonl(crcAdler((u_char*) hdr, ntohs(hdr->ansh_len)));          hdr->ansh_crc = htonl(crcAdler((u_char*) hdr, ntohs(hdr->ansh_len)));
   
Line 230  icmpSend(int s, u_short id, char flg, u_int crypted, u Line 275  icmpSend(int s, u_short id, char flg, u_int crypted, u
                 VERB(4) LOG("Put packet with len=%d", ret);                  VERB(4) LOG("Put packet with len=%d", ret);
         if (ret != sizeof(struct icmp) + sizeof(struct ansh_hdr) + datlen) {          if (ret != sizeof(struct icmp) + sizeof(struct ansh_hdr) + datlen) {
                 VERB(3) LOG("Sended data %d is different from source data len %d", ret,                   VERB(3) LOG("Sended data %d is different from source data len %d", ret, 
                                sizeof(struct icmp) + sizeof(struct ansh_hdr) + datlen);                                (int) (sizeof(struct icmp) + sizeof(struct ansh_hdr) + datlen));
                 return ANSH_FLG_ERR;                  return ANSH_FLG_ERR;
         }          }
   
Line 238  icmpSend(int s, u_short id, char flg, u_int crypted, u Line 283  icmpSend(int s, u_short id, char flg, u_int crypted, u
 }  }
   
 static int  static int
_pkt_Send(int s, char flg, u_int crypted, u_char *data, int datlen, struct ether_addr *ea)_pkt_Send(int s, u_int seq, char flg, u_int crypted, u_char *data, int datlen, struct io_ether_addr *ea)
 {  {
         u_char *pos, buf[USHRT_MAX] = { 0 };          u_char *pos, buf[USHRT_MAX] = { 0 };
         struct ether_header *e = (struct ether_header*) buf;          struct ether_header *e = (struct ether_header*) buf;
Line 250  _pkt_Send(int s, char flg, u_int crypted, u_char *data Line 295  _pkt_Send(int s, char flg, u_int crypted, u_char *data
                 return ANSH_FLG_ERR;                  return ANSH_FLG_ERR;
   
         e->ether_type = ntohs(ANSH_ID);          e->ether_type = ntohs(ANSH_ID);
        memcpy(e->ether_dhost, ea->octet, ETHER_ADDR_LEN);        memcpy(e->ether_dhost, ea->ether_addr_octet, ETHER_ADDR_LEN);
         hdr = (struct ansh_hdr*) (buf + ETHER_HDR_LEN);          hdr = (struct ansh_hdr*) (buf + ETHER_HDR_LEN);
         pos = ((u_char*) hdr) + sizeof(struct ansh_hdr);          pos = ((u_char*) hdr) + sizeof(struct ansh_hdr);
   
Line 260  _pkt_Send(int s, char flg, u_int crypted, u_char *data Line 305  _pkt_Send(int s, char flg, u_int crypted, u_char *data
         hdr->ansh_flg = flg;          hdr->ansh_flg = flg;
         hdr->ansh_len = htons(datlen + sizeof(struct ansh_hdr));          hdr->ansh_len = htons(datlen + sizeof(struct ansh_hdr));
         hdr->ansh_nonce = htonl(crypted);          hdr->ansh_nonce = htonl(crypted);
           hdr->ansh_seq = htonl(seq);
         hdr->ansh_crc = 0;          hdr->ansh_crc = 0;
         hdr->ansh_crc = htonl(crcAdler((u_char*) hdr, ntohs(hdr->ansh_len)));          hdr->ansh_crc = htonl(crcAdler((u_char*) hdr, ntohs(hdr->ansh_len)));
   
Line 270  _pkt_Send(int s, char flg, u_int crypted, u_char *data Line 316  _pkt_Send(int s, char flg, u_int crypted, u_char *data
                 VERB(4) LOG("Put packet with len=%d", ret);                  VERB(4) LOG("Put packet with len=%d", ret);
         if (ret != ETHER_HDR_LEN + sizeof(struct ansh_hdr) + datlen) {          if (ret != ETHER_HDR_LEN + sizeof(struct ansh_hdr) + datlen) {
                 VERB(3) LOG("Sended data %d is different from source data len %d", ret,                   VERB(3) LOG("Sended data %d is different from source data len %d", ret, 
                                ETHER_HDR_LEN + sizeof(struct ansh_hdr) + datlen);                                (int) (ETHER_HDR_LEN + sizeof(struct ansh_hdr) + datlen));
                 return ANSH_FLG_ERR;                  return ANSH_FLG_ERR;
         }          }
   
Line 278  _pkt_Send(int s, char flg, u_int crypted, u_char *data Line 324  _pkt_Send(int s, char flg, u_int crypted, u_char *data
 }  }
   
 int  int
pktSend(int s, char flg, u_int crypted, u_char *data, int datlen, struct ether_addr *ea)pktSend(int s, u_int seq, char flg, u_int crypted, u_char *data, int datlen, struct io_ether_addr *ea)
 {  {
         int wlen, ret = 0;          int wlen, ret = 0;
         u_char *pos = data;          u_char *pos = data;
   
         while (datlen > -1) {          while (datlen > -1) {
                wlen = _pkt_Send(s, flg, crypted, pos, (datlen > 512) ? 512 : datlen, ea);                wlen = _pkt_Send(s, seq, flg, crypted, pos, (datlen > 512) ? 512 : datlen, ea);
                 if (wlen == -1)                  if (wlen == -1)
                         return -1;                          return -1;
                 else {                  else {
Line 298  pktSend(int s, char flg, u_int crypted, u_char *data,  Line 344  pktSend(int s, char flg, u_int crypted, u_char *data, 
 }  }
   
 static char  static char
_pkt_Recv(u_char * __restrict buf, int rlen, u_int * __restrict crypted, _pkt_Recv(u_char * __restrict buf, int rlen, u_int * __restrict seq, u_int * __restrict crypted, 
                 u_char * __restrict data, int * __restrict datlen,                   u_char * __restrict data, int * __restrict datlen, 
                 u_char ** __restrict next, int * __restrict nextlen)                  u_char ** __restrict next, int * __restrict nextlen)
 {  {
Line 357  _pkt_Recv(u_char * __restrict buf, int rlen, u_int * _ Line 403  _pkt_Recv(u_char * __restrict buf, int rlen, u_int * _
                 memcpy(data, buf + bpf->bh_hdrlen + ETHER_HDR_LEN + sizeof(struct ansh_hdr), *datlen);                  memcpy(data, buf + bpf->bh_hdrlen + ETHER_HDR_LEN + sizeof(struct ansh_hdr), *datlen);
         }          }
   
           if (seq)
                   *seq = ntohl(hdr->ansh_seq);
         return hdr->ansh_flg;          return hdr->ansh_flg;
 }  }
   
 char  char
pktRecv(int s, u_int * __restrict crypted, u_char * __restrict data, int * __restrict datlen, pktRecv(int s, u_int * __restrict seq, u_int * __restrict crypted, u_char * __restrict data, 
                struct ether_header *eth)                int * __restrict datlen, struct ether_header *eth)
 {  {
        u_char *buf, *next, *pos, *ptr;        u_char *buf, *next, *ptr, *pos = data;
         int nextlen, rlen, buflen, ptrlen;          int nextlen, rlen, buflen, ptrlen;
         char flg;          char flg;
         struct bpf_hdr *bpf;          struct bpf_hdr *bpf;
         struct ether_header *e;          struct ether_header *e;
   
        if (!eth || !datlen)        if (!eth || !data || !datlen)
                 return ANSH_FLG_ERR;                  return ANSH_FLG_ERR;
           else
                   memset(data, 0, *datlen);
   
         if (!(buf = malloc(*datlen))) {          if (!(buf = malloc(*datlen))) {
                 ERR("malloc() #%d - %s", errno, strerror(errno));                  ERR("malloc() #%d - %s", errno, strerror(errno));
Line 399  pktRecv(int s, u_int * __restrict crypted, u_char * __ Line 449  pktRecv(int s, u_int * __restrict crypted, u_char * __
   
         ptr = next = buf;          ptr = next = buf;
         ptrlen = nextlen = rlen;          ptrlen = nextlen = rlen;
        pos = data;             if ((flg = _pkt_Recv(ptr, ptrlen, seq, crypted, pos, &buflen, &next, &nextlen)) == -1) {
        buflen = *datlen; 
        if ((flg = _pkt_Recv(ptr, ptrlen, crypted, pos, &buflen, &next, &nextlen)) == -1) { 
                 free(buf);                  free(buf);
                 return ANSH_FLG_ERR;                  return ANSH_FLG_ERR;
         } else {          } else {
Line 410  pktRecv(int s, u_int * __restrict crypted, u_char * __ Line 458  pktRecv(int s, u_int * __restrict crypted, u_char * __
                 ptr = next;                  ptr = next;
                 ptrlen = nextlen;                  ptrlen = nextlen;
         }          }
           /* get additional packets from buffer */
         while (next && nextlen > 0)          while (next && nextlen > 0)
                if (_pkt_Recv(ptr, ptrlen, crypted, pos, &buflen, &next, &nextlen) == -1)                if (_pkt_Recv(ptr, ptrlen, seq, crypted, pos, &buflen, &next, &nextlen) == -1)
                         break;                          break;
                 else {                  else {
                         pos += buflen;                          pos += buflen;
Line 421  pktRecv(int s, u_int * __restrict crypted, u_char * __ Line 470  pktRecv(int s, u_int * __restrict crypted, u_char * __
                 }                  }
   
         free(buf);          free(buf);
   
         return flg;          return flg;
 }  }
   
Line 457  cryptBuffer(u_char *buf, int rlen, u_int ctr) Line 507  cryptBuffer(u_char *buf, int rlen, u_int ctr)
         memcpy(ivec + 8, &ctr, sizeof ctr);          memcpy(ivec + 8, &ctr, sizeof ctr);
         memcpy(ivec + 12, &rctr, sizeof rctr);          memcpy(ivec + 12, &rctr, sizeof rctr);
   
        if (io_ctr_AES(buf, rlen, &str, (u_char*) "_ansh_ELWIX_", ivec) == -1)        if (io_ctr_AES(buf, rlen, &str, (u_char*) Key, ivec) == -1)
                 return NULL;                  return NULL;
   
         return str;          return str;
   }
   
   int
   stopProcess(sched_root_task_t * __restrict root, proc_head_t * __restrict h, pid_t pid, sched_task_func_t func)
   {
           struct tagProc *p;
   
           FTRACE(3);
   
           SLIST_FOREACH(p, h, proc_next)
                   if (p->proc_pid == pid) {
                           break;
                   }
           if (!p)
                   return 1;
   
           ioFreePTY(p->proc_pty, p->proc_ttyname);
           schedCancelby(root, NULL, CRITERIA_FD, (void*) ((intptr_t) p->proc_pty), NULL);
   
           p->proc_pid = 0;
           p->proc_seq = 0;
           p->proc_flg = ANSH_FLG_EOF;
           p->proc_rlen_[FD2NET] = 0;
   
           schedCallOnce(root, func, p, p->proc_sock);
           return 0;
 }  }
Removed from v.1.1.1.1.2.5  
changed lines
  Added in v.1.1.1.1.2.11

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