networking/nameif.c

   1 /*
   2  * nameif.c - Naming Interfaces based on MAC address for busybox.
   3  *
   4  * Writen 2000 by Andi Kleen.
   5  * Busybox port 2002 by Nick Fedchik <nick@fedchik.org.ua>
   6  *                      Glenn McGrath <bug1@optushome.com.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 /* take from linux/sockios.h */
  39 #define SIOCSIFNAME     0x8923  /* set interface name */
  40
  41 /* Octets in one ethernet addr, from <linux/if_ether.h> */
  42 #define ETH_ALEN        6
  43
  44 #ifndef ifr_newname
  45 #define ifr_newname ifr_ifru.ifru_slave
  46 #endif
  47
  48 typedef struct mactable_s {
  49         struct mactable_s *next;
  50         struct mactable_s *prev;
  51         char *ifname;
  52         struct ether_addr *mac;
  53 } mactable_t;
  54
  55 static unsigned char use_syslog;
  56
  57 static void serror(const char *s, ...) __attribute__ ((noreturn));
  58
  59 static void serror(const char *s, ...)
  60 {
  61         va_list ap;
  62
  63         va_start(ap, s);
  64
  65         if (use_syslog) {
  66                 openlog(applet_name, 0, LOG_LOCAL0);
  67                 vsyslog(LOG_ERR, s, ap);
  68                 closelog();
  69         } else {
  70                 verror_msg(s, ap);
  71                 putc('\n', stderr);
  72         }
  73
  74         va_end(ap);
  75
  76         exit(EXIT_FAILURE);
  77 }
  78
  79 /* Check ascii str_macaddr, convert and copy to *mac */
  80 struct ether_addr *cc_macaddr(char *str_macaddr)
  81 {
  82         struct ether_addr *lmac, *mac;
  83
  84         lmac = ether_aton(str_macaddr);
  85         if (lmac == NULL)
  86                 serror("cannot parse MAC %s", str_macaddr);
  87         mac = xmalloc(ETH_ALEN);
  88         memcpy(mac, lmac, ETH_ALEN);
  89
  90         return mac;
  91 }
  92
  93 int nameif_main(int argc, char **argv)
  94 {
  95         mactable_t *clist = NULL;
  96         FILE *ifh;
  97         const char *fname = "/etc/mactab";
  98         char *line;
  99         int ctl_sk;
 100         int opt;
 101         int if_index = 1;
 102         mactable_t *ch;
 103
 104
 105         while ((opt = getopt(argc, argv, "c:s")) != -1) {
 106                 switch (opt) {
 107                 case 'c':
 108                         fname = optarg;
 109                         break;
 110                 case 's':
 111                         use_syslog = 1;
 112                         break;
 113                 default:
 114                         show_usage();
 115                 }
 116         }
 117
 118         if ((argc - optind) & 1)
 119                 show_usage();
 120
 121         if (optind < argc) {
 122                 char **a = argv + optind;
 123
 124                 while (*a) {
 125
 126                         if (strlen(*a) > IF_NAMESIZE)
 127                                 serror("interface name `%s' too long", *a);
 128                         ch = xcalloc(1, sizeof(mactable_t));
 129                         ch->ifname = xstrdup(*a++);
 130                         ch->mac = cc_macaddr(*a++);
 131                         if (clist)
 132                                 clist->prev = ch;
 133                         ch->next = clist;
 134                         clist = ch;
 135                 }
 136         } else {
 137                 ifh = xfopen(fname, "r");
 138
 139                 while ((line = get_line_from_file(ifh)) != NULL) {
 140                         char *line_ptr;
 141                         size_t name_length;
 142
 143                         line_ptr = line + strspn(line, " \t");
 144                         if ((line_ptr[0] == '#') || (line_ptr[0] == '\n'))
 145                                 continue;
 146                         name_length = strcspn(line_ptr, " \t");
 147                         ch = xcalloc(1, sizeof(mactable_t));
 148                         ch->ifname = xstrndup(line_ptr, name_length);
 149                         if (name_length > IF_NAMESIZE)
 150                                 serror("interface name `%s' too long", ch->ifname);
 151                         line_ptr += name_length;
 152                         line_ptr += strspn(line_ptr, " \t");
 153                         name_length = strspn(line_ptr, "0123456789ABCDEFabcdef:");
 154                         line_ptr[name_length] = '\0';
 155                         ch->mac = cc_macaddr(line_ptr);
 156                         if (clist)
 157                                 clist->prev = ch;
 158                         ch->next = clist;
 159                         clist = ch;
 160                         free(line);
 161                 }
 162                 fclose(ifh);
 163         }
 164
 165         if ((ctl_sk = socket(PF_INET, SOCK_DGRAM, 0)) == -1)
 166                 serror("socket: %m");
 167
 168         while (clist) {
 169                 struct ifreq ifr;
 170
 171                 bzero(&ifr, sizeof(struct ifreq));
 172                 if_index++;
 173                 ifr.ifr_ifindex = if_index;
 174
 175                 /* Get ifname by index or die */
 176                 if (ioctl(ctl_sk, SIOCGIFNAME, &ifr))
 177                         break;
 178
 179                 /* Has this device hwaddr? */
 180                 if (ioctl(ctl_sk, SIOCGIFHWADDR, &ifr))
 181                         continue;
 182
 183                 /* Search for mac like in ifr.ifr_hwaddr.sa_data */
 184                 for (ch = clist; ch; ch = ch->next)
 185                         if (!memcmp(ch->mac, ifr.ifr_hwaddr.sa_data, ETH_ALEN))
 186                                 break;
 187
 188                 /* Nothing found for current ifr.ifr_hwaddr.sa_data */
 189                 if (ch == NULL)
 190                         continue;
 191
 192                 strcpy(ifr.ifr_newname, ch->ifname);
 193                 if (ioctl(ctl_sk, SIOCSIFNAME, &ifr) < 0)
 194                         serror("cannot change ifname %s to %s: %m",
 195                                    ifr.ifr_name, ch->ifname);
 196
 197                 /* Remove list entry of renamed interface */
 198                 if (ch->prev != NULL) {
 199                         (ch->prev)->next = ch->next;
 200                 } else {
 201                         clist = ch->next;
 202                 }
 203                 if (ch->next != NULL)
 204                         (ch->next)->prev = ch->prev;
 205 #ifdef CONFIG_FEATURE_CLEAN_UP
 206                 free(ch->ifname);
 207                 free(ch->mac);
 208                 free(ch);
 209 #endif
 210         }
 211
 212         return 0;
 213 }