userapps/opensource/busybox/networking/nameif.c

   1 /*
   2  * nameif.c - Naming Interfaces based on MAC address for busybox.
   3  *
   4  * Written 2000 by Andi Kleen.
   5  * Busybox port 2002 by Nick Fedchik <nick@fedchik.org.ua>
   6  *                      Glenn McGrath <bug1@iinet.net.au>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16  * General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  21  * 02111-1307 USA
  22  *
  23  */
  24
  25
  26 #include <sys/syslog.h>
  27 #include <sys/socket.h>
  28 #include <sys/ioctl.h>
  29 #include <errno.h>
  30 #include <getopt.h>
  31 #include <stdlib.h>
  32 #include <string.h>
  33 #include <net/if.h>
  34 #include <netinet/ether.h>
  35
  36 #include "busybox.h"
  37
  38 /* Older versions of net/if.h do not appear to define IF_NAMESIZE. */
  39 #ifndef IF_NAMESIZE
  40 #  ifdef IFNAMSIZ
  41 #    define IF_NAMESIZE IFNAMSIZ
  42 #  else
  43 #    define IF_NAMESIZE 16
  44 #  endif
  45 #endif
  46
  47 /* take from linux/sockios.h */
  48 #define SIOCSIFNAME     0x8923  /* set interface name */
  49
  50 /* Octets in one Ethernet addr, from <linux/if_ether.h> */
  51 #define ETH_ALEN        6
  52
  53 #ifndef ifr_newname
  54 #define ifr_newname ifr_ifru.ifru_slave
  55 #endif
  56
  57 typedef struct mactable_s {
  58         struct mactable_s *next;
  59         struct mactable_s *prev;
  60         char *ifname;
  61         struct ether_addr *mac;
  62 } mactable_t;
  63
  64 static unsigned char use_syslog;
  65
  66 static void serror(const char *s, ...) __attribute__ ((noreturn));
  67
  68 static void serror(const char *s, ...)
  69 {
  70         va_list ap;
  71
  72         va_start(ap, s);
  73
  74         if (use_syslog) {
  75                 openlog(bb_applet_name, 0, LOG_LOCAL0);
  76                 vsyslog(LOG_ERR, s, ap);
  77                 closelog();
  78         } else {
  79                 bb_verror_msg(s, ap);
  80                 putc('\n', stderr);
  81         }
  82
  83         va_end(ap);
  84
  85         exit(EXIT_FAILURE);
  86 }
  87
  88 /* Check ascii str_macaddr, convert and copy to *mac */
  89 struct ether_addr *cc_macaddr(char *str_macaddr)
  90 {
  91         struct ether_addr *lmac, *mac;
  92
  93         lmac = ether_aton(str_macaddr);
  94         if (lmac == NULL)
  95                 serror("cannot parse MAC %s", str_macaddr);
  96         mac = xmalloc(ETH_ALEN);
  97         memcpy(mac, lmac, ETH_ALEN);
  98
  99         return mac;
 100 }
 101
 102 int nameif_main(int argc, char **argv)
 103 {
 104         mactable_t *clist = NULL;
 105         FILE *ifh;
 106         const char *fname = "/etc/mactab";
 107         char *line;
 108         int ctl_sk;
 109         int opt;
 110         int if_index = 1;
 111         mactable_t *ch;
 112
 113
 114         while ((opt = getopt(argc, argv, "c:s")) != -1) {
 115                 switch (opt) {
 116                 case 'c':
 117                         fname = optarg;
 118                         break;
 119                 case 's':
 120                         use_syslog = 1;
 121                         break;
 122                 default:
 123                         bb_show_usage();
 124                 }
 125         }
 126
 127         if ((argc - optind) & 1)
 128                 bb_show_usage();
 129
 130         if (optind < argc) {
 131                 char **a = argv + optind;
 132
 133                 while (*a) {
 134
 135                         if (strlen(*a) > IF_NAMESIZE)
 136                                 serror("interface name `%s' too long", *a);
 137                         ch = xcalloc(1, sizeof(mactable_t));
 138                         ch->ifname = bb_xstrdup(*a++);
 139                         ch->mac = cc_macaddr(*a++);
 140                         if (clist)
 141                                 clist->prev = ch;
 142                         ch->next = clist;
 143                         clist = ch;
 144                 }
 145         } else {
 146                 ifh = bb_xfopen(fname, "r");
 147
 148                 while ((line = bb_get_line_from_file(ifh)) != NULL) {
 149                         char *line_ptr;
 150                         size_t name_length;
 151
 152                         line_ptr = line + strspn(line, " \t");
 153                         if ((line_ptr[0] == '#') || (line_ptr[0] == '\n'))
 154                                 continue;
 155                         name_length = strcspn(line_ptr, " \t");
 156                         ch = xcalloc(1, sizeof(mactable_t));
 157                         ch->ifname = bb_xstrndup(line_ptr, name_length);
 158                         if (name_length > IF_NAMESIZE)
 159                                 serror("interface name `%s' too long", ch->ifname);
 160                         line_ptr += name_length;
 161                         line_ptr += strspn(line_ptr, " \t");
 162                         name_length = strspn(line_ptr, "0123456789ABCDEFabcdef:");
 163                         line_ptr[name_length] = '\0';
 164                         ch->mac = cc_macaddr(line_ptr);
 165                         if (clist)
 166                                 clist->prev = ch;
 167                         ch->next = clist;
 168                         clist = ch;
 169                         free(line);
 170                 }
 171                 fclose(ifh);
 172         }
 173
 174         if ((ctl_sk = socket(PF_INET, SOCK_DGRAM, 0)) == -1)
 175                 serror("socket: %m");
 176
 177         while (clist) {
 178                 struct ifreq ifr;
 179
 180                 bzero(&ifr, sizeof(struct ifreq));
 181                 if_index++;
 182                 ifr.ifr_ifindex = if_index;
 183
 184                 /* Get ifname by index or die */
 185                 if (ioctl(ctl_sk, SIOCGIFNAME, &ifr))
 186                         break;
 187
 188                 /* Has this device hwaddr? */
 189                 if (ioctl(ctl_sk, SIOCGIFHWADDR, &ifr))
 190                         continue;
 191
 192                 /* Search for mac like in ifr.ifr_hwaddr.sa_data */
 193                 for (ch = clist; ch; ch = ch->next)
 194                         if (!memcmp(ch->mac, ifr.ifr_hwaddr.sa_data, ETH_ALEN))
 195                                 break;
 196
 197                 /* Nothing found for current ifr.ifr_hwaddr.sa_data */
 198                 if (ch == NULL)
 199                         continue;
 200
 201                 strcpy(ifr.ifr_newname, ch->ifname);
 202                 if (ioctl(ctl_sk, SIOCSIFNAME, &ifr) < 0)
 203                         serror("cannot change ifname %s to %s: %m",
 204                                    ifr.ifr_name, ch->ifname);
 205
 206                 /* Remove list entry of renamed interface */
 207                 if (ch->prev != NULL) {
 208                         (ch->prev)->next = ch->next;
 209                 } else {
 210                         clist = ch->next;
 211                 }
 212                 if (ch->next != NULL)
 213                         (ch->next)->prev = ch->prev;
 214 #ifdef CONFIG_FEATURE_CLEAN_UP
 215                 free(ch->ifname);
 216                 free(ch->mac);
 217                 free(ch);
 218 #endif
 219         }
 220
 221         return 0;
 222 }