summaryrefslogtreecommitdiff
path: root/proto_ipv6_dest_opts.c
blob: dfdd25685042bf466b3e6813b69e1181fc257f04 (plain)
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
92
93
94
95
96
97
98
99
100
101
/*
 * netsniff-ng - the packet sniffing beast
 * Copyright 2012 Markus Amend <markus@netsniff-ng.org>, Deutsche Flugsicherung GmbH
 * Subject to the GPL, version 2.
 *
 * IPv6 Destination Options Header described in RFC2460
 */

#include <stdio.h>
#include <stdint.h>
#include <netinet/in.h>    /* for ntohs() */

#include "proto.h"
#include "protos.h"
#include "dissector_eth.h"
#include "built_in.h"
#include "pkt_buff.h"

struct dest_optshdr {
	uint8_t h_next_header;
	uint8_t hdr_len;
} __packed;


static void dissect_opt_dest(struct pkt_buff *pkt, ssize_t *opt_len)
{
	/* Have to been upgraded.
	 * http://tools.ietf.org/html/rfc2460#section-4.2
	 * Look also for proto_ipv6_hop_by_hop.h, it needs
	 * dissect_opt(), too.
	 */
	if (*opt_len)
		tprintf(", Option(s) recognized ");

	/* If adding dissector reduce opt_len for each using of pkt_pull
	 * to the same size.
	 */
}

static void dest_opts(struct pkt_buff *pkt)
{
	uint16_t hdr_ext_len;
	ssize_t opt_len;
	struct dest_optshdr *dest_ops;

	dest_ops = (struct dest_optshdr *) pkt_pull(pkt, sizeof(*dest_ops));
	if (dest_ops == NULL)
		return;

	/* Total Header Length in Bytes */
	hdr_ext_len = (dest_ops->hdr_len + 1) * 8;
	/* Options length in Bytes */
	opt_len = hdr_ext_len - sizeof(*dest_ops);

	tprintf("\t [ Destination Options ");
	tprintf("NextHdr (%u), ", dest_ops->h_next_header);
	if (opt_len > pkt_len(pkt) || opt_len < 0) {
	      tprintf("HdrExtLen (%u, %u Bytes, %s)", dest_ops->hdr_len,
		    hdr_ext_len, colorize_start_full(black, red)
		    "invalid" colorize_end());
		    return;
	}
	tprintf("HdrExtLen (%u, %u Bytes)", dest_ops->hdr_len,
		hdr_ext_len);

	dissect_opt_dest(pkt, &opt_len);

	tprintf(" ]\n");

	pkt_pull(pkt, opt_len);
	pkt_set_proto(pkt, &eth_lay3, dest_ops->h_next_header);
}

static void dest_opts_less(struct pkt_buff *pkt)
{
	uint16_t hdr_ext_len;
	ssize_t opt_len;
	struct dest_optshdr *dest_ops;

	dest_ops = (struct dest_optshdr *) pkt_pull(pkt, sizeof(*dest_ops));
	if (dest_ops == NULL)
		return;

	/* Total Header Length in Bytes */
	hdr_ext_len = (dest_ops->hdr_len + 1) * 8;
	/* Options length in Bytes */
	opt_len = hdr_ext_len - sizeof(*dest_ops);
	if (opt_len > pkt_len(pkt) || opt_len < 0)
		return;

	tprintf(" Dest Ops");

	pkt_pull(pkt, opt_len);
	pkt_set_proto(pkt, &eth_lay3, dest_ops->h_next_header);
}

struct protocol ipv6_dest_opts_ops = {
	.key = 0x3C,
	.print_full = dest_opts,
	.print_less = dest_opts_less,
};