contrib/ipfilter/ipsend/resend.c

   1 /*      $FreeBSD$       */
   2
   3 /*
   4  * resend.c (C) 1995-1998 Darren Reed
   5  *
   6  * See the IPFILTER.LICENCE file for details on licencing.
   7  *
   8  */
   9 #if !defined(lint)
  10 static const char sccsid[] = "@(#)resend.c      1.3 1/11/96 (C)1995 Darren Reed";
  11 static const char rcsid[] = "@(#)$Id$";
  12 #endif
  13 #include <sys/param.h>
  14 #include <sys/types.h>
  15 #include <sys/time.h>
  16 #include <sys/socket.h>
  17 #include <net/if.h>
  18 #include <netinet/in.h>
  19 #include <arpa/inet.h>
  20 #include <netinet/in_systm.h>
  21 #include <netinet/ip.h>
  22 # include <netinet/ip_var.h>
  23 # include <netinet/if_ether.h>
  24 #include <stdio.h>
  25 #include <netdb.h>
  26 #include <string.h>
  27 #include <stdlib.h>
  28 #include <unistd.h>
  29 #include "ipsend.h"
  30
  31 extern  int     opts;
  32
  33 void    dumppacket __P((ip_t *));
  34
  35
  36 void dumppacket(ip)
  37         ip_t    *ip;
  38 {
  39         tcphdr_t *t;
  40         int i, j;
  41
  42         t = (tcphdr_t *)((char *)ip + (IP_HL(ip) << 2));
  43         if (ip->ip_tos)
  44                 printf("tos %#x ", ip->ip_tos);
  45         if (ip->ip_off & 0x3fff)
  46                 printf("frag @%#x ", (ip->ip_off & 0x1fff) << 3);
  47         printf("len %d id %d ", ip->ip_len, ip->ip_id);
  48         printf("ttl %d p %d src %s", ip->ip_ttl, ip->ip_p,
  49                 inet_ntoa(ip->ip_src));
  50         if (ip->ip_p == IPPROTO_TCP || ip->ip_p == IPPROTO_UDP)
  51                 printf(",%d", t->th_sport);
  52         printf(" dst %s", inet_ntoa(ip->ip_dst));
  53         if (ip->ip_p == IPPROTO_TCP || ip->ip_p == IPPROTO_UDP)
  54                 printf(",%d", t->th_dport);
  55         if (ip->ip_p == IPPROTO_TCP) {
  56                 printf(" seq %lu:%lu flags ",
  57                         (u_long)t->th_seq, (u_long)t->th_ack);
  58                 for (j = 0, i = 1; i < 256; i *= 2, j++)
  59                         if (t->th_flags & i)
  60                                 printf("%c", "FSRPAU--"[j]);
  61         }
  62         putchar('\n');
  63 }
  64
  65
  66 int     ip_resend(dev, mtu, r, gwip, datain)
  67         char    *dev;
  68         int     mtu;
  69         struct  in_addr gwip;
  70         struct  ipread  *r;
  71         char    *datain;
  72 {
  73         ether_header_t  *eh;
  74         char    dhost[6];
  75         ip_t    *ip;
  76         int     fd, wfd = initdevice(dev, 5), len, i;
  77         mb_t    mb;
  78
  79         if (wfd == -1)
  80                 return -1;
  81
  82         if (datain)
  83                 fd = (*r->r_open)(datain);
  84         else
  85                 fd = (*r->r_open)("-");
  86
  87         if (fd < 0)
  88                 exit(-1);
  89
  90         ip = (struct ip *)mb.mb_buf;
  91         eh = (ether_header_t *)malloc(sizeof(*eh));
  92         if(!eh)
  93             {
  94                 perror("malloc failed");
  95                 return -2;
  96             }
  97
  98         bzero((char *) &eh->ether_shost, sizeof(eh->ether_shost));
  99         if (gwip.s_addr && (arp((char *)&gwip, dhost) == -1))
 100             {
 101                 perror("arp");
 102                 free(eh);
 103                 return -2;
 104             }
 105
 106         while ((i = (*r->r_readip)(&mb, NULL, NULL)) > 0)
 107             {
 108                 if (!(opts & OPT_RAW)) {
 109                         len = ntohs(ip->ip_len);
 110                         eh = (ether_header_t *)realloc((char *)eh, sizeof(*eh) + len);
 111                         eh->ether_type = htons((u_short)ETHERTYPE_IP);
 112                         if (!gwip.s_addr) {
 113                                 if (arp((char *)&gwip,
 114                                         (char *) &eh->ether_dhost) == -1) {
 115                                         perror("arp");
 116                                         continue;
 117                                 }
 118                         } else
 119                                 bcopy(dhost, (char *) &eh->ether_dhost,
 120                                       sizeof(dhost));
 121                         if (!ip->ip_sum)
 122                                 ip->ip_sum = chksum((u_short *)ip,
 123                                                     IP_HL(ip) << 2);
 124                         bcopy(ip, (char *)(eh + 1), len);
 125                         len += sizeof(*eh);
 126                         dumppacket(ip);
 127                 } else {
 128                         eh = (ether_header_t *)mb.mb_buf;
 129                         len = i;
 130                 }
 131
 132                 if (sendip(wfd, (char *)eh, len) == -1)
 133                     {
 134                         perror("send_packet");
 135                         break;
 136                     }
 137             }
 138         (*r->r_close)();
 139         free(eh);
 140         return 0;
 141 }