Home | History | Annotate | Line # | Download | only in net
dl_print.c revision 1.2.2.2
      1  1.2.2.2  skrll /*	$NetBSD: dl_print.c,v 1.2.2.2 2015/04/06 15:18:22 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.2  skrll __KERNEL_RCSID(0, "$NetBSD: dl_print.c,v 1.2.2.2 2015/04/06 15:18:22 skrll Exp $");
     33  1.2.2.2  skrll #include <sys/systm.h>
     34  1.2.2.2  skrll #else
     35  1.2.2.2  skrll __RCSID("$NetBSD: dl_print.c,v 1.2.2.2 2015/04/06 15:18:22 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.2  skrll 	dl_print(abuf, sizeof(abuf), &sdl->sdl_addr);
     87  1.2.2.2  skrll 	return snprintf(buf, len, "[%s]:%hu", abuf, sdl->sdl_index);
     88  1.2.2.2  skrll }
     89