Home | History | Annotate | Line # | Download | only in dist
print-ahcp.c revision 1.5.10.2 
      1  1.5.10.2  snj /*
      2  1.5.10.2  snj  * Copyright (c) 2013 The TCPDUMP project
      3  1.5.10.2  snj  * All rights reserved.
      4  1.5.10.2  snj  *
      5  1.5.10.2  snj  * Redistribution and use in source and binary forms, with or without
      6  1.5.10.2  snj  * modification, are permitted provided that the following conditions
      7  1.5.10.2  snj  * are met:
      8  1.5.10.2  snj  * 1. Redistributions of source code must retain the above copyright
      9  1.5.10.2  snj  *    notice, this list of conditions and the following disclaimer.
     10  1.5.10.2  snj  * 2. Redistributions in binary form must reproduce the above copyright
     11  1.5.10.2  snj  *    notice, this list of conditions and the following disclaimer in the
     12  1.5.10.2  snj  *    documentation and/or other materials provided with the distribution.
     13  1.5.10.2  snj  *
     14  1.5.10.2  snj  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
     15  1.5.10.2  snj  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
     16  1.5.10.2  snj  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
     17  1.5.10.2  snj  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
     18  1.5.10.2  snj  * COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
     19  1.5.10.2  snj  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     20  1.5.10.2  snj  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     21  1.5.10.2  snj  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
     22  1.5.10.2  snj  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     23  1.5.10.2  snj  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     24  1.5.10.2  snj  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25  1.5.10.2  snj  * POSSIBILITY OF SUCH DAMAGE.
     26  1.5.10.2  snj  */
     27  1.5.10.2  snj 
     28  1.5.10.2  snj #include <sys/cdefs.h>
     29  1.5.10.2  snj #ifndef lint
     30  1.5.10.2  snj __RCSID("$NetBSD: print-ahcp.c,v 1.5.10.2 2017/02/19 07:37:07 snj Exp $");
     31  1.5.10.2  snj #endif
     32  1.5.10.2  snj 
     33  1.5.10.2  snj /* \summary: Ad Hoc Configuration Protocol (AHCP) printer */
     34  1.5.10.2  snj 
     35  1.5.10.2  snj /* Based on draft-chroboczek-ahcp-00 and source code of ahcpd-0.53 */
     36  1.5.10.2  snj 
     37  1.5.10.2  snj #ifdef HAVE_CONFIG_H
     38  1.5.10.2  snj #include "config.h"
     39  1.5.10.2  snj #endif
     40  1.5.10.2  snj 
     41  1.5.10.2  snj #include <netdissect-stdinc.h>
     42  1.5.10.2  snj 
     43  1.5.10.2  snj #include "netdissect.h"
     44  1.5.10.2  snj #include "extract.h"
     45  1.5.10.2  snj #include "addrtoname.h"
     46  1.5.10.2  snj 
     47  1.5.10.2  snj static const char tstr[] = " [|ahcp]";
     48  1.5.10.2  snj 
     49  1.5.10.2  snj #define AHCP_MAGIC_NUMBER 43
     50  1.5.10.2  snj #define AHCP_VERSION_1 1
     51  1.5.10.2  snj #define AHCP1_HEADER_FIX_LEN 24
     52  1.5.10.2  snj #define AHCP1_BODY_MIN_LEN 4
     53  1.5.10.2  snj 
     54  1.5.10.2  snj #define AHCP1_MSG_DISCOVER 0
     55  1.5.10.2  snj #define AHCP1_MSG_OFFER    1
     56  1.5.10.2  snj #define AHCP1_MSG_REQUEST  2
     57  1.5.10.2  snj #define AHCP1_MSG_ACK      3
     58  1.5.10.2  snj #define AHCP1_MSG_NACK     4
     59  1.5.10.2  snj #define AHCP1_MSG_RELEASE  5
     60  1.5.10.2  snj 
     61  1.5.10.2  snj static const struct tok ahcp1_msg_str[] = {
     62  1.5.10.2  snj 	{ AHCP1_MSG_DISCOVER, "Discover" },
     63  1.5.10.2  snj 	{ AHCP1_MSG_OFFER,    "Offer"    },
     64  1.5.10.2  snj 	{ AHCP1_MSG_REQUEST,  "Request"  },
     65  1.5.10.2  snj 	{ AHCP1_MSG_ACK,      "Ack"      },
     66  1.5.10.2  snj 	{ AHCP1_MSG_NACK,     "Nack"     },
     67  1.5.10.2  snj 	{ AHCP1_MSG_RELEASE,  "Release"  },
     68  1.5.10.2  snj 	{ 0, NULL }
     69  1.5.10.2  snj };
     70  1.5.10.2  snj 
     71  1.5.10.2  snj #define AHCP1_OPT_PAD                     0
     72  1.5.10.2  snj #define AHCP1_OPT_MANDATORY               1
     73  1.5.10.2  snj #define AHCP1_OPT_ORIGIN_TIME             2
     74  1.5.10.2  snj #define AHCP1_OPT_EXPIRES                 3
     75  1.5.10.2  snj #define AHCP1_OPT_MY_IPV6_ADDRESS         4
     76  1.5.10.2  snj #define AHCP1_OPT_MY_IPV4_ADDRESS         5
     77  1.5.10.2  snj #define AHCP1_OPT_IPV6_PREFIX             6
     78  1.5.10.2  snj #define AHCP1_OPT_IPV4_PREFIX             7
     79  1.5.10.2  snj #define AHCP1_OPT_IPV6_ADDRESS            8
     80  1.5.10.2  snj #define AHCP1_OPT_IPV4_ADDRESS            9
     81  1.5.10.2  snj #define AHCP1_OPT_IPV6_PREFIX_DELEGATION 10
     82  1.5.10.2  snj #define AHCP1_OPT_IPV4_PREFIX_DELEGATION 11
     83  1.5.10.2  snj #define AHCP1_OPT_NAME_SERVER            12
     84  1.5.10.2  snj #define AHCP1_OPT_NTP_SERVER             13
     85  1.5.10.2  snj #define AHCP1_OPT_MAX                    13
     86  1.5.10.2  snj 
     87  1.5.10.2  snj static const struct tok ahcp1_opt_str[] = {
     88  1.5.10.2  snj 	{ AHCP1_OPT_PAD,                    "Pad"                    },
     89  1.5.10.2  snj 	{ AHCP1_OPT_MANDATORY,              "Mandatory"              },
     90  1.5.10.2  snj 	{ AHCP1_OPT_ORIGIN_TIME,            "Origin Time"            },
     91  1.5.10.2  snj 	{ AHCP1_OPT_EXPIRES,                "Expires"                },
     92  1.5.10.2  snj 	{ AHCP1_OPT_MY_IPV6_ADDRESS,        "My-IPv6-Address"        },
     93  1.5.10.2  snj 	{ AHCP1_OPT_MY_IPV4_ADDRESS,        "My-IPv4-Address"        },
     94  1.5.10.2  snj 	{ AHCP1_OPT_IPV6_PREFIX,            "IPv6 Prefix"            },
     95  1.5.10.2  snj 	{ AHCP1_OPT_IPV4_PREFIX,            "IPv4 Prefix"            },
     96  1.5.10.2  snj 	{ AHCP1_OPT_IPV6_ADDRESS,           "IPv6 Address"           },
     97  1.5.10.2  snj 	{ AHCP1_OPT_IPV4_ADDRESS,           "IPv4 Address"           },
     98  1.5.10.2  snj 	{ AHCP1_OPT_IPV6_PREFIX_DELEGATION, "IPv6 Prefix Delegation" },
     99  1.5.10.2  snj 	{ AHCP1_OPT_IPV4_PREFIX_DELEGATION, "IPv4 Prefix Delegation" },
    100  1.5.10.2  snj 	{ AHCP1_OPT_NAME_SERVER,            "Name Server"            },
    101  1.5.10.2  snj 	{ AHCP1_OPT_NTP_SERVER,             "NTP Server"             },
    102  1.5.10.2  snj 	{ 0, NULL }
    103  1.5.10.2  snj };
    104  1.5.10.2  snj 
    105  1.5.10.2  snj static int
    106  1.5.10.2  snj ahcp_time_print(netdissect_options *ndo, const u_char *cp, const u_char *ep)
    107  1.5.10.2  snj {
    108  1.5.10.2  snj 	time_t t;
    109  1.5.10.2  snj 	struct tm *tm;
    110  1.5.10.2  snj 	char buf[BUFSIZE];
    111  1.5.10.2  snj 
    112  1.5.10.2  snj 	if (cp + 4 != ep)
    113  1.5.10.2  snj 		goto invalid;
    114  1.5.10.2  snj 	ND_TCHECK2(*cp, 4);
    115  1.5.10.2  snj 	t = EXTRACT_32BITS(cp);
    116  1.5.10.2  snj 	if (NULL == (tm = gmtime(&t)))
    117  1.5.10.2  snj 		ND_PRINT((ndo, ": gmtime() error"));
    118  1.5.10.2  snj 	else if (0 == strftime(buf, sizeof(buf), "%Y-%m-%d %H:%M:%S", tm))
    119  1.5.10.2  snj 		ND_PRINT((ndo, ": strftime() error"));
    120  1.5.10.2  snj 	else
    121  1.5.10.2  snj 		ND_PRINT((ndo, ": %s UTC", buf));
    122  1.5.10.2  snj 	return 0;
    123  1.5.10.2  snj 
    124  1.5.10.2  snj invalid:
    125  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    126  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    127  1.5.10.2  snj 	return 0;
    128  1.5.10.2  snj trunc:
    129  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    130  1.5.10.2  snj 	return -1;
    131  1.5.10.2  snj }
    132  1.5.10.2  snj 
    133  1.5.10.2  snj static int
    134  1.5.10.2  snj ahcp_seconds_print(netdissect_options *ndo, const u_char *cp, const u_char *ep)
    135  1.5.10.2  snj {
    136  1.5.10.2  snj 	if (cp + 4 != ep)
    137  1.5.10.2  snj 		goto invalid;
    138  1.5.10.2  snj 	ND_TCHECK2(*cp, 4);
    139  1.5.10.2  snj 	ND_PRINT((ndo, ": %us", EXTRACT_32BITS(cp)));
    140  1.5.10.2  snj 	return 0;
    141  1.5.10.2  snj 
    142  1.5.10.2  snj invalid:
    143  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    144  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    145  1.5.10.2  snj 	return 0;
    146  1.5.10.2  snj trunc:
    147  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    148  1.5.10.2  snj 	return -1;
    149  1.5.10.2  snj }
    150  1.5.10.2  snj 
    151  1.5.10.2  snj static int
    152  1.5.10.2  snj ahcp_ipv6_addresses_print(netdissect_options *ndo, const u_char *cp, const u_char *ep)
    153  1.5.10.2  snj {
    154  1.5.10.2  snj 	const char *sep = ": ";
    155  1.5.10.2  snj 
    156  1.5.10.2  snj 	while (cp < ep) {
    157  1.5.10.2  snj 		if (cp + 16 > ep)
    158  1.5.10.2  snj 			goto invalid;
    159  1.5.10.2  snj 		ND_TCHECK2(*cp, 16);
    160  1.5.10.2  snj 		ND_PRINT((ndo, "%s%s", sep, ip6addr_string(ndo, cp)));
    161  1.5.10.2  snj 		cp += 16;
    162  1.5.10.2  snj 		sep = ", ";
    163  1.5.10.2  snj 	}
    164  1.5.10.2  snj 	return 0;
    165  1.5.10.2  snj 
    166  1.5.10.2  snj invalid:
    167  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    168  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    169  1.5.10.2  snj 	return 0;
    170  1.5.10.2  snj trunc:
    171  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    172  1.5.10.2  snj 	return -1;
    173  1.5.10.2  snj }
    174  1.5.10.2  snj 
    175  1.5.10.2  snj static int
    176  1.5.10.2  snj ahcp_ipv4_addresses_print(netdissect_options *ndo, const u_char *cp, const u_char *ep)
    177  1.5.10.2  snj {
    178  1.5.10.2  snj 	const char *sep = ": ";
    179  1.5.10.2  snj 
    180  1.5.10.2  snj 	while (cp < ep) {
    181  1.5.10.2  snj 		if (cp + 4 > ep)
    182  1.5.10.2  snj 			goto invalid;
    183  1.5.10.2  snj 		ND_TCHECK2(*cp, 4);
    184  1.5.10.2  snj 		ND_PRINT((ndo, "%s%s", sep, ipaddr_string(ndo, cp)));
    185  1.5.10.2  snj 		cp += 4;
    186  1.5.10.2  snj 		sep = ", ";
    187  1.5.10.2  snj 	}
    188  1.5.10.2  snj 	return 0;
    189  1.5.10.2  snj 
    190  1.5.10.2  snj invalid:
    191  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    192  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    193  1.5.10.2  snj 	return 0;
    194  1.5.10.2  snj trunc:
    195  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    196  1.5.10.2  snj 	return -1;
    197  1.5.10.2  snj }
    198  1.5.10.2  snj 
    199  1.5.10.2  snj static int
    200  1.5.10.2  snj ahcp_ipv6_prefixes_print(netdissect_options *ndo, const u_char *cp, const u_char *ep)
    201  1.5.10.2  snj {
    202  1.5.10.2  snj 	const char *sep = ": ";
    203  1.5.10.2  snj 
    204  1.5.10.2  snj 	while (cp < ep) {
    205  1.5.10.2  snj 		if (cp + 17 > ep)
    206  1.5.10.2  snj 			goto invalid;
    207  1.5.10.2  snj 		ND_TCHECK2(*cp, 17);
    208  1.5.10.2  snj 		ND_PRINT((ndo, "%s%s/%u", sep, ip6addr_string(ndo, cp), *(cp + 16)));
    209  1.5.10.2  snj 		cp += 17;
    210  1.5.10.2  snj 		sep = ", ";
    211  1.5.10.2  snj 	}
    212  1.5.10.2  snj 	return 0;
    213  1.5.10.2  snj 
    214  1.5.10.2  snj invalid:
    215  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    216  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    217  1.5.10.2  snj 	return 0;
    218  1.5.10.2  snj trunc:
    219  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    220  1.5.10.2  snj 	return -1;
    221  1.5.10.2  snj }
    222  1.5.10.2  snj 
    223  1.5.10.2  snj static int
    224  1.5.10.2  snj ahcp_ipv4_prefixes_print(netdissect_options *ndo, const u_char *cp, const u_char *ep)
    225  1.5.10.2  snj {
    226  1.5.10.2  snj 	const char *sep = ": ";
    227  1.5.10.2  snj 
    228  1.5.10.2  snj 	while (cp < ep) {
    229  1.5.10.2  snj 		if (cp + 5 > ep)
    230  1.5.10.2  snj 			goto invalid;
    231  1.5.10.2  snj 		ND_TCHECK2(*cp, 5);
    232  1.5.10.2  snj 		ND_PRINT((ndo, "%s%s/%u", sep, ipaddr_string(ndo, cp), *(cp + 4)));
    233  1.5.10.2  snj 		cp += 5;
    234  1.5.10.2  snj 		sep = ", ";
    235  1.5.10.2  snj 	}
    236  1.5.10.2  snj 	return 0;
    237  1.5.10.2  snj 
    238  1.5.10.2  snj invalid:
    239  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    240  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    241  1.5.10.2  snj 	return 0;
    242  1.5.10.2  snj trunc:
    243  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    244  1.5.10.2  snj 	return -1;
    245  1.5.10.2  snj }
    246  1.5.10.2  snj 
    247  1.5.10.2  snj /* Data decoders signal truncated data with -1. */
    248  1.5.10.2  snj static int
    249  1.5.10.2  snj (* const data_decoders[AHCP1_OPT_MAX + 1])(netdissect_options *, const u_char *, const u_char *) = {
    250  1.5.10.2  snj 	/* [AHCP1_OPT_PAD]                    = */  NULL,
    251  1.5.10.2  snj 	/* [AHCP1_OPT_MANDATORY]              = */  NULL,
    252  1.5.10.2  snj 	/* [AHCP1_OPT_ORIGIN_TIME]            = */  ahcp_time_print,
    253  1.5.10.2  snj 	/* [AHCP1_OPT_EXPIRES]                = */  ahcp_seconds_print,
    254  1.5.10.2  snj 	/* [AHCP1_OPT_MY_IPV6_ADDRESS]        = */  ahcp_ipv6_addresses_print,
    255  1.5.10.2  snj 	/* [AHCP1_OPT_MY_IPV4_ADDRESS]        = */  ahcp_ipv4_addresses_print,
    256  1.5.10.2  snj 	/* [AHCP1_OPT_IPV6_PREFIX]            = */  ahcp_ipv6_prefixes_print,
    257  1.5.10.2  snj 	/* [AHCP1_OPT_IPV4_PREFIX]            = */  NULL,
    258  1.5.10.2  snj 	/* [AHCP1_OPT_IPV6_ADDRESS]           = */  ahcp_ipv6_addresses_print,
    259  1.5.10.2  snj 	/* [AHCP1_OPT_IPV4_ADDRESS]           = */  ahcp_ipv4_addresses_print,
    260  1.5.10.2  snj 	/* [AHCP1_OPT_IPV6_PREFIX_DELEGATION] = */  ahcp_ipv6_prefixes_print,
    261  1.5.10.2  snj 	/* [AHCP1_OPT_IPV4_PREFIX_DELEGATION] = */  ahcp_ipv4_prefixes_print,
    262  1.5.10.2  snj 	/* [AHCP1_OPT_NAME_SERVER]            = */  ahcp_ipv6_addresses_print,
    263  1.5.10.2  snj 	/* [AHCP1_OPT_NTP_SERVER]             = */  ahcp_ipv6_addresses_print,
    264  1.5.10.2  snj };
    265  1.5.10.2  snj 
    266  1.5.10.2  snj static void
    267  1.5.10.2  snj ahcp1_options_print(netdissect_options *ndo, const u_char *cp, const u_char *ep)
    268  1.5.10.2  snj {
    269  1.5.10.2  snj 	uint8_t option_no, option_len;
    270  1.5.10.2  snj 
    271  1.5.10.2  snj 	while (cp < ep) {
    272  1.5.10.2  snj 		/* Option no */
    273  1.5.10.2  snj 		ND_TCHECK2(*cp, 1);
    274  1.5.10.2  snj 		option_no = *cp;
    275  1.5.10.2  snj 		cp += 1;
    276  1.5.10.2  snj 		ND_PRINT((ndo, "\n\t %s", tok2str(ahcp1_opt_str, "Unknown-%u", option_no)));
    277  1.5.10.2  snj 		if (option_no == AHCP1_OPT_PAD || option_no == AHCP1_OPT_MANDATORY)
    278  1.5.10.2  snj 			continue;
    279  1.5.10.2  snj 		/* Length */
    280  1.5.10.2  snj 		if (cp + 1 > ep)
    281  1.5.10.2  snj 			goto invalid;
    282  1.5.10.2  snj 		ND_TCHECK2(*cp, 1);
    283  1.5.10.2  snj 		option_len = *cp;
    284  1.5.10.2  snj 		cp += 1;
    285  1.5.10.2  snj 		if (cp + option_len > ep)
    286  1.5.10.2  snj 			goto invalid;
    287  1.5.10.2  snj 		/* Value */
    288  1.5.10.2  snj 		if (option_no <= AHCP1_OPT_MAX && data_decoders[option_no] != NULL) {
    289  1.5.10.2  snj 			if (data_decoders[option_no](ndo, cp, cp + option_len) < 0)
    290  1.5.10.2  snj 				break; /* truncated and already marked up */
    291  1.5.10.2  snj 		} else {
    292  1.5.10.2  snj 			ND_PRINT((ndo, " (Length %u)", option_len));
    293  1.5.10.2  snj 			ND_TCHECK2(*cp, option_len);
    294  1.5.10.2  snj 		}
    295  1.5.10.2  snj 		cp += option_len;
    296  1.5.10.2  snj 	}
    297  1.5.10.2  snj 	return;
    298  1.5.10.2  snj 
    299  1.5.10.2  snj invalid:
    300  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    301  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    302  1.5.10.2  snj 	return;
    303  1.5.10.2  snj trunc:
    304  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    305  1.5.10.2  snj }
    306  1.5.10.2  snj 
    307  1.5.10.2  snj static void
    308  1.5.10.2  snj ahcp1_body_print(netdissect_options *ndo, const u_char *cp, const u_char *ep)
    309  1.5.10.2  snj {
    310  1.5.10.2  snj 	uint8_t type, mbz;
    311  1.5.10.2  snj 	uint16_t body_len;
    312  1.5.10.2  snj 
    313  1.5.10.2  snj 	if (cp + AHCP1_BODY_MIN_LEN > ep)
    314  1.5.10.2  snj 		goto invalid;
    315  1.5.10.2  snj 	/* Type */
    316  1.5.10.2  snj 	ND_TCHECK2(*cp, 1);
    317  1.5.10.2  snj 	type = *cp;
    318  1.5.10.2  snj 	cp += 1;
    319  1.5.10.2  snj 	/* MBZ */
    320  1.5.10.2  snj 	ND_TCHECK2(*cp, 1);
    321  1.5.10.2  snj 	mbz = *cp;
    322  1.5.10.2  snj 	cp += 1;
    323  1.5.10.2  snj 	/* Length */
    324  1.5.10.2  snj 	ND_TCHECK2(*cp, 2);
    325  1.5.10.2  snj 	body_len = EXTRACT_16BITS(cp);
    326  1.5.10.2  snj 	cp += 2;
    327  1.5.10.2  snj 
    328  1.5.10.2  snj 	if (ndo->ndo_vflag) {
    329  1.5.10.2  snj 		ND_PRINT((ndo, "\n\t%s", tok2str(ahcp1_msg_str, "Unknown-%u", type)));
    330  1.5.10.2  snj 		if (mbz != 0)
    331  1.5.10.2  snj 			ND_PRINT((ndo, ", MBZ %u", mbz));
    332  1.5.10.2  snj 		ND_PRINT((ndo, ", Length %u", body_len));
    333  1.5.10.2  snj 	}
    334  1.5.10.2  snj 	if (cp + body_len > ep)
    335  1.5.10.2  snj 		goto invalid;
    336  1.5.10.2  snj 
    337  1.5.10.2  snj 	/* Options */
    338  1.5.10.2  snj 	if (ndo->ndo_vflag >= 2)
    339  1.5.10.2  snj 		ahcp1_options_print(ndo, cp, cp + body_len); /* not ep (ignore extra data) */
    340  1.5.10.2  snj 	else
    341  1.5.10.2  snj 		ND_TCHECK2(*cp, body_len);
    342  1.5.10.2  snj 	return;
    343  1.5.10.2  snj 
    344  1.5.10.2  snj invalid:
    345  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    346  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    347  1.5.10.2  snj 	return;
    348  1.5.10.2  snj trunc:
    349  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    350  1.5.10.2  snj }
    351  1.5.10.2  snj 
    352  1.5.10.2  snj void
    353  1.5.10.2  snj ahcp_print(netdissect_options *ndo, const u_char *cp, const u_int len)
    354  1.5.10.2  snj {
    355  1.5.10.2  snj 	const u_char *ep = cp + len;
    356  1.5.10.2  snj 	uint8_t version;
    357  1.5.10.2  snj 
    358  1.5.10.2  snj 	ND_PRINT((ndo, "AHCP"));
    359  1.5.10.2  snj 	if (len < 2)
    360  1.5.10.2  snj 		goto invalid;
    361  1.5.10.2  snj 	/* Magic */
    362  1.5.10.2  snj 	ND_TCHECK2(*cp, 1);
    363  1.5.10.2  snj 	if (*cp != AHCP_MAGIC_NUMBER)
    364  1.5.10.2  snj 		goto invalid;
    365  1.5.10.2  snj 	cp += 1;
    366  1.5.10.2  snj 	/* Version */
    367  1.5.10.2  snj 	ND_TCHECK2(*cp, 1);
    368  1.5.10.2  snj 	version = *cp;
    369  1.5.10.2  snj 	cp += 1;
    370  1.5.10.2  snj 	switch (version) {
    371  1.5.10.2  snj 		case AHCP_VERSION_1: {
    372  1.5.10.2  snj 			ND_PRINT((ndo, " Version 1"));
    373  1.5.10.2  snj 			if (len < AHCP1_HEADER_FIX_LEN)
    374  1.5.10.2  snj 				goto invalid;
    375  1.5.10.2  snj 			if (!ndo->ndo_vflag) {
    376  1.5.10.2  snj 				ND_TCHECK2(*cp, AHCP1_HEADER_FIX_LEN - 2);
    377  1.5.10.2  snj 				cp += AHCP1_HEADER_FIX_LEN - 2;
    378  1.5.10.2  snj 			} else {
    379  1.5.10.2  snj 				/* Hopcount */
    380  1.5.10.2  snj 				ND_TCHECK2(*cp, 1);
    381  1.5.10.2  snj 				ND_PRINT((ndo, "\n\tHopcount %u", *cp));
    382  1.5.10.2  snj 				cp += 1;
    383  1.5.10.2  snj 				/* Original Hopcount */
    384  1.5.10.2  snj 				ND_TCHECK2(*cp, 1);
    385  1.5.10.2  snj 				ND_PRINT((ndo, ", Original Hopcount %u", *cp));
    386  1.5.10.2  snj 				cp += 1;
    387  1.5.10.2  snj 				/* Nonce */
    388  1.5.10.2  snj 				ND_TCHECK2(*cp, 4);
    389  1.5.10.2  snj 				ND_PRINT((ndo, ", Nonce 0x%08x", EXTRACT_32BITS(cp)));
    390  1.5.10.2  snj 				cp += 4;
    391  1.5.10.2  snj 				/* Source Id */
    392  1.5.10.2  snj 				ND_TCHECK2(*cp, 8);
    393  1.5.10.2  snj 				ND_PRINT((ndo, ", Source Id %s", linkaddr_string(ndo, cp, 0, 8)));
    394  1.5.10.2  snj 				cp += 8;
    395  1.5.10.2  snj 				/* Destination Id */
    396  1.5.10.2  snj 				ND_TCHECK2(*cp, 8);
    397  1.5.10.2  snj 				ND_PRINT((ndo, ", Destination Id %s", linkaddr_string(ndo, cp, 0, 8)));
    398  1.5.10.2  snj 				cp += 8;
    399  1.5.10.2  snj 			}
    400  1.5.10.2  snj 			/* Body */
    401  1.5.10.2  snj 			ahcp1_body_print(ndo, cp, ep);
    402  1.5.10.2  snj 			break;
    403  1.5.10.2  snj 		}
    404  1.5.10.2  snj 		default:
    405  1.5.10.2  snj 			ND_PRINT((ndo, " Version %u (unknown)", version));
    406  1.5.10.2  snj 			break;
    407  1.5.10.2  snj 	}
    408  1.5.10.2  snj 	return;
    409  1.5.10.2  snj 
    410  1.5.10.2  snj invalid:
    411  1.5.10.2  snj 	ND_PRINT((ndo, "%s", istr));
    412  1.5.10.2  snj 	ND_TCHECK2(*cp, ep - cp);
    413  1.5.10.2  snj 	return;
    414  1.5.10.2  snj trunc:
    415  1.5.10.2  snj 	ND_PRINT((ndo, "%s", tstr));
    416  1.5.10.2  snj }
    417