1*05b00f60SXin Li /*
2*05b00f60SXin Li * Copyright (c) 1998-2007 The TCPDUMP project
3*05b00f60SXin Li * Copyright (c) 2009 Florian Forster
4*05b00f60SXin Li *
5*05b00f60SXin Li * Redistribution and use in source and binary forms, with or without
6*05b00f60SXin Li * modification, are permitted provided that: (1) source code
7*05b00f60SXin Li * distributions retain the above copyright notice and this paragraph
8*05b00f60SXin Li * in its entirety, and (2) distributions including binary code include
9*05b00f60SXin Li * the above copyright notice and this paragraph in its entirety in
10*05b00f60SXin Li * the documentation or other materials provided with the distribution.
11*05b00f60SXin Li * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
12*05b00f60SXin Li * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
13*05b00f60SXin Li * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
14*05b00f60SXin Li * FOR A PARTICULAR PURPOSE.
15*05b00f60SXin Li *
16*05b00f60SXin Li * Original code by Hannes Gredler <[email protected]>
17*05b00f60SXin Li * IPv6 additions by Florian Forster <octo at verplant.org>
18*05b00f60SXin Li */
19*05b00f60SXin Li
20*05b00f60SXin Li /* \summary: Optimized Link State Routing Protocol (OLSR) printer */
21*05b00f60SXin Li
22*05b00f60SXin Li /* specification: RFC 3626 */
23*05b00f60SXin Li
24*05b00f60SXin Li #ifdef HAVE_CONFIG_H
25*05b00f60SXin Li #include <config.h>
26*05b00f60SXin Li #endif
27*05b00f60SXin Li
28*05b00f60SXin Li #include "netdissect-stdinc.h"
29*05b00f60SXin Li
30*05b00f60SXin Li #include "netdissect.h"
31*05b00f60SXin Li #include "addrtoname.h"
32*05b00f60SXin Li #include "extract.h"
33*05b00f60SXin Li
34*05b00f60SXin Li /*
35*05b00f60SXin Li * RFC 3626 common header
36*05b00f60SXin Li *
37*05b00f60SXin Li * 0 1 2 3
38*05b00f60SXin Li * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
39*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
40*05b00f60SXin Li * | Packet Length | Packet Sequence Number |
41*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
42*05b00f60SXin Li * | Message Type | Vtime | Message Size |
43*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
44*05b00f60SXin Li * | Originator Address |
45*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
46*05b00f60SXin Li * | Time To Live | Hop Count | Message Sequence Number |
47*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
48*05b00f60SXin Li * | |
49*05b00f60SXin Li * : MESSAGE :
50*05b00f60SXin Li * | |
51*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
52*05b00f60SXin Li * | Message Type | Vtime | Message Size |
53*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
54*05b00f60SXin Li * | Originator Address |
55*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
56*05b00f60SXin Li * | Time To Live | Hop Count | Message Sequence Number |
57*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
58*05b00f60SXin Li * | |
59*05b00f60SXin Li * : MESSAGE :
60*05b00f60SXin Li * | |
61*05b00f60SXin Li * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
62*05b00f60SXin Li * : :
63*05b00f60SXin Li */
64*05b00f60SXin Li
65*05b00f60SXin Li struct olsr_common {
66*05b00f60SXin Li nd_uint16_t packet_len;
67*05b00f60SXin Li nd_uint16_t packet_seq;
68*05b00f60SXin Li };
69*05b00f60SXin Li
70*05b00f60SXin Li #define OLSR_HELLO_MSG 1 /* rfc3626 */
71*05b00f60SXin Li #define OLSR_TC_MSG 2 /* rfc3626 */
72*05b00f60SXin Li #define OLSR_MID_MSG 3 /* rfc3626 */
73*05b00f60SXin Li #define OLSR_HNA_MSG 4 /* rfc3626 */
74*05b00f60SXin Li #define OLSR_POWERINFO_MSG 128
75*05b00f60SXin Li #define OLSR_NAMESERVICE_MSG 130
76*05b00f60SXin Li #define OLSR_HELLO_LQ_MSG 201 /* LQ extensions olsr.org */
77*05b00f60SXin Li #define OLSR_TC_LQ_MSG 202 /* LQ extensions olsr.org */
78*05b00f60SXin Li
79*05b00f60SXin Li static const struct tok olsr_msg_values[] = {
80*05b00f60SXin Li { OLSR_HELLO_MSG, "Hello" },
81*05b00f60SXin Li { OLSR_TC_MSG, "TC" },
82*05b00f60SXin Li { OLSR_MID_MSG, "MID" },
83*05b00f60SXin Li { OLSR_HNA_MSG, "HNA" },
84*05b00f60SXin Li { OLSR_POWERINFO_MSG, "Powerinfo" },
85*05b00f60SXin Li { OLSR_NAMESERVICE_MSG, "Nameservice" },
86*05b00f60SXin Li { OLSR_HELLO_LQ_MSG, "Hello-LQ" },
87*05b00f60SXin Li { OLSR_TC_LQ_MSG, "TC-LQ" },
88*05b00f60SXin Li { 0, NULL}
89*05b00f60SXin Li };
90*05b00f60SXin Li
91*05b00f60SXin Li struct olsr_msg4 {
92*05b00f60SXin Li nd_uint8_t msg_type;
93*05b00f60SXin Li nd_uint8_t vtime;
94*05b00f60SXin Li nd_uint16_t msg_len;
95*05b00f60SXin Li nd_ipv4 originator;
96*05b00f60SXin Li nd_uint8_t ttl;
97*05b00f60SXin Li nd_uint8_t hopcount;
98*05b00f60SXin Li nd_uint16_t msg_seq;
99*05b00f60SXin Li };
100*05b00f60SXin Li
101*05b00f60SXin Li struct olsr_msg6 {
102*05b00f60SXin Li nd_uint8_t msg_type;
103*05b00f60SXin Li nd_uint8_t vtime;
104*05b00f60SXin Li nd_uint16_t msg_len;
105*05b00f60SXin Li nd_ipv6 originator;
106*05b00f60SXin Li nd_uint8_t ttl;
107*05b00f60SXin Li nd_uint8_t hopcount;
108*05b00f60SXin Li nd_uint16_t msg_seq;
109*05b00f60SXin Li };
110*05b00f60SXin Li
111*05b00f60SXin Li struct olsr_hello {
112*05b00f60SXin Li nd_byte res[2];
113*05b00f60SXin Li nd_uint8_t htime;
114*05b00f60SXin Li nd_uint8_t will;
115*05b00f60SXin Li };
116*05b00f60SXin Li
117*05b00f60SXin Li struct olsr_hello_link {
118*05b00f60SXin Li nd_uint8_t link_code;
119*05b00f60SXin Li nd_byte res;
120*05b00f60SXin Li nd_uint16_t len;
121*05b00f60SXin Li };
122*05b00f60SXin Li
123*05b00f60SXin Li struct olsr_tc {
124*05b00f60SXin Li nd_uint16_t ans_seq;
125*05b00f60SXin Li nd_byte res[2];
126*05b00f60SXin Li };
127*05b00f60SXin Li
128*05b00f60SXin Li struct olsr_hna4 {
129*05b00f60SXin Li nd_ipv4 network;
130*05b00f60SXin Li nd_ipv4 mask;
131*05b00f60SXin Li };
132*05b00f60SXin Li
133*05b00f60SXin Li struct olsr_hna6 {
134*05b00f60SXin Li nd_ipv6 network;
135*05b00f60SXin Li nd_ipv6 mask;
136*05b00f60SXin Li };
137*05b00f60SXin Li
138*05b00f60SXin Li
139*05b00f60SXin Li /** gateway HNA flags */
140*05b00f60SXin Li enum gateway_hna_flags {
141*05b00f60SXin Li GW_HNA_FLAG_LINKSPEED = 1 << 0,
142*05b00f60SXin Li GW_HNA_FLAG_IPV4 = 1 << 1,
143*05b00f60SXin Li GW_HNA_FLAG_IPV4_NAT = 1 << 2,
144*05b00f60SXin Li GW_HNA_FLAG_IPV6 = 1 << 3,
145*05b00f60SXin Li GW_HNA_FLAG_IPV6PREFIX = 1 << 4
146*05b00f60SXin Li };
147*05b00f60SXin Li
148*05b00f60SXin Li /** gateway HNA field byte offsets in the netmask field of the HNA */
149*05b00f60SXin Li enum gateway_hna_fields {
150*05b00f60SXin Li GW_HNA_PAD = 0,
151*05b00f60SXin Li GW_HNA_FLAGS = 1,
152*05b00f60SXin Li GW_HNA_UPLINK = 2,
153*05b00f60SXin Li GW_HNA_DOWNLINK = 3,
154*05b00f60SXin Li GW_HNA_V6PREFIXLEN = 4,
155*05b00f60SXin Li GW_HNA_V6PREFIX = 5
156*05b00f60SXin Li };
157*05b00f60SXin Li
158*05b00f60SXin Li
159*05b00f60SXin Li #define OLSR_EXTRACT_LINK_TYPE(link_code) (link_code & 0x3)
160*05b00f60SXin Li #define OLSR_EXTRACT_NEIGHBOR_TYPE(link_code) (link_code >> 2)
161*05b00f60SXin Li
162*05b00f60SXin Li static const struct tok olsr_link_type_values[] = {
163*05b00f60SXin Li { 0, "Unspecified" },
164*05b00f60SXin Li { 1, "Asymmetric" },
165*05b00f60SXin Li { 2, "Symmetric" },
166*05b00f60SXin Li { 3, "Lost" },
167*05b00f60SXin Li { 0, NULL}
168*05b00f60SXin Li };
169*05b00f60SXin Li
170*05b00f60SXin Li static const struct tok olsr_neighbor_type_values[] = {
171*05b00f60SXin Li { 0, "Not-Neighbor" },
172*05b00f60SXin Li { 1, "Symmetric" },
173*05b00f60SXin Li { 2, "Symmetric-MPR" },
174*05b00f60SXin Li { 0, NULL}
175*05b00f60SXin Li };
176*05b00f60SXin Li
177*05b00f60SXin Li struct olsr_lq_neighbor4 {
178*05b00f60SXin Li nd_ipv4 neighbor;
179*05b00f60SXin Li nd_uint8_t link_quality;
180*05b00f60SXin Li nd_uint8_t neighbor_link_quality;
181*05b00f60SXin Li nd_byte res[2];
182*05b00f60SXin Li };
183*05b00f60SXin Li
184*05b00f60SXin Li struct olsr_lq_neighbor6 {
185*05b00f60SXin Li nd_ipv6 neighbor;
186*05b00f60SXin Li nd_uint8_t link_quality;
187*05b00f60SXin Li nd_uint8_t neighbor_link_quality;
188*05b00f60SXin Li nd_byte res[2];
189*05b00f60SXin Li };
190*05b00f60SXin Li
191*05b00f60SXin Li #define MAX_SMARTGW_SPEED 320000000
192*05b00f60SXin Li
193*05b00f60SXin Li /**
194*05b00f60SXin Li * Convert an encoded 1 byte transport value (5 bits mantissa, 3 bits exponent)
195*05b00f60SXin Li * to an uplink/downlink speed value
196*05b00f60SXin Li *
197*05b00f60SXin Li * @param value the encoded 1 byte transport value
198*05b00f60SXin Li * @return the uplink/downlink speed value (in kbit/s)
199*05b00f60SXin Li */
deserialize_gw_speed(uint8_t value)200*05b00f60SXin Li static uint32_t deserialize_gw_speed(uint8_t value) {
201*05b00f60SXin Li uint32_t speed;
202*05b00f60SXin Li uint32_t exp;
203*05b00f60SXin Li
204*05b00f60SXin Li if (!value) {
205*05b00f60SXin Li return 0;
206*05b00f60SXin Li }
207*05b00f60SXin Li
208*05b00f60SXin Li if (value == UINT8_MAX) {
209*05b00f60SXin Li /* maximum value: also return maximum value */
210*05b00f60SXin Li return MAX_SMARTGW_SPEED;
211*05b00f60SXin Li }
212*05b00f60SXin Li
213*05b00f60SXin Li speed = (value >> 3) + 1;
214*05b00f60SXin Li exp = value & 7;
215*05b00f60SXin Li
216*05b00f60SXin Li while (exp != 0) {
217*05b00f60SXin Li speed *= 10;
218*05b00f60SXin Li exp--;
219*05b00f60SXin Li }
220*05b00f60SXin Li return speed;
221*05b00f60SXin Li }
222*05b00f60SXin Li
223*05b00f60SXin Li /*
224*05b00f60SXin Li * macro to convert the 8-bit mantissa/exponent to a double float
225*05b00f60SXin Li * taken from olsr.org.
226*05b00f60SXin Li */
227*05b00f60SXin Li #define VTIME_SCALE_FACTOR 0.0625
228*05b00f60SXin Li #define ME_TO_DOUBLE(me) \
229*05b00f60SXin Li (double)(VTIME_SCALE_FACTOR*(1+(double)(me>>4)/16)*(double)(1<<(me&0x0F)))
230*05b00f60SXin Li
231*05b00f60SXin Li /*
232*05b00f60SXin Li * print a neighbor list with LQ extensions.
233*05b00f60SXin Li */
234*05b00f60SXin Li static int
olsr_print_lq_neighbor4(netdissect_options * ndo,const u_char * msg_data,u_int hello_len)235*05b00f60SXin Li olsr_print_lq_neighbor4(netdissect_options *ndo,
236*05b00f60SXin Li const u_char *msg_data, u_int hello_len)
237*05b00f60SXin Li {
238*05b00f60SXin Li const struct olsr_lq_neighbor4 *lq_neighbor;
239*05b00f60SXin Li
240*05b00f60SXin Li while (hello_len >= sizeof(struct olsr_lq_neighbor4)) {
241*05b00f60SXin Li
242*05b00f60SXin Li lq_neighbor = (const struct olsr_lq_neighbor4 *)msg_data;
243*05b00f60SXin Li ND_TCHECK_SIZE(lq_neighbor);
244*05b00f60SXin Li
245*05b00f60SXin Li ND_PRINT("\n\t neighbor %s, link-quality %.2f%%"
246*05b00f60SXin Li ", neighbor-link-quality %.2f%%",
247*05b00f60SXin Li GET_IPADDR_STRING(lq_neighbor->neighbor),
248*05b00f60SXin Li ((double) GET_U_1(lq_neighbor->link_quality)/2.55),
249*05b00f60SXin Li ((double) GET_U_1(lq_neighbor->neighbor_link_quality)/2.55));
250*05b00f60SXin Li
251*05b00f60SXin Li msg_data += sizeof(struct olsr_lq_neighbor4);
252*05b00f60SXin Li hello_len -= sizeof(struct olsr_lq_neighbor4);
253*05b00f60SXin Li }
254*05b00f60SXin Li return (0);
255*05b00f60SXin Li trunc:
256*05b00f60SXin Li return -1;
257*05b00f60SXin Li }
258*05b00f60SXin Li
259*05b00f60SXin Li static int
olsr_print_lq_neighbor6(netdissect_options * ndo,const u_char * msg_data,u_int hello_len)260*05b00f60SXin Li olsr_print_lq_neighbor6(netdissect_options *ndo,
261*05b00f60SXin Li const u_char *msg_data, u_int hello_len)
262*05b00f60SXin Li {
263*05b00f60SXin Li const struct olsr_lq_neighbor6 *lq_neighbor;
264*05b00f60SXin Li
265*05b00f60SXin Li while (hello_len >= sizeof(struct olsr_lq_neighbor6)) {
266*05b00f60SXin Li
267*05b00f60SXin Li lq_neighbor = (const struct olsr_lq_neighbor6 *)msg_data;
268*05b00f60SXin Li ND_TCHECK_SIZE(lq_neighbor);
269*05b00f60SXin Li
270*05b00f60SXin Li ND_PRINT("\n\t neighbor %s, link-quality %.2f%%"
271*05b00f60SXin Li ", neighbor-link-quality %.2f%%",
272*05b00f60SXin Li GET_IP6ADDR_STRING(lq_neighbor->neighbor),
273*05b00f60SXin Li ((double) GET_U_1(lq_neighbor->link_quality)/2.55),
274*05b00f60SXin Li ((double) GET_U_1(lq_neighbor->neighbor_link_quality)/2.55));
275*05b00f60SXin Li
276*05b00f60SXin Li msg_data += sizeof(struct olsr_lq_neighbor6);
277*05b00f60SXin Li hello_len -= sizeof(struct olsr_lq_neighbor6);
278*05b00f60SXin Li }
279*05b00f60SXin Li return (0);
280*05b00f60SXin Li trunc:
281*05b00f60SXin Li return -1;
282*05b00f60SXin Li }
283*05b00f60SXin Li
284*05b00f60SXin Li /*
285*05b00f60SXin Li * print a neighbor list.
286*05b00f60SXin Li */
287*05b00f60SXin Li static int
olsr_print_neighbor(netdissect_options * ndo,const u_char * msg_data,u_int hello_len)288*05b00f60SXin Li olsr_print_neighbor(netdissect_options *ndo,
289*05b00f60SXin Li const u_char *msg_data, u_int hello_len)
290*05b00f60SXin Li {
291*05b00f60SXin Li int neighbor;
292*05b00f60SXin Li
293*05b00f60SXin Li ND_PRINT("\n\t neighbor\n\t\t");
294*05b00f60SXin Li neighbor = 1;
295*05b00f60SXin Li
296*05b00f60SXin Li while (hello_len >= sizeof(nd_ipv4)) {
297*05b00f60SXin Li /* print 4 neighbors per line */
298*05b00f60SXin Li ND_PRINT("%s%s", GET_IPADDR_STRING(msg_data),
299*05b00f60SXin Li neighbor % 4 == 0 ? "\n\t\t" : " ");
300*05b00f60SXin Li
301*05b00f60SXin Li msg_data += sizeof(nd_ipv4);
302*05b00f60SXin Li hello_len -= sizeof(nd_ipv4);
303*05b00f60SXin Li }
304*05b00f60SXin Li return (0);
305*05b00f60SXin Li }
306*05b00f60SXin Li
307*05b00f60SXin Li
308*05b00f60SXin Li void
olsr_print(netdissect_options * ndo,const u_char * pptr,u_int length,int is_ipv6)309*05b00f60SXin Li olsr_print(netdissect_options *ndo,
310*05b00f60SXin Li const u_char *pptr, u_int length, int is_ipv6)
311*05b00f60SXin Li {
312*05b00f60SXin Li union {
313*05b00f60SXin Li const struct olsr_common *common;
314*05b00f60SXin Li const struct olsr_msg4 *msg4;
315*05b00f60SXin Li const struct olsr_msg6 *msg6;
316*05b00f60SXin Li const struct olsr_hello *hello;
317*05b00f60SXin Li const struct olsr_hello_link *hello_link;
318*05b00f60SXin Li const struct olsr_tc *tc;
319*05b00f60SXin Li const struct olsr_hna4 *hna;
320*05b00f60SXin Li } ptr;
321*05b00f60SXin Li
322*05b00f60SXin Li u_int msg_type, msg_len, msg_tlen, hello_len;
323*05b00f60SXin Li uint16_t name_entry_type, name_entry_len;
324*05b00f60SXin Li u_int name_entry_padding;
325*05b00f60SXin Li uint8_t link_type, neighbor_type;
326*05b00f60SXin Li const u_char *tptr, *msg_data;
327*05b00f60SXin Li
328*05b00f60SXin Li ndo->ndo_protocol = "olsr";
329*05b00f60SXin Li tptr = pptr;
330*05b00f60SXin Li
331*05b00f60SXin Li nd_print_protocol_caps(ndo);
332*05b00f60SXin Li ND_PRINT("v%u", (is_ipv6) ? 6 : 4);
333*05b00f60SXin Li
334*05b00f60SXin Li if (length < sizeof(struct olsr_common)) {
335*05b00f60SXin Li goto trunc;
336*05b00f60SXin Li }
337*05b00f60SXin Li
338*05b00f60SXin Li ND_TCHECK_LEN(tptr, sizeof(struct olsr_common));
339*05b00f60SXin Li
340*05b00f60SXin Li ptr.common = (const struct olsr_common *)tptr;
341*05b00f60SXin Li length = ND_MIN(length, GET_BE_U_2(ptr.common->packet_len));
342*05b00f60SXin Li
343*05b00f60SXin Li ND_PRINT(", seq 0x%04x, length %u",
344*05b00f60SXin Li GET_BE_U_2(ptr.common->packet_seq),
345*05b00f60SXin Li length);
346*05b00f60SXin Li
347*05b00f60SXin Li tptr += sizeof(struct olsr_common);
348*05b00f60SXin Li
349*05b00f60SXin Li /*
350*05b00f60SXin Li * In non-verbose mode, just print version.
351*05b00f60SXin Li */
352*05b00f60SXin Li if (ndo->ndo_vflag < 1) {
353*05b00f60SXin Li return;
354*05b00f60SXin Li }
355*05b00f60SXin Li
356*05b00f60SXin Li while (tptr < (pptr+length)) {
357*05b00f60SXin Li union
358*05b00f60SXin Li {
359*05b00f60SXin Li const struct olsr_msg4 *v4;
360*05b00f60SXin Li const struct olsr_msg6 *v6;
361*05b00f60SXin Li } msgptr;
362*05b00f60SXin Li int msg_len_valid = 0;
363*05b00f60SXin Li
364*05b00f60SXin Li if (is_ipv6)
365*05b00f60SXin Li {
366*05b00f60SXin Li ND_TCHECK_LEN(tptr, sizeof(struct olsr_msg6));
367*05b00f60SXin Li msgptr.v6 = (const struct olsr_msg6 *) tptr;
368*05b00f60SXin Li msg_type = GET_U_1(msgptr.v6->msg_type);
369*05b00f60SXin Li msg_len = GET_BE_U_2(msgptr.v6->msg_len);
370*05b00f60SXin Li if ((msg_len >= sizeof (struct olsr_msg6))
371*05b00f60SXin Li && (msg_len <= length))
372*05b00f60SXin Li msg_len_valid = 1;
373*05b00f60SXin Li
374*05b00f60SXin Li /* infinite loop check */
375*05b00f60SXin Li if (msg_type == 0 || msg_len == 0) {
376*05b00f60SXin Li return;
377*05b00f60SXin Li }
378*05b00f60SXin Li
379*05b00f60SXin Li ND_PRINT("\n\t%s Message (%#04x), originator %s, ttl %u, hop %u"
380*05b00f60SXin Li "\n\t vtime %.3fs, msg-seq 0x%04x, length %u%s",
381*05b00f60SXin Li tok2str(olsr_msg_values, "Unknown", msg_type),
382*05b00f60SXin Li msg_type, GET_IP6ADDR_STRING(msgptr.v6->originator),
383*05b00f60SXin Li GET_U_1(msgptr.v6->ttl),
384*05b00f60SXin Li GET_U_1(msgptr.v6->hopcount),
385*05b00f60SXin Li ME_TO_DOUBLE(GET_U_1(msgptr.v6->vtime)),
386*05b00f60SXin Li GET_BE_U_2(msgptr.v6->msg_seq),
387*05b00f60SXin Li msg_len, (msg_len_valid == 0) ? " (invalid)" : "");
388*05b00f60SXin Li if (!msg_len_valid) {
389*05b00f60SXin Li return;
390*05b00f60SXin Li }
391*05b00f60SXin Li
392*05b00f60SXin Li msg_tlen = msg_len - sizeof(struct olsr_msg6);
393*05b00f60SXin Li msg_data = tptr + sizeof(struct olsr_msg6);
394*05b00f60SXin Li }
395*05b00f60SXin Li else /* (!is_ipv6) */
396*05b00f60SXin Li {
397*05b00f60SXin Li ND_TCHECK_LEN(tptr, sizeof(struct olsr_msg4));
398*05b00f60SXin Li msgptr.v4 = (const struct olsr_msg4 *) tptr;
399*05b00f60SXin Li msg_type = GET_U_1(msgptr.v4->msg_type);
400*05b00f60SXin Li msg_len = GET_BE_U_2(msgptr.v4->msg_len);
401*05b00f60SXin Li if ((msg_len >= sizeof (struct olsr_msg4))
402*05b00f60SXin Li && (msg_len <= length))
403*05b00f60SXin Li msg_len_valid = 1;
404*05b00f60SXin Li
405*05b00f60SXin Li /* infinite loop check */
406*05b00f60SXin Li if (msg_type == 0 || msg_len == 0) {
407*05b00f60SXin Li return;
408*05b00f60SXin Li }
409*05b00f60SXin Li
410*05b00f60SXin Li ND_PRINT("\n\t%s Message (%#04x), originator %s, ttl %u, hop %u"
411*05b00f60SXin Li "\n\t vtime %.3fs, msg-seq 0x%04x, length %u%s",
412*05b00f60SXin Li tok2str(olsr_msg_values, "Unknown", msg_type),
413*05b00f60SXin Li msg_type, GET_IPADDR_STRING(msgptr.v4->originator),
414*05b00f60SXin Li GET_U_1(msgptr.v4->ttl),
415*05b00f60SXin Li GET_U_1(msgptr.v4->hopcount),
416*05b00f60SXin Li ME_TO_DOUBLE(GET_U_1(msgptr.v4->vtime)),
417*05b00f60SXin Li GET_BE_U_2(msgptr.v4->msg_seq),
418*05b00f60SXin Li msg_len, (msg_len_valid == 0) ? " (invalid)" : "");
419*05b00f60SXin Li if (!msg_len_valid) {
420*05b00f60SXin Li return;
421*05b00f60SXin Li }
422*05b00f60SXin Li
423*05b00f60SXin Li msg_tlen = msg_len - sizeof(struct olsr_msg4);
424*05b00f60SXin Li msg_data = tptr + sizeof(struct olsr_msg4);
425*05b00f60SXin Li }
426*05b00f60SXin Li
427*05b00f60SXin Li switch (msg_type) {
428*05b00f60SXin Li case OLSR_HELLO_MSG:
429*05b00f60SXin Li case OLSR_HELLO_LQ_MSG:
430*05b00f60SXin Li if (msg_tlen < sizeof(struct olsr_hello))
431*05b00f60SXin Li goto trunc;
432*05b00f60SXin Li ND_TCHECK_LEN(msg_data, sizeof(struct olsr_hello));
433*05b00f60SXin Li
434*05b00f60SXin Li ptr.hello = (const struct olsr_hello *)msg_data;
435*05b00f60SXin Li ND_PRINT("\n\t hello-time %.3fs, MPR willingness %u",
436*05b00f60SXin Li ME_TO_DOUBLE(GET_U_1(ptr.hello->htime)),
437*05b00f60SXin Li GET_U_1(ptr.hello->will));
438*05b00f60SXin Li msg_data += sizeof(struct olsr_hello);
439*05b00f60SXin Li msg_tlen -= sizeof(struct olsr_hello);
440*05b00f60SXin Li
441*05b00f60SXin Li while (msg_tlen >= sizeof(struct olsr_hello_link)) {
442*05b00f60SXin Li int hello_len_valid = 0;
443*05b00f60SXin Li
444*05b00f60SXin Li /*
445*05b00f60SXin Li * link-type.
446*05b00f60SXin Li */
447*05b00f60SXin Li ND_TCHECK_LEN(msg_data, sizeof(struct olsr_hello_link));
448*05b00f60SXin Li
449*05b00f60SXin Li ptr.hello_link = (const struct olsr_hello_link *)msg_data;
450*05b00f60SXin Li
451*05b00f60SXin Li hello_len = GET_BE_U_2(ptr.hello_link->len);
452*05b00f60SXin Li link_type = OLSR_EXTRACT_LINK_TYPE(GET_U_1(ptr.hello_link->link_code));
453*05b00f60SXin Li neighbor_type = OLSR_EXTRACT_NEIGHBOR_TYPE(GET_U_1(ptr.hello_link->link_code));
454*05b00f60SXin Li
455*05b00f60SXin Li if ((hello_len <= msg_tlen)
456*05b00f60SXin Li && (hello_len >= sizeof(struct olsr_hello_link)))
457*05b00f60SXin Li hello_len_valid = 1;
458*05b00f60SXin Li
459*05b00f60SXin Li ND_PRINT("\n\t link-type %s, neighbor-type %s, len %u%s",
460*05b00f60SXin Li tok2str(olsr_link_type_values, "Unknown", link_type),
461*05b00f60SXin Li tok2str(olsr_neighbor_type_values, "Unknown", neighbor_type),
462*05b00f60SXin Li hello_len,
463*05b00f60SXin Li (hello_len_valid == 0) ? " (invalid)" : "");
464*05b00f60SXin Li
465*05b00f60SXin Li if (hello_len_valid == 0)
466*05b00f60SXin Li break;
467*05b00f60SXin Li
468*05b00f60SXin Li msg_data += sizeof(struct olsr_hello_link);
469*05b00f60SXin Li msg_tlen -= sizeof(struct olsr_hello_link);
470*05b00f60SXin Li hello_len -= sizeof(struct olsr_hello_link);
471*05b00f60SXin Li
472*05b00f60SXin Li ND_TCHECK_LEN(msg_data, hello_len);
473*05b00f60SXin Li if (msg_type == OLSR_HELLO_MSG) {
474*05b00f60SXin Li if (olsr_print_neighbor(ndo, msg_data, hello_len) == -1)
475*05b00f60SXin Li goto trunc;
476*05b00f60SXin Li } else {
477*05b00f60SXin Li if (is_ipv6) {
478*05b00f60SXin Li if (olsr_print_lq_neighbor6(ndo, msg_data, hello_len) == -1)
479*05b00f60SXin Li goto trunc;
480*05b00f60SXin Li } else {
481*05b00f60SXin Li if (olsr_print_lq_neighbor4(ndo, msg_data, hello_len) == -1)
482*05b00f60SXin Li goto trunc;
483*05b00f60SXin Li }
484*05b00f60SXin Li }
485*05b00f60SXin Li
486*05b00f60SXin Li msg_data += hello_len;
487*05b00f60SXin Li msg_tlen -= hello_len;
488*05b00f60SXin Li }
489*05b00f60SXin Li break;
490*05b00f60SXin Li
491*05b00f60SXin Li case OLSR_TC_MSG:
492*05b00f60SXin Li case OLSR_TC_LQ_MSG:
493*05b00f60SXin Li if (msg_tlen < sizeof(struct olsr_tc))
494*05b00f60SXin Li goto trunc;
495*05b00f60SXin Li ND_TCHECK_LEN(msg_data, sizeof(struct olsr_tc));
496*05b00f60SXin Li
497*05b00f60SXin Li ptr.tc = (const struct olsr_tc *)msg_data;
498*05b00f60SXin Li ND_PRINT("\n\t advertised neighbor seq 0x%04x",
499*05b00f60SXin Li GET_BE_U_2(ptr.tc->ans_seq));
500*05b00f60SXin Li msg_data += sizeof(struct olsr_tc);
501*05b00f60SXin Li msg_tlen -= sizeof(struct olsr_tc);
502*05b00f60SXin Li
503*05b00f60SXin Li if (msg_type == OLSR_TC_MSG) {
504*05b00f60SXin Li if (olsr_print_neighbor(ndo, msg_data, msg_tlen) == -1)
505*05b00f60SXin Li goto trunc;
506*05b00f60SXin Li } else {
507*05b00f60SXin Li if (is_ipv6) {
508*05b00f60SXin Li if (olsr_print_lq_neighbor6(ndo, msg_data, msg_tlen) == -1)
509*05b00f60SXin Li goto trunc;
510*05b00f60SXin Li } else {
511*05b00f60SXin Li if (olsr_print_lq_neighbor4(ndo, msg_data, msg_tlen) == -1)
512*05b00f60SXin Li goto trunc;
513*05b00f60SXin Li }
514*05b00f60SXin Li }
515*05b00f60SXin Li break;
516*05b00f60SXin Li
517*05b00f60SXin Li case OLSR_MID_MSG:
518*05b00f60SXin Li {
519*05b00f60SXin Li u_int addr_size = (u_int)sizeof(nd_ipv4);
520*05b00f60SXin Li
521*05b00f60SXin Li if (is_ipv6)
522*05b00f60SXin Li addr_size = (u_int)sizeof(nd_ipv6);
523*05b00f60SXin Li
524*05b00f60SXin Li while (msg_tlen >= addr_size) {
525*05b00f60SXin Li ND_TCHECK_LEN(msg_data, addr_size);
526*05b00f60SXin Li ND_PRINT("\n\t interface address %s",
527*05b00f60SXin Li is_ipv6 ? GET_IP6ADDR_STRING(msg_data) :
528*05b00f60SXin Li GET_IPADDR_STRING(msg_data));
529*05b00f60SXin Li
530*05b00f60SXin Li msg_data += addr_size;
531*05b00f60SXin Li msg_tlen -= addr_size;
532*05b00f60SXin Li }
533*05b00f60SXin Li break;
534*05b00f60SXin Li }
535*05b00f60SXin Li
536*05b00f60SXin Li case OLSR_HNA_MSG:
537*05b00f60SXin Li if (is_ipv6)
538*05b00f60SXin Li {
539*05b00f60SXin Li int i = 0;
540*05b00f60SXin Li
541*05b00f60SXin Li ND_PRINT("\n\t Advertised networks (total %u)",
542*05b00f60SXin Li (unsigned int) (msg_tlen / sizeof(struct olsr_hna6)));
543*05b00f60SXin Li
544*05b00f60SXin Li while (msg_tlen >= sizeof(struct olsr_hna6)) {
545*05b00f60SXin Li const struct olsr_hna6 *hna6;
546*05b00f60SXin Li
547*05b00f60SXin Li ND_TCHECK_LEN(msg_data, sizeof(struct olsr_hna6));
548*05b00f60SXin Li
549*05b00f60SXin Li hna6 = (const struct olsr_hna6 *)msg_data;
550*05b00f60SXin Li
551*05b00f60SXin Li ND_PRINT("\n\t #%i: %s/%u",
552*05b00f60SXin Li i, GET_IP6ADDR_STRING(hna6->network),
553*05b00f60SXin Li mask62plen (hna6->mask));
554*05b00f60SXin Li
555*05b00f60SXin Li msg_data += sizeof(struct olsr_hna6);
556*05b00f60SXin Li msg_tlen -= sizeof(struct olsr_hna6);
557*05b00f60SXin Li }
558*05b00f60SXin Li }
559*05b00f60SXin Li else
560*05b00f60SXin Li {
561*05b00f60SXin Li int col = 0;
562*05b00f60SXin Li
563*05b00f60SXin Li ND_PRINT("\n\t Advertised networks (total %u)",
564*05b00f60SXin Li (unsigned int) (msg_tlen / sizeof(struct olsr_hna4)));
565*05b00f60SXin Li
566*05b00f60SXin Li while (msg_tlen >= sizeof(struct olsr_hna4)) {
567*05b00f60SXin Li ND_TCHECK_LEN(msg_data, sizeof(struct olsr_hna4));
568*05b00f60SXin Li
569*05b00f60SXin Li ptr.hna = (const struct olsr_hna4 *)msg_data;
570*05b00f60SXin Li
571*05b00f60SXin Li /* print 4 prefixes per line */
572*05b00f60SXin Li if (!ptr.hna->network[0] && !ptr.hna->network[1] &&
573*05b00f60SXin Li !ptr.hna->network[2] && !ptr.hna->network[3] &&
574*05b00f60SXin Li !ptr.hna->mask[GW_HNA_PAD] &&
575*05b00f60SXin Li ptr.hna->mask[GW_HNA_FLAGS]) {
576*05b00f60SXin Li /* smart gateway */
577*05b00f60SXin Li ND_PRINT("%sSmart-Gateway:%s%s%s%s%s %u/%u",
578*05b00f60SXin Li col == 0 ? "\n\t " : ", ", /* indent */
579*05b00f60SXin Li /* sgw */
580*05b00f60SXin Li /* LINKSPEED */
581*05b00f60SXin Li (ptr.hna->mask[GW_HNA_FLAGS] &
582*05b00f60SXin Li GW_HNA_FLAG_LINKSPEED) ? " LINKSPEED" : "",
583*05b00f60SXin Li /* IPV4 */
584*05b00f60SXin Li (ptr.hna->mask[GW_HNA_FLAGS] &
585*05b00f60SXin Li GW_HNA_FLAG_IPV4) ? " IPV4" : "",
586*05b00f60SXin Li /* IPV4-NAT */
587*05b00f60SXin Li (ptr.hna->mask[GW_HNA_FLAGS] &
588*05b00f60SXin Li GW_HNA_FLAG_IPV4_NAT) ? " IPV4-NAT" : "",
589*05b00f60SXin Li /* IPV6 */
590*05b00f60SXin Li (ptr.hna->mask[GW_HNA_FLAGS] &
591*05b00f60SXin Li GW_HNA_FLAG_IPV6) ? " IPV6" : "",
592*05b00f60SXin Li /* IPv6PREFIX */
593*05b00f60SXin Li (ptr.hna->mask[GW_HNA_FLAGS] &
594*05b00f60SXin Li GW_HNA_FLAG_IPV6PREFIX) ? " IPv6-PREFIX" : "",
595*05b00f60SXin Li /* uplink */
596*05b00f60SXin Li (ptr.hna->mask[GW_HNA_FLAGS] &
597*05b00f60SXin Li GW_HNA_FLAG_LINKSPEED) ?
598*05b00f60SXin Li deserialize_gw_speed(ptr.hna->mask[GW_HNA_UPLINK]) : 0,
599*05b00f60SXin Li /* downlink */
600*05b00f60SXin Li (ptr.hna->mask[GW_HNA_FLAGS] &
601*05b00f60SXin Li GW_HNA_FLAG_LINKSPEED) ?
602*05b00f60SXin Li deserialize_gw_speed(ptr.hna->mask[GW_HNA_DOWNLINK]) : 0
603*05b00f60SXin Li );
604*05b00f60SXin Li } else {
605*05b00f60SXin Li /* normal route */
606*05b00f60SXin Li ND_PRINT("%s%s/%u",
607*05b00f60SXin Li col == 0 ? "\n\t " : ", ",
608*05b00f60SXin Li GET_IPADDR_STRING(ptr.hna->network),
609*05b00f60SXin Li mask2plen(GET_BE_U_4(ptr.hna->mask)));
610*05b00f60SXin Li }
611*05b00f60SXin Li
612*05b00f60SXin Li msg_data += sizeof(struct olsr_hna4);
613*05b00f60SXin Li msg_tlen -= sizeof(struct olsr_hna4);
614*05b00f60SXin Li
615*05b00f60SXin Li col = (col + 1) % 4;
616*05b00f60SXin Li }
617*05b00f60SXin Li }
618*05b00f60SXin Li break;
619*05b00f60SXin Li
620*05b00f60SXin Li case OLSR_NAMESERVICE_MSG:
621*05b00f60SXin Li {
622*05b00f60SXin Li u_int name_entries;
623*05b00f60SXin Li u_int addr_size;
624*05b00f60SXin Li int name_entries_valid;
625*05b00f60SXin Li u_int i;
626*05b00f60SXin Li
627*05b00f60SXin Li if (msg_tlen < 4)
628*05b00f60SXin Li goto trunc;
629*05b00f60SXin Li
630*05b00f60SXin Li name_entries = GET_BE_U_2(msg_data + 2);
631*05b00f60SXin Li addr_size = 4;
632*05b00f60SXin Li if (is_ipv6)
633*05b00f60SXin Li addr_size = 16;
634*05b00f60SXin Li
635*05b00f60SXin Li name_entries_valid = 0;
636*05b00f60SXin Li if ((name_entries > 0)
637*05b00f60SXin Li && ((name_entries * (4 + addr_size)) <= msg_tlen))
638*05b00f60SXin Li name_entries_valid = 1;
639*05b00f60SXin Li
640*05b00f60SXin Li ND_PRINT("\n\t Version %u, Entries %u%s",
641*05b00f60SXin Li GET_BE_U_2(msg_data),
642*05b00f60SXin Li name_entries, (name_entries_valid == 0) ? " (invalid)" : "");
643*05b00f60SXin Li
644*05b00f60SXin Li if (name_entries_valid == 0)
645*05b00f60SXin Li break;
646*05b00f60SXin Li
647*05b00f60SXin Li msg_data += 4;
648*05b00f60SXin Li msg_tlen -= 4;
649*05b00f60SXin Li
650*05b00f60SXin Li for (i = 0; i < name_entries; i++) {
651*05b00f60SXin Li int name_entry_len_valid = 0;
652*05b00f60SXin Li
653*05b00f60SXin Li if (msg_tlen < 4)
654*05b00f60SXin Li break;
655*05b00f60SXin Li
656*05b00f60SXin Li name_entry_type = GET_BE_U_2(msg_data);
657*05b00f60SXin Li name_entry_len = GET_BE_U_2(msg_data + 2);
658*05b00f60SXin Li
659*05b00f60SXin Li msg_data += 4;
660*05b00f60SXin Li msg_tlen -= 4;
661*05b00f60SXin Li
662*05b00f60SXin Li if ((name_entry_len > 0) && ((addr_size + name_entry_len) <= msg_tlen))
663*05b00f60SXin Li name_entry_len_valid = 1;
664*05b00f60SXin Li
665*05b00f60SXin Li ND_PRINT("\n\t #%u: type %#06x, length %u%s",
666*05b00f60SXin Li (unsigned int) i, name_entry_type,
667*05b00f60SXin Li name_entry_len, (name_entry_len_valid == 0) ? " (invalid)" : "");
668*05b00f60SXin Li
669*05b00f60SXin Li if (name_entry_len_valid == 0)
670*05b00f60SXin Li break;
671*05b00f60SXin Li
672*05b00f60SXin Li /* 32-bit alignment */
673*05b00f60SXin Li name_entry_padding = 0;
674*05b00f60SXin Li if (name_entry_len%4 != 0)
675*05b00f60SXin Li name_entry_padding = 4-(name_entry_len%4);
676*05b00f60SXin Li
677*05b00f60SXin Li if (msg_tlen < addr_size + name_entry_len + name_entry_padding)
678*05b00f60SXin Li goto trunc;
679*05b00f60SXin Li
680*05b00f60SXin Li ND_TCHECK_LEN(msg_data,
681*05b00f60SXin Li addr_size + name_entry_len + name_entry_padding);
682*05b00f60SXin Li
683*05b00f60SXin Li if (is_ipv6)
684*05b00f60SXin Li ND_PRINT(", address %s, name \"",
685*05b00f60SXin Li GET_IP6ADDR_STRING(msg_data));
686*05b00f60SXin Li else
687*05b00f60SXin Li ND_PRINT(", address %s, name \"",
688*05b00f60SXin Li GET_IPADDR_STRING(msg_data));
689*05b00f60SXin Li (void)nd_printn(ndo, msg_data + addr_size, name_entry_len, NULL);
690*05b00f60SXin Li ND_PRINT("\"");
691*05b00f60SXin Li
692*05b00f60SXin Li msg_data += addr_size + name_entry_len + name_entry_padding;
693*05b00f60SXin Li msg_tlen -= addr_size + name_entry_len + name_entry_padding;
694*05b00f60SXin Li } /* for (i = 0; i < name_entries; i++) */
695*05b00f60SXin Li break;
696*05b00f60SXin Li } /* case OLSR_NAMESERVICE_MSG */
697*05b00f60SXin Li
698*05b00f60SXin Li /*
699*05b00f60SXin Li * FIXME those are the defined messages that lack a decoder
700*05b00f60SXin Li * you are welcome to contribute code ;-)
701*05b00f60SXin Li */
702*05b00f60SXin Li case OLSR_POWERINFO_MSG:
703*05b00f60SXin Li default:
704*05b00f60SXin Li print_unknown_data(ndo, msg_data, "\n\t ", msg_tlen);
705*05b00f60SXin Li break;
706*05b00f60SXin Li } /* switch (msg_type) */
707*05b00f60SXin Li tptr += msg_len;
708*05b00f60SXin Li } /* while (tptr < (pptr+length)) */
709*05b00f60SXin Li
710*05b00f60SXin Li return;
711*05b00f60SXin Li
712*05b00f60SXin Li trunc:
713*05b00f60SXin Li nd_print_trunc(ndo);
714*05b00f60SXin Li }
715