1 /*
2  * Copyright (C) 1998 WIDE Project.
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  * 3. Neither the name of the project nor the names of its contributors
14  *    may be used to endorse or promote products derived from this software
15  *    without specific prior written permission.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  */
29 
30 /* \summary: IPv6 header option printer */
31 
32 #ifdef HAVE_CONFIG_H
33 #include "config.h"
34 #endif
35 
36 #include <netdissect-stdinc.h>
37 
38 #include "netdissect.h"
39 #include "addrtoname.h"
40 #include "extract.h"
41 
42 #include "ip6.h"
43 
44 static void
ip6_sopt_print(netdissect_options * ndo,const u_char * bp,int len)45 ip6_sopt_print(netdissect_options *ndo, const u_char *bp, int len)
46 {
47     int i;
48     int optlen;
49 
50     for (i = 0; i < len; i += optlen) {
51 	if (bp[i] == IP6OPT_PAD1)
52 	    optlen = 1;
53 	else {
54 	    if (i + 1 < len)
55 		optlen = bp[i + 1] + 2;
56 	    else
57 		goto trunc;
58 	}
59 	if (i + optlen > len)
60 	    goto trunc;
61 
62 	switch (bp[i]) {
63 	case IP6OPT_PAD1:
64             ND_PRINT((ndo, ", pad1"));
65 	    break;
66 	case IP6OPT_PADN:
67 	    if (len - i < IP6OPT_MINLEN) {
68 		ND_PRINT((ndo, ", padn: trunc"));
69 		goto trunc;
70 	    }
71             ND_PRINT((ndo, ", padn"));
72 	    break;
73 	default:
74 	    if (len - i < IP6OPT_MINLEN) {
75 		ND_PRINT((ndo, ", sopt_type %d: trunc)", bp[i]));
76 		goto trunc;
77 	    }
78 	    ND_PRINT((ndo, ", sopt_type 0x%02x: len=%d", bp[i], bp[i + 1]));
79 	    break;
80 	}
81     }
82     return;
83 
84 trunc:
85     ND_PRINT((ndo, "[trunc] "));
86 }
87 
88 static void
ip6_opt_print(netdissect_options * ndo,const u_char * bp,int len)89 ip6_opt_print(netdissect_options *ndo, const u_char *bp, int len)
90 {
91     int i;
92     int optlen = 0;
93 
94     if (len == 0)
95         return;
96     for (i = 0; i < len; i += optlen) {
97 	if (bp[i] == IP6OPT_PAD1)
98 	    optlen = 1;
99 	else {
100 	    if (i + 1 < len)
101 		optlen = bp[i + 1] + 2;
102 	    else
103 		goto trunc;
104 	}
105 	if (i + optlen > len)
106 	    goto trunc;
107 
108 	switch (bp[i]) {
109 	case IP6OPT_PAD1:
110             ND_PRINT((ndo, "(pad1)"));
111 	    break;
112 	case IP6OPT_PADN:
113 	    if (len - i < IP6OPT_MINLEN) {
114 		ND_PRINT((ndo, "(padn: trunc)"));
115 		goto trunc;
116 	    }
117             ND_PRINT((ndo, "(padn)"));
118 	    break;
119 	case IP6OPT_ROUTER_ALERT:
120 	    if (len - i < IP6OPT_RTALERT_LEN) {
121 		ND_PRINT((ndo, "(rtalert: trunc)"));
122 		goto trunc;
123 	    }
124 	    if (bp[i + 1] != IP6OPT_RTALERT_LEN - 2) {
125 		ND_PRINT((ndo, "(rtalert: invalid len %d)", bp[i + 1]));
126 		goto trunc;
127 	    }
128 	    ND_PRINT((ndo, "(rtalert: 0x%04x) ", EXTRACT_16BITS(&bp[i + 2])));
129 	    break;
130 	case IP6OPT_JUMBO:
131 	    if (len - i < IP6OPT_JUMBO_LEN) {
132 		ND_PRINT((ndo, "(jumbo: trunc)"));
133 		goto trunc;
134 	    }
135 	    if (bp[i + 1] != IP6OPT_JUMBO_LEN - 2) {
136 		ND_PRINT((ndo, "(jumbo: invalid len %d)", bp[i + 1]));
137 		goto trunc;
138 	    }
139 	    ND_PRINT((ndo, "(jumbo: %u) ", EXTRACT_32BITS(&bp[i + 2])));
140 	    break;
141         case IP6OPT_HOME_ADDRESS:
142 	    if (len - i < IP6OPT_HOMEADDR_MINLEN) {
143 		ND_PRINT((ndo, "(homeaddr: trunc)"));
144 		goto trunc;
145 	    }
146 	    if (bp[i + 1] < IP6OPT_HOMEADDR_MINLEN - 2) {
147 		ND_PRINT((ndo, "(homeaddr: invalid len %d)", bp[i + 1]));
148 		goto trunc;
149 	    }
150 	    ND_PRINT((ndo, "(homeaddr: %s", ip6addr_string(ndo, &bp[i + 2])));
151             if (bp[i + 1] > IP6OPT_HOMEADDR_MINLEN - 2) {
152 		ip6_sopt_print(ndo, &bp[i + IP6OPT_HOMEADDR_MINLEN],
153 		    (optlen - IP6OPT_HOMEADDR_MINLEN));
154 	    }
155             ND_PRINT((ndo, ")"));
156 	    break;
157 	default:
158 	    if (len - i < IP6OPT_MINLEN) {
159 		ND_PRINT((ndo, "(type %d: trunc)", bp[i]));
160 		goto trunc;
161 	    }
162 	    ND_PRINT((ndo, "(opt_type 0x%02x: len=%d)", bp[i], bp[i + 1]));
163 	    break;
164 	}
165     }
166     ND_PRINT((ndo, " "));
167     return;
168 
169 trunc:
170     ND_PRINT((ndo, "[trunc] "));
171 }
172 
173 int
hbhopt_print(netdissect_options * ndo,register const u_char * bp)174 hbhopt_print(netdissect_options *ndo, register const u_char *bp)
175 {
176     const struct ip6_hbh *dp = (const struct ip6_hbh *)bp;
177     int hbhlen = 0;
178 
179     ND_TCHECK(dp->ip6h_len);
180     hbhlen = (int)((dp->ip6h_len + 1) << 3);
181     ND_TCHECK2(*dp, hbhlen);
182     ND_PRINT((ndo, "HBH "));
183     if (ndo->ndo_vflag)
184 	ip6_opt_print(ndo, (const u_char *)dp + sizeof(*dp), hbhlen - sizeof(*dp));
185 
186     return(hbhlen);
187 
188   trunc:
189     ND_PRINT((ndo, "[|HBH]"));
190     return(-1);
191 }
192 
193 int
dstopt_print(netdissect_options * ndo,register const u_char * bp)194 dstopt_print(netdissect_options *ndo, register const u_char *bp)
195 {
196     const struct ip6_dest *dp = (const struct ip6_dest *)bp;
197     int dstoptlen = 0;
198 
199     ND_TCHECK(dp->ip6d_len);
200     dstoptlen = (int)((dp->ip6d_len + 1) << 3);
201     ND_TCHECK2(*dp, dstoptlen);
202     ND_PRINT((ndo, "DSTOPT "));
203     if (ndo->ndo_vflag) {
204 	ip6_opt_print(ndo, (const u_char *)dp + sizeof(*dp),
205 	    dstoptlen - sizeof(*dp));
206     }
207 
208     return(dstoptlen);
209 
210   trunc:
211     ND_PRINT((ndo, "[|DSTOPT]"));
212     return(-1);
213 }
214