dl_print.c revision 1.2.2.3 1 1.2.2.3 skrll /* $NetBSD: dl_print.c,v 1.2.2.3 2016/04/22 15:44:17 skrll Exp $ */
2 1.2.2.2 skrll
3 1.2.2.2 skrll /*-
4 1.2.2.2 skrll * Copyright (c) 2014 The NetBSD Foundation, Inc.
5 1.2.2.2 skrll * All rights reserved.
6 1.2.2.2 skrll *
7 1.2.2.2 skrll * Redistribution and use in source and binary forms, with or without
8 1.2.2.2 skrll * modification, are permitted provided that the following conditions
9 1.2.2.2 skrll * are met:
10 1.2.2.2 skrll * 1. Redistributions of source code must retain the above copyright
11 1.2.2.2 skrll * notice, this list of conditions and the following disclaimer.
12 1.2.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright
13 1.2.2.2 skrll * notice, this list of conditions and the following disclaimer in the
14 1.2.2.2 skrll * documentation and/or other materials provided with the distribution.
15 1.2.2.2 skrll *
16 1.2.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.2.2.2 skrll * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.2.2.2 skrll * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.2.2.2 skrll * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.2.2.2 skrll * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.2.2.2 skrll * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.2.2.2 skrll * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.2.2.2 skrll * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.2.2.2 skrll * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.2.2.2 skrll * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.2.2.2 skrll * POSSIBILITY OF SUCH DAMAGE.
27 1.2.2.2 skrll */
28 1.2.2.2 skrll #include <sys/cdefs.h>
29 1.2.2.2 skrll #include <sys/types.h>
30 1.2.2.2 skrll
31 1.2.2.2 skrll #ifdef _KERNEL
32 1.2.2.3 skrll __KERNEL_RCSID(0, "$NetBSD: dl_print.c,v 1.2.2.3 2016/04/22 15:44:17 skrll Exp $");
33 1.2.2.2 skrll #include <sys/systm.h>
34 1.2.2.2 skrll #else
35 1.2.2.3 skrll __RCSID("$NetBSD: dl_print.c,v 1.2.2.3 2016/04/22 15:44:17 skrll Exp $");
36 1.2.2.2 skrll #include <stdio.h>
37 1.2.2.2 skrll static const uint8_t hexdigits[] = "0123456789abcdef";
38 1.2.2.2 skrll #endif
39 1.2.2.2 skrll #include <net/if_dl.h>
40 1.2.2.2 skrll
41 1.2.2.2 skrll int
42 1.2.2.2 skrll dl_print(char *buf, size_t len, const struct dl_addr *dl)
43 1.2.2.2 skrll {
44 1.2.2.2 skrll const uint8_t *ap = (const uint8_t *)dl->dl_data;
45 1.2.2.2 skrll char abuf[256 * 3], *cp, *ecp;
46 1.2.2.2 skrll
47 1.2.2.2 skrll ap += dl->dl_nlen;
48 1.2.2.2 skrll cp = abuf;
49 1.2.2.2 skrll ecp = abuf + sizeof(abuf);
50 1.2.2.2 skrll
51 1.2.2.2 skrll #define ADDC(c) do { \
52 1.2.2.2 skrll if (cp >= ecp) {\
53 1.2.2.2 skrll cp++; \
54 1.2.2.2 skrll } else \
55 1.2.2.2 skrll *cp++ = (char)(c); \
56 1.2.2.2 skrll } while (/*CONSTCOND*/0)
57 1.2.2.2 skrll
58 1.2.2.2 skrll #define ADDX(v) do { \
59 1.2.2.2 skrll uint8_t n = hexdigits[(v)]; \
60 1.2.2.2 skrll ADDC(n); \
61 1.2.2.2 skrll } while (/*CONSTCOND*/0)
62 1.2.2.2 skrll
63 1.2.2.2 skrll for (size_t i = 0; i < dl->dl_alen; i++) {
64 1.2.2.2 skrll ADDX((u_int)ap[i] >> 4);
65 1.2.2.2 skrll ADDX(ap[i] & 0xf);
66 1.2.2.2 skrll ADDC(':');
67 1.2.2.2 skrll }
68 1.2.2.2 skrll if (cp > abuf)
69 1.2.2.2 skrll --cp;
70 1.2.2.2 skrll if (ecp > abuf) {
71 1.2.2.2 skrll if (cp < ecp)
72 1.2.2.2 skrll *cp = '\0';
73 1.2.2.2 skrll else
74 1.2.2.2 skrll *--ecp = '\0';
75 1.2.2.2 skrll }
76 1.2.2.2 skrll return snprintf(buf, len, "%.*s/%hhu#%s",
77 1.2.2.2 skrll (int)dl->dl_nlen, dl->dl_data, dl->dl_type, abuf);
78 1.2.2.2 skrll }
79 1.2.2.2 skrll
80 1.2.2.2 skrll int
81 1.2.2.2 skrll sdl_print(char *buf, size_t len, const void *v)
82 1.2.2.2 skrll {
83 1.2.2.2 skrll const struct sockaddr_dl *sdl = v;
84 1.2.2.2 skrll char abuf[LINK_ADDRSTRLEN];
85 1.2.2.2 skrll
86 1.2.2.3 skrll if (sdl->sdl_slen == 0 && sdl->sdl_nlen == 0 && sdl->sdl_alen == 0)
87 1.2.2.3 skrll return snprintf(buf, len, "link#%hu", sdl->sdl_index);
88 1.2.2.3 skrll
89 1.2.2.2 skrll dl_print(abuf, sizeof(abuf), &sdl->sdl_addr);
90 1.2.2.2 skrll return snprintf(buf, len, "[%s]:%hu", abuf, sdl->sdl_index);
91 1.2.2.2 skrll }
92