stty: simplify linewrapping code a bit
[oweals/busybox.git] / networking / ifconfig.c
1 /* vi: set sw=4 ts=4: */
2 /* ifconfig
3  *
4  * Similar to the standard Unix ifconfig, but with only the necessary
5  * parts for AF_INET, and without any printing of if info (for now).
6  *
7  * Bjorn Wesen, Axis Communications AB
8  *
9  *
10  * Authors of the original ifconfig was:
11  *              Fred N. van Kempen, <waltje@uwalt.nl.mugnet.org>
12  *
13  * Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
14  */
15
16 /*
17  * Heavily modified by Manuel Novoa III       Mar 6, 2001
18  *
19  * From initial port to busybox, removed most of the redundancy by
20  * converting to a table-driven approach.  Added several (optional)
21  * args missing from initial port.
22  *
23  * Still missing:  media, tunnel.
24  *
25  * 2002-04-20
26  * IPV6 support added by Bart Visscher <magick@linux-fan.com>
27  */
28
29 #include <net/if.h>
30 #include <net/if_arp.h>
31 #include <netinet/in.h>
32 #if __GLIBC__ >=2 && __GLIBC_MINOR >= 1
33 #include <netpacket/packet.h>
34 #include <net/ethernet.h>
35 #else
36 #include <sys/types.h>
37 #include <netinet/if_ether.h>
38 #endif
39 #include "inet_common.h"
40 #include "busybox.h"
41
42 #ifdef CONFIG_FEATURE_IFCONFIG_SLIP
43 # include <net/if_slip.h>
44 #endif
45
46 /* I don't know if this is needed for busybox or not.  Anyone? */
47 #define QUESTIONABLE_ALIAS_CASE
48
49
50 /* Defines for glibc2.0 users. */
51 #ifndef SIOCSIFTXQLEN
52 # define SIOCSIFTXQLEN      0x8943
53 # define SIOCGIFTXQLEN      0x8942
54 #endif
55
56 /* ifr_qlen is ifru_ivalue, but it isn't present in 2.0 kernel headers */
57 #ifndef ifr_qlen
58 # define ifr_qlen        ifr_ifru.ifru_mtu
59 #endif
60
61 #ifndef IFF_DYNAMIC
62 # define IFF_DYNAMIC     0x8000 /* dialup device with changing addresses */
63 #endif
64
65 #ifdef CONFIG_FEATURE_IPV6
66 struct in6_ifreq {
67         struct in6_addr ifr6_addr;
68         uint32_t ifr6_prefixlen;
69         int ifr6_ifindex;
70 };
71 #endif
72
73 /*
74  * Here are the bit masks for the "flags" member of struct options below.
75  * N_ signifies no arg prefix; M_ signifies arg prefixed by '-'.
76  * CLR clears the flag; SET sets the flag; ARG signifies (optional) arg.
77  */
78 #define N_CLR            0x01
79 #define M_CLR            0x02
80 #define N_SET            0x04
81 #define M_SET            0x08
82 #define N_ARG            0x10
83 #define M_ARG            0x20
84
85 #define M_MASK           (M_CLR | M_SET | M_ARG)
86 #define N_MASK           (N_CLR | N_SET | N_ARG)
87 #define SET_MASK         (N_SET | M_SET)
88 #define CLR_MASK         (N_CLR | M_CLR)
89 #define SET_CLR_MASK     (SET_MASK | CLR_MASK)
90 #define ARG_MASK         (M_ARG | N_ARG)
91
92 /*
93  * Here are the bit masks for the "arg_flags" member of struct options below.
94  */
95
96 /*
97  * cast type:
98  *   00 int
99  *   01 char *
100  *   02 HOST_COPY in_ether
101  *   03 HOST_COPY INET_resolve
102  */
103 #define A_CAST_TYPE      0x03
104 /*
105  * map type:
106  *   00 not a map type (mem_start, io_addr, irq)
107  *   04 memstart (unsigned long)
108  *   08 io_addr  (unsigned short)
109  *   0C irq      (unsigned char)
110  */
111 #define A_MAP_TYPE       0x0C
112 #define A_ARG_REQ        0x10   /* Set if an arg is required. */
113 #define A_NETMASK        0x20   /* Set if netmask (check for multiple sets). */
114 #define A_SET_AFTER      0x40   /* Set a flag at the end. */
115 #define A_COLON_CHK      0x80   /* Is this needed?  See below. */
116 #ifdef CONFIG_FEATURE_IFCONFIG_BROADCAST_PLUS
117 #define A_HOSTNAME      0x100   /* Set if it is ip addr. */
118 #define A_BROADCAST     0x200   /* Set if it is broadcast addr. */
119 #else
120 #define A_HOSTNAME          0
121 #define A_BROADCAST         0
122 #endif
123
124 /*
125  * These defines are for dealing with the A_CAST_TYPE field.
126  */
127 #define A_CAST_CHAR_PTR  0x01
128 #define A_CAST_RESOLVE   0x01
129 #define A_CAST_HOST_COPY 0x02
130 #define A_CAST_HOST_COPY_IN_ETHER    A_CAST_HOST_COPY
131 #define A_CAST_HOST_COPY_RESOLVE     (A_CAST_HOST_COPY | A_CAST_RESOLVE)
132
133 /*
134  * These defines are for dealing with the A_MAP_TYPE field.
135  */
136 #define A_MAP_ULONG      0x04   /* memstart */
137 #define A_MAP_USHORT     0x08   /* io_addr */
138 #define A_MAP_UCHAR      0x0C   /* irq */
139
140 /*
141  * Define the bit masks signifying which operations to perform for each arg.
142  */
143
144 #define ARG_METRIC       (A_ARG_REQ /*| A_CAST_INT*/)
145 #define ARG_MTU          (A_ARG_REQ /*| A_CAST_INT*/)
146 #define ARG_TXQUEUELEN   (A_ARG_REQ /*| A_CAST_INT*/)
147 #define ARG_MEM_START    (A_ARG_REQ | A_MAP_ULONG)
148 #define ARG_IO_ADDR      (A_ARG_REQ | A_MAP_ULONG)
149 #define ARG_IRQ          (A_ARG_REQ | A_MAP_UCHAR)
150 #define ARG_DSTADDR      (A_ARG_REQ | A_CAST_HOST_COPY_RESOLVE)
151 #define ARG_NETMASK      (A_ARG_REQ | A_CAST_HOST_COPY_RESOLVE | A_NETMASK)
152 #define ARG_BROADCAST    (A_ARG_REQ | A_CAST_HOST_COPY_RESOLVE | A_SET_AFTER | A_BROADCAST)
153 #define ARG_HW           (A_ARG_REQ | A_CAST_HOST_COPY_IN_ETHER)
154 #define ARG_POINTOPOINT  (A_ARG_REQ | A_CAST_HOST_COPY_RESOLVE | A_SET_AFTER)
155 #define ARG_KEEPALIVE    (A_ARG_REQ | A_CAST_CHAR_PTR)
156 #define ARG_OUTFILL      (A_ARG_REQ | A_CAST_CHAR_PTR)
157 #define ARG_HOSTNAME     (A_CAST_HOST_COPY_RESOLVE | A_SET_AFTER | A_COLON_CHK | A_HOSTNAME)
158 #define ARG_ADD_DEL      (A_CAST_HOST_COPY_RESOLVE | A_SET_AFTER)
159
160
161 /*
162  * Set up the tables.  Warning!  They must have corresponding order!
163  */
164
165 struct arg1opt {
166         const char *name;
167         int selector;
168         unsigned short ifr_offset;
169 };
170
171 struct options {
172         const char *name;
173 #ifdef CONFIG_FEATURE_IFCONFIG_BROADCAST_PLUS
174         const unsigned int flags:6;
175         const unsigned int arg_flags:10;
176 #else
177         const unsigned char flags;
178         const unsigned char arg_flags;
179 #endif
180         const unsigned short selector;
181 };
182
183 #define ifreq_offsetof(x)  offsetof(struct ifreq, x)
184
185 static const struct arg1opt Arg1Opt[] = {
186         {"SIOCSIFMETRIC",  SIOCSIFMETRIC,  ifreq_offsetof(ifr_metric)},
187         {"SIOCSIFMTU",     SIOCSIFMTU,     ifreq_offsetof(ifr_mtu)},
188         {"SIOCSIFTXQLEN",  SIOCSIFTXQLEN,  ifreq_offsetof(ifr_qlen)},
189         {"SIOCSIFDSTADDR", SIOCSIFDSTADDR, ifreq_offsetof(ifr_dstaddr)},
190         {"SIOCSIFNETMASK", SIOCSIFNETMASK, ifreq_offsetof(ifr_netmask)},
191         {"SIOCSIFBRDADDR", SIOCSIFBRDADDR, ifreq_offsetof(ifr_broadaddr)},
192 #ifdef CONFIG_FEATURE_IFCONFIG_HW
193         {"SIOCSIFHWADDR",  SIOCSIFHWADDR,  ifreq_offsetof(ifr_hwaddr)},
194 #endif
195         {"SIOCSIFDSTADDR", SIOCSIFDSTADDR, ifreq_offsetof(ifr_dstaddr)},
196 #ifdef SIOCSKEEPALIVE
197         {"SIOCSKEEPALIVE", SIOCSKEEPALIVE, ifreq_offsetof(ifr_data)},
198 #endif
199 #ifdef SIOCSOUTFILL
200         {"SIOCSOUTFILL",   SIOCSOUTFILL,   ifreq_offsetof(ifr_data)},
201 #endif
202 #ifdef CONFIG_FEATURE_IFCONFIG_MEMSTART_IOADDR_IRQ
203         {"SIOCSIFMAP",     SIOCSIFMAP,     ifreq_offsetof(ifr_map.mem_start)},
204         {"SIOCSIFMAP",     SIOCSIFMAP,     ifreq_offsetof(ifr_map.base_addr)},
205         {"SIOCSIFMAP",     SIOCSIFMAP,     ifreq_offsetof(ifr_map.irq)},
206 #endif
207         /* Last entry if for unmatched (possibly hostname) arg. */
208 #ifdef CONFIG_FEATURE_IPV6
209         {"SIOCSIFADDR",    SIOCSIFADDR,    ifreq_offsetof(ifr_addr)}, /* IPv6 version ignores the offset */
210         {"SIOCDIFADDR",    SIOCDIFADDR,    ifreq_offsetof(ifr_addr)}, /* IPv6 version ignores the offset */
211 #endif
212         {"SIOCSIFADDR",    SIOCSIFADDR,    ifreq_offsetof(ifr_addr)},
213 };
214
215 static const struct options OptArray[] = {
216         {"metric",      N_ARG,         ARG_METRIC,      0},
217         {"mtu",         N_ARG,         ARG_MTU,         0},
218         {"txqueuelen",  N_ARG,         ARG_TXQUEUELEN,  0},
219         {"dstaddr",     N_ARG,         ARG_DSTADDR,     0},
220         {"netmask",     N_ARG,         ARG_NETMASK,     0},
221         {"broadcast",   N_ARG | M_CLR, ARG_BROADCAST,   IFF_BROADCAST},
222 #ifdef CONFIG_FEATURE_IFCONFIG_HW
223         {"hw",          N_ARG, ARG_HW,                  0},
224 #endif
225         {"pointopoint", N_ARG | M_CLR, ARG_POINTOPOINT, IFF_POINTOPOINT},
226 #ifdef SIOCSKEEPALIVE
227         {"keepalive",   N_ARG,         ARG_KEEPALIVE,   0},
228 #endif
229 #ifdef SIOCSOUTFILL
230         {"outfill",     N_ARG,         ARG_OUTFILL,     0},
231 #endif
232 #ifdef CONFIG_FEATURE_IFCONFIG_MEMSTART_IOADDR_IRQ
233         {"mem_start",   N_ARG,         ARG_MEM_START,   0},
234         {"io_addr",     N_ARG,         ARG_IO_ADDR,     0},
235         {"irq",         N_ARG,         ARG_IRQ,         0},
236 #endif
237 #ifdef CONFIG_FEATURE_IPV6
238         {"add",         N_ARG,         ARG_ADD_DEL,     0},
239         {"del",         N_ARG,         ARG_ADD_DEL,     0},
240 #endif
241         {"arp",         N_CLR | M_SET, 0,               IFF_NOARP},
242         {"trailers",    N_CLR | M_SET, 0,               IFF_NOTRAILERS},
243         {"promisc",     N_SET | M_CLR, 0,               IFF_PROMISC},
244         {"multicast",   N_SET | M_CLR, 0,               IFF_MULTICAST},
245         {"allmulti",    N_SET | M_CLR, 0,               IFF_ALLMULTI},
246         {"dynamic",     N_SET | M_CLR, 0,               IFF_DYNAMIC},
247         {"up",          N_SET,         0,               (IFF_UP | IFF_RUNNING)},
248         {"down",        N_CLR,         0,               IFF_UP},
249         {NULL,          0,             ARG_HOSTNAME,    (IFF_UP | IFF_RUNNING)}
250 };
251
252 /*
253  * A couple of prototypes.
254  */
255
256 #ifdef CONFIG_FEATURE_IFCONFIG_HW
257 static int in_ether(char *bufp, struct sockaddr *sap);
258 #endif
259
260 #ifdef CONFIG_FEATURE_IFCONFIG_STATUS
261 extern int interface_opt_a;
262 extern int display_interfaces(char *ifname);
263 #endif
264
265 /*
266  * Our main function.
267  */
268
269 int ifconfig_main(int argc, char **argv)
270 {
271         struct ifreq ifr;
272         struct sockaddr_in sai;
273 #ifdef CONFIG_FEATURE_IPV6
274         struct sockaddr_in6 sai6;
275 #endif
276 #ifdef CONFIG_FEATURE_IFCONFIG_HW
277         struct sockaddr sa;
278 #endif
279         const struct arg1opt *a1op;
280         const struct options *op;
281         int sockfd;                     /* socket fd we use to manipulate stuff with */
282         int goterr;
283         int selector;
284 #ifdef CONFIG_FEATURE_IFCONFIG_BROADCAST_PLUS
285         unsigned int mask;
286         unsigned int did_flags;
287         unsigned int sai_hostname, sai_netmask;
288 #else
289         unsigned char mask;
290         unsigned char did_flags;
291 #endif
292         char *p;
293         char host[128];
294
295         goterr = 0;
296         did_flags = 0;
297 #ifdef CONFIG_FEATURE_IFCONFIG_BROADCAST_PLUS
298         sai_hostname = 0;
299         sai_netmask = 0;
300 #endif
301
302         /* skip argv[0] */
303         ++argv;
304         --argc;
305
306 #ifdef CONFIG_FEATURE_IFCONFIG_STATUS
307         if ((argc > 0) && (((*argv)[0] == '-') && ((*argv)[1] == 'a') && !(*argv)[2])) {
308                 interface_opt_a = 1;
309                 --argc;
310                 ++argv;
311         }
312 #endif
313
314         if (argc <= 1) {
315 #ifdef CONFIG_FEATURE_IFCONFIG_STATUS
316                 return display_interfaces(argc ? *argv : NULL);
317 #else
318                 bb_error_msg_and_die
319                         ("ifconfig was not compiled with interface status display support.");
320 #endif
321         }
322
323         /* Create a channel to the NET kernel. */
324         sockfd = xsocket(AF_INET, SOCK_DGRAM, 0);
325
326         /* get interface name */
327         safe_strncpy(ifr.ifr_name, *argv, IFNAMSIZ);
328
329         /* Process the remaining arguments. */
330         while (*++argv != (char *) NULL) {
331                 p = *argv;
332                 mask = N_MASK;
333                 if (*p == '-') {        /* If the arg starts with '-'... */
334                         ++p;            /*    advance past it and */
335                         mask = M_MASK;  /*    set the appropriate mask. */
336                 }
337                 for (op = OptArray; op->name; op++) {   /* Find table entry. */
338                         if (strcmp(p, op->name) == 0) { /* If name matches... */
339                                 if ((mask &= op->flags)) {      /* set the mask and go. */
340                                         goto FOUND_ARG;
341                                 }
342                                 /* If we get here, there was a valid arg with an */
343                                 /* invalid '-' prefix. */
344                                 ++goterr;
345                                 goto LOOP;
346                         }
347                 }
348
349                 /* We fell through, so treat as possible hostname. */
350                 a1op = Arg1Opt + (sizeof(Arg1Opt) / sizeof(Arg1Opt[0])) - 1;
351                 mask = op->arg_flags;
352                 goto HOSTNAME;
353
354           FOUND_ARG:
355                 if (mask & ARG_MASK) {
356                         mask = op->arg_flags;
357                         a1op = Arg1Opt + (op - OptArray);
358                         if (mask & A_NETMASK & did_flags) {
359                                 bb_show_usage();
360                         }
361                         if (*++argv == NULL) {
362                                 if (mask & A_ARG_REQ) {
363                                         bb_show_usage();
364                                 } else {
365                                         --argv;
366                                         mask &= A_SET_AFTER;    /* just for broadcast */
367                                 }
368                         } else {        /* got an arg so process it */
369                           HOSTNAME:
370                                 did_flags |= (mask & (A_NETMASK|A_HOSTNAME));
371                                 if (mask & A_CAST_HOST_COPY) {
372 #ifdef CONFIG_FEATURE_IFCONFIG_HW
373                                         if (mask & A_CAST_RESOLVE) {
374 #endif
375 #ifdef CONFIG_FEATURE_IPV6
376                                                 char *prefix;
377                                                 int prefix_len = 0;
378 #endif
379
380                                                 safe_strncpy(host, *argv, (sizeof host));
381 #ifdef CONFIG_FEATURE_IPV6
382                                                 if ((prefix = strchr(host, '/'))) {
383                                                         if (safe_strtoi(prefix + 1, &prefix_len) ||
384                                                                 (prefix_len < 0) || (prefix_len > 128))
385                                                         {
386                                                                 ++goterr;
387                                                                 goto LOOP;
388                                                         }
389                                                         *prefix = 0;
390                                                 }
391 #endif
392
393                                                 sai.sin_family = AF_INET;
394                                                 sai.sin_port = 0;
395                                                 if (!strcmp(host, bb_INET_default)) {
396                                                         /* Default is special, meaning 0.0.0.0. */
397                                                         sai.sin_addr.s_addr = INADDR_ANY;
398 #ifdef CONFIG_FEATURE_IFCONFIG_BROADCAST_PLUS
399                                                 } else if (((host[0] == '+') && !host[1]) && (mask & A_BROADCAST) &&
400                                                                    (did_flags & (A_NETMASK|A_HOSTNAME)) == (A_NETMASK|A_HOSTNAME)) {
401                                                         /* + is special, meaning broadcast is derived. */
402                                                         sai.sin_addr.s_addr = (~sai_netmask) | (sai_hostname & sai_netmask);
403 #endif
404 #ifdef CONFIG_FEATURE_IPV6
405                                                 } else if (inet_pton(AF_INET6, host, &sai6.sin6_addr) > 0) {
406                                                         int sockfd6;
407                                                         struct in6_ifreq ifr6;
408
409                                                         memcpy((char *) &ifr6.ifr6_addr,
410                                                                    (char *) &sai6.sin6_addr,
411                                                                    sizeof(struct in6_addr));
412
413                                                         /* Create a channel to the NET kernel. */
414                                                         if ((sockfd6 = socket(AF_INET6, SOCK_DGRAM, 0)) < 0) {
415                                                                 bb_perror_msg_and_die("socket6");
416                                                         }
417                                                         if (ioctl(sockfd6, SIOGIFINDEX, &ifr) < 0) {
418                                                                 perror("SIOGIFINDEX");
419                                                                 ++goterr;
420                                                                 continue;
421                                                         }
422                                                         ifr6.ifr6_ifindex = ifr.ifr_ifindex;
423                                                         ifr6.ifr6_prefixlen = prefix_len;
424                                                         if (ioctl(sockfd6, a1op->selector, &ifr6) < 0) {
425                                                                 perror(a1op->name);
426                                                                 ++goterr;
427                                                         }
428                                                         continue;
429 #endif
430                                                 } else if (inet_aton(host, &sai.sin_addr) == 0) {
431                                                         /* It's not a dotted quad. */
432                                                         struct hostent *hp;
433                                                         if ((hp = gethostbyname(host)) == (struct hostent *)NULL) {
434                                                                 ++goterr;
435                                                                 continue;
436                                                         }
437                                                         memcpy((char *) &sai.sin_addr, (char *) hp->h_addr_list[0],
438                                                         sizeof(struct in_addr));
439                                                 }
440 #ifdef CONFIG_FEATURE_IFCONFIG_BROADCAST_PLUS
441                                                 if (mask & A_HOSTNAME) {
442                                                         sai_hostname = sai.sin_addr.s_addr;
443                                                 }
444                                                 if (mask & A_NETMASK) {
445                                                         sai_netmask = sai.sin_addr.s_addr;
446                                                 }
447 #endif
448                                                 p = (char *) &sai;
449 #ifdef CONFIG_FEATURE_IFCONFIG_HW
450                                         } else {        /* A_CAST_HOST_COPY_IN_ETHER */
451                                                 /* This is the "hw" arg case. */
452                                                 if (strcmp("ether", *argv) || (*++argv == NULL)) {
453                                                         bb_show_usage();
454                                                 }
455                                                 safe_strncpy(host, *argv, (sizeof host));
456                                                 if (in_ether(host, &sa)) {
457                                                         bb_error_msg("invalid hw-addr %s", host);
458                                                         ++goterr;
459                                                         continue;
460                                                 }
461                                                 p = (char *) &sa;
462                                         }
463 #endif
464                                         memcpy((((char *) (&ifr)) + a1op->ifr_offset),
465                                                    p, sizeof(struct sockaddr));
466                                 } else {
467                                         unsigned long i = strtoul(*argv, NULL, 0);
468
469                                         p = ((char *) (&ifr)) + a1op->ifr_offset;
470 #ifdef CONFIG_FEATURE_IFCONFIG_MEMSTART_IOADDR_IRQ
471                                         if (mask & A_MAP_TYPE) {
472                                                 if (ioctl(sockfd, SIOCGIFMAP, &ifr) < 0) {
473                                                         ++goterr;
474                                                         continue;
475                                                 }
476                                                 if ((mask & A_MAP_UCHAR) == A_MAP_UCHAR) {
477                                                         *((unsigned char *) p) = i;
478                                                 } else if (mask & A_MAP_USHORT) {
479                                                         *((unsigned short *) p) = i;
480                                                 } else {
481                                                         *((unsigned long *) p) = i;
482                                                 }
483                                         } else
484 #endif
485                                         if (mask & A_CAST_CHAR_PTR) {
486                                                 *((caddr_t *) p) = (caddr_t) i;
487                                         } else {        /* A_CAST_INT */
488                                                 *((int *) p) = i;
489                                         }
490                                 }
491
492                                 if (ioctl(sockfd, a1op->selector, &ifr) < 0) {
493                                         perror(a1op->name);
494                                         ++goterr;
495                                         continue;
496                                 }
497 #ifdef QUESTIONABLE_ALIAS_CASE
498                                 if (mask & A_COLON_CHK) {
499                                         /*
500                                          * Don't do the set_flag() if the address is an alias with
501                                          * a - at the end, since it's deleted already! - Roman
502                                          *
503                                          * Should really use regex.h here, not sure though how well
504                                          * it'll go with the cross-platform support etc.
505                                          */
506                                         char *ptr;
507                                         short int found_colon = 0;
508
509                                         for (ptr = ifr.ifr_name; *ptr; ptr++) {
510                                                 if (*ptr == ':') {
511                                                         found_colon++;
512                                                 }
513                                         }
514
515                                         if (found_colon && *(ptr - 1) == '-') {
516                                                 continue;
517                                         }
518                                 }
519 #endif
520                         }
521                         if (!(mask & A_SET_AFTER)) {
522                                 continue;
523                         }
524                         mask = N_SET;
525                 }
526
527                 if (ioctl(sockfd, SIOCGIFFLAGS, &ifr) < 0) {
528                         perror("SIOCGIFFLAGS");
529                         ++goterr;
530                 } else {
531                         selector = op->selector;
532                         if (mask & SET_MASK) {
533                                 ifr.ifr_flags |= selector;
534                         } else {
535                                 ifr.ifr_flags &= ~selector;
536                         }
537                         if (ioctl(sockfd, SIOCSIFFLAGS, &ifr) < 0) {
538                                 perror("SIOCSIFFLAGS");
539                                 ++goterr;
540                         }
541                 }
542           LOOP:
543                 continue;
544         }                                       /* end of while-loop */
545
546         if (ENABLE_FEATURE_CLEAN_UP) close(sockfd);
547         return goterr;
548 }
549
550 #ifdef CONFIG_FEATURE_IFCONFIG_HW
551 /* Input an Ethernet address and convert to binary. */
552 static int in_ether(char *bufp, struct sockaddr *sap)
553 {
554         char *ptr;
555         int i, j;
556         unsigned char val;
557         unsigned char c;
558
559         sap->sa_family = ARPHRD_ETHER;
560         ptr = sap->sa_data;
561
562         i = 0;
563         do {
564                 j = val = 0;
565
566                 /* We might get a semicolon here - not required. */
567                 if (i && (*bufp == ':')) {
568                         bufp++;
569                 }
570
571                 do {
572                         c = *bufp;
573                         if (((unsigned char)(c - '0')) <= 9) {
574                                 c -= '0';
575                         } else if (((unsigned char)((c|0x20) - 'a')) <= 5) {
576                                 c = (c|0x20) - ('a'-10);
577                         } else if (j && (c == ':' || c == 0)) {
578                                 break;
579                         } else {
580                                 return -1;
581                         }
582                         ++bufp;
583                         val <<= 4;
584                         val += c;
585                 } while (++j < 2);
586                 *ptr++ = val;
587         } while (++i < ETH_ALEN);
588
589         return (int) (*bufp);   /* Error if we don't end at end of string. */
590 }
591 #endif