Manousaridis Angelos writes:
[oweals/busybox.git] / 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 /* 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 }