contrib/ipfilter/ipsend/sbpf.c

   1 /* $FreeBSD$ */
   2 /*
   3  * (C)opyright 1995-1998 Darren Reed. (from tcplog)
   4  *
   5  * See the IPFILTER.LICENCE file for details on licencing.
   6  *
   7  */
   8 #include <sys/param.h>
   9 #include <sys/types.h>
  10 #include <sys/mbuf.h>
  11 #include <sys/time.h>
  12 #include <sys/timeb.h>
  13 #include <sys/socket.h>
  14 #include <sys/file.h>
  15 #include <sys/ioctl.h>
  16 #if BSD < 199103
  17 #include <sys/fcntlcom.h>
  18 #endif
  19 #if (__FreeBSD_version >= 300000)
  20 # include <sys/dirent.h>
  21 #else
  22 # include <sys/dir.h>
  23 #endif
  24 #include <net/bpf.h>
  25
  26 #include <net/if.h>
  27 #include <netinet/in.h>
  28 #include <netinet/in_systm.h>
  29 #include <netinet/ip.h>
  30 #include <netinet/ip_var.h>
  31 #include <netinet/udp.h>
  32 #include <netinet/udp_var.h>
  33 #include <netinet/tcp.h>
  34
  35 #include <stdio.h>
  36 #include <netdb.h>
  37 #include <string.h>
  38 #include <unistd.h>
  39 #include <stdlib.h>
  40 #include <ctype.h>
  41 #include <signal.h>
  42 #include <errno.h>
  43
  44 #include "ipsend.h"
  45
  46 #if !defined(lint)
  47 static const char sccsid[] = "@(#)sbpf.c        1.3 8/25/95 (C)1995 Darren Reed";
  48 static const char rcsid[] = "@(#)$Id: sbpf.c,v 2.5 2002/02/24 07:30:03 darrenr Exp $";
  49 #endif
  50
  51 /*
  52  * the code herein is dervied from libpcap.
  53  */
  54 static  u_char  *buf = NULL;
  55 static  int     bufsize = 0, timeout = 1;
  56
  57
  58 int     initdevice(device, tout)
  59 char    *device;
  60 int     tout;
  61 {
  62         struct  bpf_version bv;
  63         struct  timeval to;
  64         struct  ifreq ifr;
  65         char    bpfname[16];
  66         int     fd = 0, i;
  67
  68         for (i = 0; i < 16; i++)
  69             {
  70                 (void) sprintf(bpfname, "/dev/bpf%d", i);
  71                 if ((fd = open(bpfname, O_RDWR)) >= 0)
  72                         break;
  73             }
  74         if (i == 16)
  75             {
  76                 fprintf(stderr, "no bpf devices available as /dev/bpfxx\n");
  77                 return -1;
  78             }
  79
  80         if (ioctl(fd, BIOCVERSION, (caddr_t)&bv) < 0)
  81             {
  82                 perror("BIOCVERSION");
  83                 return -1;
  84             }
  85         if (bv.bv_major != BPF_MAJOR_VERSION ||
  86             bv.bv_minor < BPF_MINOR_VERSION)
  87             {
  88                 fprintf(stderr, "kernel bpf (v%d.%d) filter out of date:\n",
  89                         bv.bv_major, bv.bv_minor);
  90                 fprintf(stderr, "current version: %d.%d\n",
  91                         BPF_MAJOR_VERSION, BPF_MINOR_VERSION);
  92                 return -1;
  93             }
  94
  95         (void) strncpy(ifr.ifr_name, device, sizeof(ifr.ifr_name));
  96         if (ioctl(fd, BIOCSETIF, &ifr) == -1)
  97             {
  98                 fprintf(stderr, "%s(%d):", ifr.ifr_name, fd);
  99                 perror("BIOCSETIF");
 100                 exit(1);
 101             }
 102         /*
 103          * get kernel buffer size
 104          */
 105         if (ioctl(fd, BIOCGBLEN, &bufsize) == -1)
 106             {
 107                 perror("BIOCSBLEN");
 108                 exit(-1);
 109             }
 110         buf = (u_char*)malloc(bufsize);
 111         /*
 112          * set the timeout
 113          */
 114         timeout = tout;
 115         to.tv_sec = 1;
 116         to.tv_usec = 0;
 117         if (ioctl(fd, BIOCSRTIMEOUT, (caddr_t)&to) == -1)
 118             {
 119                 perror("BIOCSRTIMEOUT");
 120                 exit(-1);
 121             }
 122
 123         (void) ioctl(fd, BIOCFLUSH, 0);
 124         return fd;
 125 }
 126
 127
 128 /*
 129  * output an IP packet onto a fd opened for /dev/bpf
 130  */
 131 int     sendip(fd, pkt, len)
 132 int     fd, len;
 133 char    *pkt;
 134 {
 135         if (write(fd, pkt, len) == -1)
 136             {
 137                 perror("send");
 138                 return -1;
 139             }
 140
 141         return len;
 142 }