Home | History | Annotate | Line # | Download | only in net
linkaddr.c revision 1.5
      1  1.5  cgd /*	$NetBSD: linkaddr.c,v 1.5 1995/02/25 06:20:49 cgd Exp $	*/
      2  1.5  cgd 
      3  1.1  cgd /*-
      4  1.5  cgd  * Copyright (c) 1990, 1993
      5  1.5  cgd  *	The Regents of the University of California.  All rights reserved.
      6  1.1  cgd  *
      7  1.1  cgd  * Redistribution and use in source and binary forms, with or without
      8  1.1  cgd  * modification, are permitted provided that the following conditions
      9  1.1  cgd  * are met:
     10  1.1  cgd  * 1. Redistributions of source code must retain the above copyright
     11  1.1  cgd  *    notice, this list of conditions and the following disclaimer.
     12  1.1  cgd  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  cgd  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  cgd  *    documentation and/or other materials provided with the distribution.
     15  1.1  cgd  * 3. All advertising materials mentioning features or use of this software
     16  1.1  cgd  *    must display the following acknowledgement:
     17  1.1  cgd  *	This product includes software developed by the University of
     18  1.1  cgd  *	California, Berkeley and its contributors.
     19  1.1  cgd  * 4. Neither the name of the University nor the names of its contributors
     20  1.1  cgd  *    may be used to endorse or promote products derived from this software
     21  1.1  cgd  *    without specific prior written permission.
     22  1.1  cgd  *
     23  1.1  cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     24  1.1  cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     25  1.1  cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     26  1.1  cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     27  1.1  cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     28  1.1  cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     29  1.1  cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     30  1.1  cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     31  1.1  cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     32  1.1  cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     33  1.1  cgd  * SUCH DAMAGE.
     34  1.1  cgd  */
     35  1.1  cgd 
     36  1.1  cgd #if defined(LIBC_SCCS) && !defined(lint)
     37  1.5  cgd #if 0
     38  1.5  cgd static char sccsid[] = "@(#)linkaddr.c	8.1 (Berkeley) 6/4/93";
     39  1.5  cgd #else
     40  1.5  cgd static char rcsid[] = "$NetBSD: linkaddr.c,v 1.5 1995/02/25 06:20:49 cgd Exp $";
     41  1.5  cgd #endif
     42  1.1  cgd #endif /* LIBC_SCCS and not lint */
     43  1.1  cgd 
     44  1.1  cgd #include <sys/types.h>
     45  1.1  cgd #include <sys/socket.h>
     46  1.1  cgd #include <net/if_dl.h>
     47  1.1  cgd #include <string.h>
     48  1.1  cgd 
     49  1.1  cgd /* States*/
     50  1.1  cgd #define NAMING	0
     51  1.1  cgd #define GOTONE	1
     52  1.1  cgd #define GOTTWO	2
     53  1.1  cgd #define RESET	3
     54  1.1  cgd /* Inputs */
     55  1.1  cgd #define	DIGIT	(4*0)
     56  1.1  cgd #define	END	(4*1)
     57  1.1  cgd #define DELIM	(4*2)
     58  1.1  cgd #define LETTER	(4*3)
     59  1.1  cgd 
     60  1.1  cgd void
     61  1.1  cgd link_addr(addr, sdl)
     62  1.1  cgd 	register const char *addr;
     63  1.1  cgd 	register struct sockaddr_dl *sdl;
     64  1.1  cgd {
     65  1.1  cgd 	register char *cp = sdl->sdl_data;
     66  1.1  cgd 	char *cplim = sdl->sdl_len + (char *)sdl;
     67  1.1  cgd 	register int byte = 0, state = NAMING, new;
     68  1.1  cgd 
     69  1.1  cgd 	bzero((char *)&sdl->sdl_family, sdl->sdl_len - 1);
     70  1.1  cgd 	sdl->sdl_family = AF_LINK;
     71  1.1  cgd 	do {
     72  1.1  cgd 		state &= ~LETTER;
     73  1.1  cgd 		if ((*addr >= '0') && (*addr <= '9')) {
     74  1.1  cgd 			new = *addr - '0';
     75  1.1  cgd 		} else if ((*addr >= 'a') && (*addr <= 'f')) {
     76  1.1  cgd 			new = *addr - 'a' + 10;
     77  1.1  cgd 		} else if ((*addr >= 'A') && (*addr <= 'F')) {
     78  1.1  cgd 			new = *addr - 'A' + 10;
     79  1.1  cgd 		} else if (*addr == 0) {
     80  1.1  cgd 			state |= END;
     81  1.1  cgd 		} else if (state == NAMING &&
     82  1.1  cgd 			   (((*addr >= 'A') && (*addr <= 'Z')) ||
     83  1.1  cgd 			   ((*addr >= 'a') && (*addr <= 'z'))))
     84  1.1  cgd 			state |= LETTER;
     85  1.1  cgd 		else
     86  1.1  cgd 			state |= DELIM;
     87  1.1  cgd 		addr++;
     88  1.1  cgd 		switch (state /* | INPUT */) {
     89  1.1  cgd 		case NAMING | DIGIT:
     90  1.1  cgd 		case NAMING | LETTER:
     91  1.5  cgd 			*cp++ = addr[-1];
     92  1.5  cgd 			continue;
     93  1.1  cgd 		case NAMING | DELIM:
     94  1.5  cgd 			state = RESET;
     95  1.5  cgd 			sdl->sdl_nlen = cp - sdl->sdl_data;
     96  1.5  cgd 			continue;
     97  1.1  cgd 		case GOTTWO | DIGIT:
     98  1.5  cgd 			*cp++ = byte;
     99  1.5  cgd 			/* FALLTHROUGH */
    100  1.1  cgd 		case RESET | DIGIT:
    101  1.5  cgd 			state = GOTONE;
    102  1.5  cgd 			byte = new;
    103  1.5  cgd 			continue;
    104  1.1  cgd 		case GOTONE | DIGIT:
    105  1.5  cgd 			state = GOTTWO;
    106  1.5  cgd 			byte = new + (byte << 4);
    107  1.5  cgd 			continue;
    108  1.1  cgd 		default: /* | DELIM */
    109  1.5  cgd 			state = RESET;
    110  1.5  cgd 			*cp++ = byte;
    111  1.5  cgd 			byte = 0;
    112  1.5  cgd 			continue;
    113  1.1  cgd 		case GOTONE | END:
    114  1.1  cgd 		case GOTTWO | END:
    115  1.5  cgd 			*cp++ = byte;
    116  1.5  cgd 			/* FALLTHROUGH */
    117  1.1  cgd 		case RESET | END:
    118  1.1  cgd 			break;
    119  1.1  cgd 		}
    120  1.1  cgd 		break;
    121  1.1  cgd 	} while (cp < cplim);
    122  1.1  cgd 	sdl->sdl_alen = cp - LLADDR(sdl);
    123  1.1  cgd 	new = cp - (char *)sdl;
    124  1.1  cgd 	if (new > sizeof(*sdl))
    125  1.1  cgd 		sdl->sdl_len = new;
    126  1.1  cgd 	return;
    127  1.1  cgd }
    128  1.1  cgd 
    129  1.1  cgd static char hexlist[] = "0123456789abcdef";
    130  1.1  cgd 
    131  1.1  cgd char *
    132  1.1  cgd link_ntoa(sdl)
    133  1.1  cgd 	register const struct sockaddr_dl *sdl;
    134  1.1  cgd {
    135  1.1  cgd 	static char obuf[64];
    136  1.1  cgd 	register char *out = obuf;
    137  1.1  cgd 	register int i;
    138  1.1  cgd 	register u_char *in = (u_char *)LLADDR(sdl);
    139  1.5  cgd 	u_char *inlim = in + sdl->sdl_alen;
    140  1.1  cgd 	int firsttime = 1;
    141  1.1  cgd 
    142  1.1  cgd 	if (sdl->sdl_nlen) {
    143  1.1  cgd 		bcopy(sdl->sdl_data, obuf, sdl->sdl_nlen);
    144  1.1  cgd 		out += sdl->sdl_nlen;
    145  1.5  cgd 		if (sdl->sdl_alen)
    146  1.5  cgd 			*out++ = ':';
    147  1.1  cgd 	}
    148  1.1  cgd 	while (in < inlim) {
    149  1.5  cgd 		if (firsttime)
    150  1.5  cgd 			firsttime = 0;
    151  1.5  cgd 		else
    152  1.5  cgd 			*out++ = '.';
    153  1.1  cgd 		i = *in++;
    154  1.1  cgd 		if (i > 0xf) {
    155  1.1  cgd 			out[1] = hexlist[i & 0xf];
    156  1.1  cgd 			i >>= 4;
    157  1.1  cgd 			out[0] = hexlist[i];
    158  1.1  cgd 			out += 2;
    159  1.1  cgd 		} else
    160  1.1  cgd 			*out++ = hexlist[i];
    161  1.1  cgd 	}
    162  1.1  cgd 	*out = 0;
    163  1.5  cgd 	return (obuf);
    164  1.1  cgd }
    165