1*84d9c625SLionel Sambuc /* $NetBSD: iso_addr.c,v 1.15 2013/03/01 18:25:16 joerg Exp $ */
22fe8fb19SBen Gras
32fe8fb19SBen Gras /*
42fe8fb19SBen Gras * Copyright (c) 1989, 1993
52fe8fb19SBen Gras * The Regents of the University of California. All rights reserved.
62fe8fb19SBen Gras *
72fe8fb19SBen Gras * Redistribution and use in source and binary forms, with or without
82fe8fb19SBen Gras * modification, are permitted provided that the following conditions
92fe8fb19SBen Gras * are met:
102fe8fb19SBen Gras * 1. Redistributions of source code must retain the above copyright
112fe8fb19SBen Gras * notice, this list of conditions and the following disclaimer.
122fe8fb19SBen Gras * 2. Redistributions in binary form must reproduce the above copyright
132fe8fb19SBen Gras * notice, this list of conditions and the following disclaimer in the
142fe8fb19SBen Gras * documentation and/or other materials provided with the distribution.
152fe8fb19SBen Gras * 3. Neither the name of the University nor the names of its contributors
162fe8fb19SBen Gras * may be used to endorse or promote products derived from this software
172fe8fb19SBen Gras * without specific prior written permission.
182fe8fb19SBen Gras *
192fe8fb19SBen Gras * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
202fe8fb19SBen Gras * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
212fe8fb19SBen Gras * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
222fe8fb19SBen Gras * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
232fe8fb19SBen Gras * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
242fe8fb19SBen Gras * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
252fe8fb19SBen Gras * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
262fe8fb19SBen Gras * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
272fe8fb19SBen Gras * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
282fe8fb19SBen Gras * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
292fe8fb19SBen Gras * SUCH DAMAGE.
302fe8fb19SBen Gras */
312fe8fb19SBen Gras
322fe8fb19SBen Gras #include <sys/cdefs.h>
332fe8fb19SBen Gras #if defined(LIBC_SCCS) && !defined(lint)
342fe8fb19SBen Gras #if 0
352fe8fb19SBen Gras static char sccsid[] = "@(#)iso_addr.c 8.1 (Berkeley) 6/4/93";
362fe8fb19SBen Gras #else
37*84d9c625SLionel Sambuc __RCSID("$NetBSD: iso_addr.c,v 1.15 2013/03/01 18:25:16 joerg Exp $");
382fe8fb19SBen Gras #endif
392fe8fb19SBen Gras #endif /* LIBC_SCCS and not lint */
402fe8fb19SBen Gras
412fe8fb19SBen Gras #include <sys/types.h>
422fe8fb19SBen Gras
432fe8fb19SBen Gras #include <assert.h>
442fe8fb19SBen Gras #include <string.h>
452fe8fb19SBen Gras
46*84d9c625SLionel Sambuc struct iso_addr {
47*84d9c625SLionel Sambuc uint8_t isoa_len; /* length (in bytes) */
48*84d9c625SLionel Sambuc char isoa_genaddr[20]; /* general opaque address */
49*84d9c625SLionel Sambuc };
50*84d9c625SLionel Sambuc
51*84d9c625SLionel Sambuc __BEGIN_DECLS
52*84d9c625SLionel Sambuc struct iso_addr *iso_addr(const char *);
53*84d9c625SLionel Sambuc char *iso_ntoa(const struct iso_addr *);
54*84d9c625SLionel Sambuc __END_DECLS
55*84d9c625SLionel Sambuc
562fe8fb19SBen Gras /* States*/
572fe8fb19SBen Gras #define VIRGIN 0
582fe8fb19SBen Gras #define GOTONE 1
592fe8fb19SBen Gras #define GOTTWO 2
602fe8fb19SBen Gras /* Inputs */
612fe8fb19SBen Gras #define DIGIT (4*0)
622fe8fb19SBen Gras #define END (4*1)
632fe8fb19SBen Gras #define DELIM (4*2)
642fe8fb19SBen Gras
652fe8fb19SBen Gras struct iso_addr *
iso_addr(const char * addr)66f14fb602SLionel Sambuc iso_addr(const char *addr)
672fe8fb19SBen Gras {
682fe8fb19SBen Gras static struct iso_addr out_addr;
692fe8fb19SBen Gras register char *cp = out_addr.isoa_genaddr;
702fe8fb19SBen Gras char *cplim = cp + sizeof(out_addr.isoa_genaddr);
712fe8fb19SBen Gras register int byte = 0, state = VIRGIN;
722fe8fb19SBen Gras register int newaddr = 0; /* pacify gcc */
732fe8fb19SBen Gras
742fe8fb19SBen Gras _DIAGASSERT(addr != NULL);
752fe8fb19SBen Gras
762fe8fb19SBen Gras (void)memset(&out_addr, 0, sizeof (out_addr));
772fe8fb19SBen Gras do {
782fe8fb19SBen Gras if ((*addr >= '0') && (*addr <= '9')) {
792fe8fb19SBen Gras newaddr = *addr - '0';
802fe8fb19SBen Gras } else if ((*addr >= 'a') && (*addr <= 'f')) {
812fe8fb19SBen Gras newaddr = *addr - 'a' + 10;
822fe8fb19SBen Gras } else if ((*addr >= 'A') && (*addr <= 'F')) {
832fe8fb19SBen Gras newaddr = *addr - 'A' + 10;
842fe8fb19SBen Gras } else if (*addr == 0)
852fe8fb19SBen Gras state |= END;
862fe8fb19SBen Gras else
872fe8fb19SBen Gras state |= DELIM;
882fe8fb19SBen Gras addr++;
892fe8fb19SBen Gras switch (state /* | INPUT */) {
902fe8fb19SBen Gras case GOTTWO | DIGIT:
912fe8fb19SBen Gras *cp++ = byte; /*FALLTHROUGH*/
922fe8fb19SBen Gras case VIRGIN | DIGIT:
932fe8fb19SBen Gras state = GOTONE; byte = newaddr; continue;
942fe8fb19SBen Gras case GOTONE | DIGIT:
952fe8fb19SBen Gras state = GOTTWO; byte = newaddr + (byte << 4); continue;
962fe8fb19SBen Gras default: /* | DELIM */
972fe8fb19SBen Gras state = VIRGIN; *cp++ = byte; byte = 0; continue;
982fe8fb19SBen Gras case GOTONE | END:
992fe8fb19SBen Gras case GOTTWO | END:
1002fe8fb19SBen Gras *cp++ = byte; /* FALLTHROUGH */
1012fe8fb19SBen Gras case VIRGIN | END:
1022fe8fb19SBen Gras break;
1032fe8fb19SBen Gras }
1042fe8fb19SBen Gras break;
1052fe8fb19SBen Gras } while (cp < cplim);
106f14fb602SLionel Sambuc _DIAGASSERT(__type_fit(uint8_t, cp - out_addr.isoa_genaddr));
107f14fb602SLionel Sambuc out_addr.isoa_len = (uint8_t)(cp - out_addr.isoa_genaddr);
1082fe8fb19SBen Gras return (&out_addr);
1092fe8fb19SBen Gras }
1102fe8fb19SBen Gras
1112fe8fb19SBen Gras static const char hexlist[16] = "0123456789abcdef";
1122fe8fb19SBen Gras
1132fe8fb19SBen Gras char *
iso_ntoa(const struct iso_addr * isoa)114f14fb602SLionel Sambuc iso_ntoa(const struct iso_addr *isoa)
1152fe8fb19SBen Gras {
1162fe8fb19SBen Gras static char obuf[64];
1172fe8fb19SBen Gras char *out = obuf;
1182fe8fb19SBen Gras size_t i;
1192fe8fb19SBen Gras const u_char *in = (const u_char *)isoa->isoa_genaddr;
1202fe8fb19SBen Gras const u_char *inlim = in + isoa->isoa_len;
1212fe8fb19SBen Gras
1222fe8fb19SBen Gras _DIAGASSERT(isoa != NULL);
1232fe8fb19SBen Gras
1242fe8fb19SBen Gras out[1] = 0;
1252fe8fb19SBen Gras while (in < inlim) {
1262fe8fb19SBen Gras i = *in++;
1272fe8fb19SBen Gras *out++ = '.';
1282fe8fb19SBen Gras if (i > 0xf) {
1292fe8fb19SBen Gras out[1] = hexlist[i & 0xf];
1302fe8fb19SBen Gras i >>= 4;
1312fe8fb19SBen Gras out[0] = hexlist[i];
1322fe8fb19SBen Gras out += 2;
1332fe8fb19SBen Gras } else
1342fe8fb19SBen Gras *out++ = hexlist[i];
1352fe8fb19SBen Gras }
1362fe8fb19SBen Gras *out = 0;
1372fe8fb19SBen Gras return(obuf + 1);
1382fe8fb19SBen Gras }
139