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