resend.c revision 161357 
1/*	$FreeBSD: head/contrib/ipfilter/ipsend/resend.c 161357 2006-08-16 12:23:02Z guido $	*/
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: resend.c,v 2.8.2.2 2006/03/17 13:45:34 darrenr Exp $";
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
38static	u_char	pbuf[65536];	/* 1 big packet */
39void	printpacket __P((ip_t *));
40
41
42void printpacket(ip)
43ip_t	*ip;
44{
45	tcphdr_t *t;
46	int i, j;
47
48	t = (tcphdr_t *)((char *)ip + (IP_HL(ip) << 2));
49	if (ip->ip_tos)
50		printf("tos %#x ", ip->ip_tos);
51	if (ip->ip_off & 0x3fff)
52		printf("frag @%#x ", (ip->ip_off & 0x1fff) << 3);
53	printf("len %d id %d ", ip->ip_len, ip->ip_id);
54	printf("ttl %d p %d src %s", ip->ip_ttl, ip->ip_p,
55		inet_ntoa(ip->ip_src));
56	if (ip->ip_p == IPPROTO_TCP || ip->ip_p == IPPROTO_UDP)
57		printf(",%d", t->th_sport);
58	printf(" dst %s", inet_ntoa(ip->ip_dst));
59	if (ip->ip_p == IPPROTO_TCP || ip->ip_p == IPPROTO_UDP)
60		printf(",%d", t->th_dport);
61	if (ip->ip_p == IPPROTO_TCP) {
62		printf(" seq %lu:%lu flags ",
63			(u_long)t->th_seq, (u_long)t->th_ack);
64		for (j = 0, i = 1; i < 256; i *= 2, j++)
65			if (t->th_flags & i)
66				printf("%c", "FSRPAU--"[j]);
67	}
68	putchar('\n');
69}
70
71
72int	ip_resend(dev, mtu, r, gwip, datain)
73char	*dev;
74int	mtu;
75struct	in_addr	gwip;
76struct	ipread	*r;
77char	*datain;
78{
79	ether_header_t	*eh;
80	char	dhost[6];
81	ip_t	*ip;
82	int	fd, wfd = initdevice(dev, 5), len, i;
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 *)pbuf;
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)((char *)pbuf, sizeof(pbuf), 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			printpacket(ip);
132		} else {
133			eh = (ether_header_t *)pbuf;
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