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