1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
|
/*
* mod_ip_opt.c
*
* Copyright (c) 2001 Dug Song <dugsong@monkey.org>
*
* $Id: mod_ip_opt.c,v 1.7 2002/04/07 22:55:20 dugsong Exp $
*/
#include "config.h"
#include <err.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "pkt.h"
#include "mod.h"
void *
ip_opt_close(void *d)
{
if (d != NULL)
free(d);
return (NULL);
}
void *
ip_opt_open(int argc, char *argv[])
{
struct ip_opt *opt;
struct addr addr;
int i, j;
if (argc < 4)
return (NULL);
if ((opt = calloc(1, sizeof(*opt))) == NULL)
return (NULL);
if (strcasecmp(argv[1], "lsrr") == 0) {
opt->opt_type = IP_OPT_LSRR;
} else if (strcasecmp(argv[1], "ssrr") == 0) {
opt->opt_type = IP_OPT_SSRR;
} else
return (ip_opt_close(opt));
if ((i = atoi(argv[2])) < 4 || i > 0xff) {
warnx("<ptr> must be >= 4, and should be a multiple of 4");
return (ip_opt_close(opt));
}
opt->opt_data.rr.ptr = i;
for (i = 3, j = 0; i < argc && j < 9; i++, j++) {
if (addr_aton(argv[i], &addr) < 0) {
return (ip_opt_close(opt));
}
opt->opt_data.rr.iplist[j] = addr.addr_ip;
}
opt->opt_len = IP_OPT_LEN + 1 + (IP_ADDR_LEN * j);
return (opt);
}
int
ip_opt_apply(void *d, struct pktq *pktq)
{
struct ip_opt *opt = (struct ip_opt *)d;
struct pkt *pkt;
size_t len;
TAILQ_FOREACH(pkt, pktq, pkt_next) {
len = ip_add_option(pkt->pkt_ip, PKT_BUF_LEN - ETH_HDR_LEN,
IP_PROTO_IP, opt, opt->opt_len);
if (len > 0) {
pkt->pkt_end += len;
pkt_decorate(pkt);
ip_checksum(pkt->pkt_ip,
pkt->pkt_end - pkt->pkt_eth_data);
}
}
return (0);
}
struct mod mod_ip_opt = {
"ip_opt", /* name */
"ip_opt lsrr|ssrr <ptr> <ip-addr> ...", /* usage */
ip_opt_open, /* open */
ip_opt_apply, /* apply */
ip_opt_close /* close */
};
|
