1 | /* $NetBSD: in6_print.c,v 1.1 2014/12/02 19:36:58 christos Exp $ */ |
2 | |
3 | /*- |
4 | * Copyright (c) 2014 The NetBSD Foundation, Inc. |
5 | * All rights reserved. |
6 | * |
7 | * Redistribution and use in source and binary forms, with or without |
8 | * modification, are permitted provided that the following conditions |
9 | * are met: |
10 | * 1. Redistributions of source code must retain the above copyright |
11 | * notice, this list of conditions and the following disclaimer. |
12 | * 2. Redistributions in binary form must reproduce the above copyright |
13 | * notice, this list of conditions and the following disclaimer in the |
14 | * documentation and/or other materials provided with the distribution. |
15 | * |
16 | * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS |
17 | * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED |
18 | * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
19 | * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS |
20 | * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
21 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
22 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
23 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
24 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
25 | * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
26 | * POSSIBILITY OF SUCH DAMAGE. |
27 | */ |
28 | #include <sys/cdefs.h> |
29 | |
30 | #include <sys/types.h> |
31 | #ifdef _KERNEL |
32 | __KERNEL_RCSID(0, "$NetBSD: in6_print.c,v 1.1 2014/12/02 19:36:58 christos Exp $" ); |
33 | #include <sys/systm.h> |
34 | #else |
35 | __RCSID("$NetBSD: in6_print.c,v 1.1 2014/12/02 19:36:58 christos Exp $" ); |
36 | #include <stdio.h> |
37 | #define s6_addr32 __u6_addr.__u6_addr32 |
38 | static const uint8_t hexdigits[] = "0123456789abcdef" ; |
39 | #endif |
40 | |
41 | #include <netinet/in.h> |
42 | |
43 | int |
44 | in6_print(char *buf, size_t len, const struct in6_addr *ia6) |
45 | { |
46 | int i; |
47 | char *bp; |
48 | char *cp, *ecp; |
49 | const uint16_t *a; |
50 | const uint8_t *d; |
51 | int dcolon = 0; |
52 | |
53 | if (IN6_IS_ADDR_V4MAPPED(ia6)) { |
54 | char buf4[INET_ADDRSTRLEN]; |
55 | struct in_addr ia = { .s_addr = ia6->s6_addr32[3] }; |
56 | in_print(buf4, sizeof(buf4), &ia); |
57 | return snprintf(buf, len, "::ffff:%s" , buf4); |
58 | } |
59 | |
60 | #define ADDC(c) do { \ |
61 | if (cp >= ecp) {\ |
62 | cp++; \ |
63 | } else \ |
64 | *cp++ = (char)(c); \ |
65 | } while (/*CONSTCOND*/0) |
66 | #define ADDX(v) do { \ |
67 | uint8_t n = hexdigits[(v)]; \ |
68 | ADDC(n); \ |
69 | if (cp == bp && n == '0') \ |
70 | cp--; \ |
71 | } while (/*CONSTCOND*/0) |
72 | |
73 | cp = buf; |
74 | ecp = buf + len; |
75 | a = (const uint16_t *)ia6; |
76 | for (i = 0; i < 8; i++) { |
77 | if (dcolon == 1) { |
78 | if (*a == 0) { |
79 | if (i == 7) |
80 | ADDC(':'); |
81 | a++; |
82 | continue; |
83 | } else |
84 | dcolon = 2; |
85 | } |
86 | if (*a == 0) { |
87 | if (dcolon == 0 && *(a + 1) == 0) { |
88 | if (i == 0) |
89 | ADDC(':'); |
90 | ADDC(':'); |
91 | dcolon = 1; |
92 | } else { |
93 | ADDC('0'); |
94 | ADDC(':'); |
95 | } |
96 | a++; |
97 | continue; |
98 | } |
99 | d = (const u_char *)a; |
100 | bp = cp + 1; |
101 | |
102 | ADDX((u_int)*d >> 4); |
103 | ADDX(*d & 0xf); |
104 | d++; |
105 | ADDX((u_int)*d >> 4); |
106 | ADDX(*d & 0xf); |
107 | ADDC(':'); |
108 | a++; |
109 | } |
110 | if (cp > buf) |
111 | --cp; |
112 | if (ecp > buf) { |
113 | if (cp < ecp) |
114 | *cp = '\0'; |
115 | else |
116 | *--ecp = '\0'; |
117 | } |
118 | return (int)(cp - buf); |
119 | } |
120 | |
121 | int |
122 | sin6_print(char *buf, size_t len, const void *v) |
123 | { |
124 | const struct sockaddr_in6 *sin6 = v; |
125 | const struct in6_addr *ia6 = &sin6->sin6_addr; |
126 | char abuf[INET6_ADDRSTRLEN]; |
127 | |
128 | if (!sin6->sin6_port) |
129 | return in6_print(buf, len, ia6); |
130 | in6_print(abuf, sizeof(abuf), ia6); |
131 | return snprintf(buf, len, "[%s]:%hu" , abuf, ntohs(sin6->sin6_port)); |
132 | } |
133 | |