networking/libiproute/iplink.c

   1 /* vi: set sw=4 ts=4: */
   2 /*
   3  * iplink.c "ip link".
   4  *
   5  * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
   6  *
   7  * Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
   8  */
   9 #include <net/if.h>
  10 #include <net/if_packet.h>
  11 #include <netpacket/packet.h>
  12 #include <net/ethernet.h>
  13
  14 #include "ip_common.h"  /* #include "libbb.h" is inside */
  15 #include "rt_names.h"
  16 #include "utils.h"
  17
  18 /* taken from linux/sockios.h */
  19 #define SIOCSIFNAME     0x8923          /* set interface name */
  20
  21 /* Exits on error */
  22 static int get_ctl_fd(void)
  23 {
  24         int fd;
  25
  26         fd = socket(PF_INET, SOCK_DGRAM, 0);
  27         if (fd >= 0)
  28                 return fd;
  29         fd = socket(PF_PACKET, SOCK_DGRAM, 0);
  30         if (fd >= 0)
  31                 return fd;
  32         return xsocket(PF_INET6, SOCK_DGRAM, 0);
  33 }
  34
  35 /* Exits on error */
  36 static void do_chflags(char *dev, uint32_t flags, uint32_t mask)
  37 {
  38         struct ifreq ifr;
  39         int fd;
  40
  41         strncpy_IFNAMSIZ(ifr.ifr_name, dev);
  42         fd = get_ctl_fd();
  43         xioctl(fd, SIOCGIFFLAGS, &ifr);
  44         if ((ifr.ifr_flags ^ flags) & mask) {
  45                 ifr.ifr_flags &= ~mask;
  46                 ifr.ifr_flags |= mask & flags;
  47                 xioctl(fd, SIOCSIFFLAGS, &ifr);
  48         }
  49         close(fd);
  50 }
  51
  52 /* Exits on error */
  53 static void do_changename(char *dev, char *newdev)
  54 {
  55         struct ifreq ifr;
  56         int fd;
  57
  58         strncpy_IFNAMSIZ(ifr.ifr_name, dev);
  59         strncpy_IFNAMSIZ(ifr.ifr_newname, newdev);
  60         fd = get_ctl_fd();
  61         xioctl(fd, SIOCSIFNAME, &ifr);
  62         close(fd);
  63 }
  64
  65 /* Exits on error */
  66 static void set_qlen(char *dev, int qlen)
  67 {
  68         struct ifreq ifr;
  69         int s;
  70
  71         s = get_ctl_fd();
  72         memset(&ifr, 0, sizeof(ifr));
  73         strncpy_IFNAMSIZ(ifr.ifr_name, dev);
  74         ifr.ifr_qlen = qlen;
  75         xioctl(s, SIOCSIFTXQLEN, &ifr);
  76         close(s);
  77 }
  78
  79 /* Exits on error */
  80 static void set_mtu(char *dev, int mtu)
  81 {
  82         struct ifreq ifr;
  83         int s;
  84
  85         s = get_ctl_fd();
  86         memset(&ifr, 0, sizeof(ifr));
  87         strncpy_IFNAMSIZ(ifr.ifr_name, dev);
  88         ifr.ifr_mtu = mtu;
  89         xioctl(s, SIOCSIFMTU, &ifr);
  90         close(s);
  91 }
  92
  93 /* Exits on error */
  94 static int get_address(char *dev, int *htype)
  95 {
  96         struct ifreq ifr;
  97         struct sockaddr_ll me;
  98         socklen_t alen;
  99         int s;
 100
 101         s = xsocket(PF_PACKET, SOCK_DGRAM, 0);
 102
 103         memset(&ifr, 0, sizeof(ifr));
 104         strncpy_IFNAMSIZ(ifr.ifr_name, dev);
 105         xioctl(s, SIOCGIFINDEX, &ifr);
 106
 107         memset(&me, 0, sizeof(me));
 108         me.sll_family = AF_PACKET;
 109         me.sll_ifindex = ifr.ifr_ifindex;
 110         me.sll_protocol = htons(ETH_P_LOOP);
 111         xbind(s, (struct sockaddr*)&me, sizeof(me));
 112         alen = sizeof(me);
 113         getsockname(s, (struct sockaddr*)&me, &alen);
 114         //never happens:
 115         //if (getsockname(s, (struct sockaddr*)&me, &alen) == -1)
 116         //      bb_perror_msg_and_die("getsockname");
 117         close(s);
 118         *htype = me.sll_hatype;
 119         return me.sll_halen;
 120 }
 121
 122 /* Exits on error */
 123 static void parse_address(char *dev, int hatype, int halen, char *lla, struct ifreq *ifr)
 124 {
 125         int alen;
 126
 127         memset(ifr, 0, sizeof(*ifr));
 128         strncpy_IFNAMSIZ(ifr->ifr_name, dev);
 129         ifr->ifr_hwaddr.sa_family = hatype;
 130
 131         alen = hatype == 1/*ARPHRD_ETHER*/ ? 14/*ETH_HLEN*/ : 19/*INFINIBAND_HLEN*/;
 132         alen = ll_addr_a2n((unsigned char *)(ifr->ifr_hwaddr.sa_data), alen, lla);
 133         if (alen < 0)
 134                 exit(EXIT_FAILURE);
 135         if (alen != halen) {
 136                 bb_error_msg_and_die("wrong address (%s) length: expected %d bytes", lla, halen);
 137         }
 138 }
 139
 140 /* Exits on error */
 141 static void set_address(struct ifreq *ifr, int brd)
 142 {
 143         int s;
 144
 145         s = get_ctl_fd();
 146         if (brd)
 147                 xioctl(s, SIOCSIFHWBROADCAST, ifr);
 148         else
 149                 xioctl(s, SIOCSIFHWADDR, ifr);
 150         close(s);
 151 }
 152
 153
 154 static void die_must_be_on_off(const char *msg) NORETURN;
 155 static void die_must_be_on_off(const char *msg)
 156 {
 157         bb_error_msg_and_die("argument of \"%s\" must be \"on\" or \"off\"", msg);
 158 }
 159
 160 /* Return value becomes exitcode. It's okay to not return at all */
 161 static int do_set(char **argv)
 162 {
 163         char *dev = NULL;
 164         uint32_t mask = 0;
 165         uint32_t flags = 0;
 166         int qlen = -1;
 167         int mtu = -1;
 168         char *newaddr = NULL;
 169         char *newbrd = NULL;
 170         struct ifreq ifr0, ifr1;
 171         char *newname = NULL;
 172         int htype, halen;
 173         static const char keywords[] ALIGN1 =
 174                 "up\0""down\0""name\0""mtu\0""multicast\0"
 175                 "arp\0""address\0""dev\0";
 176         enum { ARG_up = 0, ARG_down, ARG_name, ARG_mtu, ARG_multicast,
 177                 ARG_arp, ARG_addr, ARG_dev };
 178         static const char str_on_off[] ALIGN1 = "on\0""off\0";
 179         enum { PARM_on = 0, PARM_off };
 180         smalluint key;
 181
 182         while (*argv) {
 183                 /* substring search ensures that e.g. "addr" and "address"
 184                  * are both accepted */
 185                 key = index_in_substrings(keywords, *argv);
 186                 if (key == ARG_up) {
 187                         mask |= IFF_UP;
 188                         flags |= IFF_UP;
 189                 }
 190                 if (key == ARG_down) {
 191                         mask |= IFF_UP;
 192                         flags &= ~IFF_UP;
 193                 }
 194                 if (key == ARG_name) {
 195                         NEXT_ARG();
 196                         newname = *argv;
 197                 }
 198                 if (key == ARG_mtu) {
 199                         NEXT_ARG();
 200                         if (mtu != -1)
 201                                 duparg("mtu", *argv);
 202                         mtu = get_unsigned(*argv, "mtu");
 203                 }
 204                 if (key == ARG_multicast) {
 205                         int param;
 206                         NEXT_ARG();
 207                         mask |= IFF_MULTICAST;
 208                         param = index_in_strings(str_on_off, *argv);
 209                         if (param < 0)
 210                                 die_must_be_on_off("multicast");
 211                         if (param == PARM_on)
 212                                 flags |= IFF_MULTICAST;
 213                         else
 214                                 flags &= ~IFF_MULTICAST;
 215                 }
 216                 if (key == ARG_arp) {
 217                         int param;
 218                         NEXT_ARG();
 219                         mask |= IFF_NOARP;
 220                         param = index_in_strings(str_on_off, *argv);
 221                         if (param < 0)
 222                                 die_must_be_on_off("arp");
 223                         if (param == PARM_on)
 224                                 flags &= ~IFF_NOARP;
 225                         else
 226                                 flags |= IFF_NOARP;
 227                 }
 228                 if (key == ARG_addr) {
 229                         NEXT_ARG();
 230                         newaddr = *argv;
 231                 }
 232                 if (key >= ARG_dev) {
 233                         if (key == ARG_dev) {
 234                                 NEXT_ARG();
 235                         }
 236                         if (dev)
 237                                 duparg2("dev", *argv);
 238                         dev = *argv;
 239                 }
 240                 argv++;
 241         }
 242
 243         if (!dev) {
 244                 bb_error_msg_and_die(bb_msg_requires_arg, "\"dev\"");
 245         }
 246
 247         if (newaddr || newbrd) {
 248                 halen = get_address(dev, &htype);
 249                 if (newaddr) {
 250                         parse_address(dev, htype, halen, newaddr, &ifr0);
 251                 }
 252                 if (newbrd) {
 253                         parse_address(dev, htype, halen, newbrd, &ifr1);
 254                 }
 255         }
 256
 257         if (newname && strcmp(dev, newname)) {
 258                 do_changename(dev, newname);
 259                 dev = newname;
 260         }
 261         if (qlen != -1) {
 262                 set_qlen(dev, qlen);
 263         }
 264         if (mtu != -1) {
 265                 set_mtu(dev, mtu);
 266         }
 267         if (newaddr || newbrd) {
 268                 if (newbrd) {
 269                         set_address(&ifr1, 1);
 270                 }
 271                 if (newaddr) {
 272                         set_address(&ifr0, 0);
 273                 }
 274         }
 275         if (mask)
 276                 do_chflags(dev, flags, mask);
 277         return 0;
 278 }
 279
 280 static int ipaddr_list_link(char **argv)
 281 {
 282         preferred_family = AF_PACKET;
 283         return ipaddr_list_or_flush(argv, 0);
 284 }
 285
 286 #ifndef NLMSG_TAIL
 287 #define NLMSG_TAIL(nmsg) \
 288         ((struct rtattr *) (((void *) (nmsg)) + NLMSG_ALIGN((nmsg)->nlmsg_len)))
 289 #endif
 290 /* Return value becomes exitcode. It's okay to not return at all */
 291 static int do_change(char **argv, const unsigned rtm)
 292 {
 293         static const char keywords[] ALIGN1 =
 294                 "link\0""name\0""type\0""dev\0";
 295         enum {
 296                 ARG_link,
 297                 ARG_name,
 298                 ARG_type,
 299                 ARG_dev,
 300         };
 301         struct rtnl_handle rth;
 302         struct {
 303                 struct nlmsghdr         n;
 304                 struct ifinfomsg        i;
 305                 char                    buf[1024];
 306         } req;
 307         int arg;
 308         char *name_str = NULL, *link_str = NULL, *type_str = NULL, *dev_str = NULL;
 309
 310         memset(&req, 0, sizeof(req));
 311
 312         req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct ifinfomsg));
 313         req.n.nlmsg_flags = NLM_F_REQUEST;
 314         req.n.nlmsg_type = rtm;
 315         req.i.ifi_family = preferred_family;
 316         if (rtm == RTM_NEWLINK)
 317                 req.n.nlmsg_flags |= NLM_F_CREATE|NLM_F_EXCL;
 318
 319         while (*argv) {
 320                 arg = index_in_substrings(keywords, *argv);
 321                 if (arg == ARG_link) {
 322                         NEXT_ARG();
 323                         link_str = *argv;
 324                 } else if (arg == ARG_name) {
 325                         NEXT_ARG();
 326                         name_str = *argv;
 327                 } else if (arg == ARG_type) {
 328                         NEXT_ARG();
 329                         type_str = *argv;
 330                 } else {
 331                         if (arg == ARG_dev) {
 332                                 if (dev_str)
 333                                         duparg(*argv, "dev");
 334                                 NEXT_ARG();
 335                         }
 336                         dev_str = *argv;
 337                 }
 338                 argv++;
 339         }
 340         xrtnl_open(&rth);
 341         ll_init_map(&rth);
 342         if (type_str) {
 343                 struct rtattr *linkinfo = NLMSG_TAIL(&req.n);
 344
 345                 addattr_l(&req.n, sizeof(req), IFLA_LINKINFO, NULL, 0);
 346                 addattr_l(&req.n, sizeof(req), IFLA_INFO_KIND, type_str,
 347                                 strlen(type_str));
 348                 linkinfo->rta_len = (void *)NLMSG_TAIL(&req.n) - (void *)linkinfo;
 349         }
 350         if (rtm != RTM_NEWLINK) {
 351                 if (!dev_str)
 352                         return 1; /* Need a device to delete */
 353                 req.i.ifi_index = xll_name_to_index(dev_str);
 354         } else {
 355                 if (!name_str)
 356                         name_str = dev_str;
 357                 if (link_str) {
 358                         int idx = xll_name_to_index(link_str);
 359                         addattr_l(&req.n, sizeof(req), IFLA_LINK, &idx, 4);
 360                 }
 361         }
 362         if (name_str) {
 363                 const size_t name_len = strlen(name_str) + 1;
 364                 if (name_len < 2 || name_len > IFNAMSIZ)
 365                         invarg(name_str, "name");
 366                 addattr_l(&req.n, sizeof(req), IFLA_IFNAME, name_str, name_len);
 367         }
 368         if (rtnl_talk(&rth, &req.n, 0, 0, NULL, NULL, NULL) < 0)
 369                 return 2;
 370         return 0;
 371 }
 372
 373 /* Return value becomes exitcode. It's okay to not return at all */
 374 int do_iplink(char **argv)
 375 {
 376         static const char keywords[] ALIGN1 =
 377                 "add\0""delete\0""set\0""show\0""lst\0""list\0";
 378         int key;
 379         if (!*argv)
 380                 return ipaddr_list_link(argv);
 381         key = index_in_substrings(keywords, *argv);
 382         if (key < 0)
 383                 bb_error_msg_and_die(bb_msg_invalid_arg, *argv, applet_name);
 384         argv++;
 385         if (key <= 1) /* add/delete */
 386                 return do_change(argv, key ? RTM_DELLINK : RTM_NEWLINK);
 387         else if (key == 2) /* set */
 388                 return do_set(argv);
 389         /* show, lst, list */
 390         return ipaddr_list_link(argv);
 391 }