sbin/ifconfig/af_link.c

   1 /*
   2  * Copyright (c) 1983, 1993
   3  *      The Regents of the University of California.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 4. Neither the name of the University nor the names of its contributors
  14  *    may be used to endorse or promote products derived from this software
  15  *    without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  */
  29
  30 #ifndef lint
  31 static const char rcsid[] =
  32   "$FreeBSD$";
  33 #endif /* not lint */
  34
  35 #include <sys/types.h>
  36 #include <sys/ioctl.h>
  37 #include <sys/socket.h>
  38 #include <net/if.h>
  39
  40 #include <err.h>
  41 #include <stdio.h>
  42 #include <stdlib.h>
  43 #include <string.h>
  44 #include <ifaddrs.h>
  45 #include <unistd.h>
  46
  47 #include <net/if_dl.h>
  48 #include <net/if_types.h>
  49 #include <net/ethernet.h>
  50
  51 #include "ifconfig.h"
  52
  53 static struct ifreq link_ridreq;
  54
  55 extern char *f_ether;
  56
  57 static void
  58 link_status(int s __unused, const struct ifaddrs *ifa)
  59 {
  60         /* XXX no const 'cuz LLADDR is defined wrong */
  61         struct sockaddr_dl *sdl;
  62         char *ether_format, *format_char;
  63         struct ifreq ifr;
  64         int n, rc, sock_hw;
  65         static const u_char laggaddr[6] = {0};
  66
  67         sdl = (struct sockaddr_dl *) ifa->ifa_addr;
  68         if (sdl == NULL || sdl->sdl_alen == 0)
  69                 return;
  70
  71         if ((sdl->sdl_type == IFT_ETHER || sdl->sdl_type == IFT_L2VLAN ||
  72             sdl->sdl_type == IFT_BRIDGE) && sdl->sdl_alen == ETHER_ADDR_LEN) {
  73                 ether_format = ether_ntoa((struct ether_addr *)LLADDR(sdl));
  74                 if (f_ether != NULL && strcmp(f_ether, "dash") == 0) {
  75                         for (format_char = strchr(ether_format, ':');
  76                             format_char != NULL;
  77                             format_char = strchr(ether_format, ':'))
  78                                 *format_char = '-';
  79                 }
  80                 printf("\tether %s\n", ether_format);
  81         } else {
  82                 n = sdl->sdl_nlen > 0 ? sdl->sdl_nlen + 1 : 0;
  83                 printf("\tlladdr %s\n", link_ntoa(sdl) + n);
  84         }
  85
  86         /*
  87          * Best-effort (i.e. failures are silent) to get original
  88          * hardware address, as read by NIC driver at attach time. Only
  89          * applies to Ethernet NICs (IFT_ETHER). However, laggX
  90          * interfaces claim to be IFT_ETHER, and re-type their component
  91          * Ethernet NICs as IFT_IEEE8023ADLAG. So, check for both. If
  92          * the MAC is zeroed, then it's actually a lagg.
  93          */
  94         if ((sdl->sdl_type != IFT_ETHER &&
  95             sdl->sdl_type != IFT_IEEE8023ADLAG) ||
  96             sdl->sdl_alen != ETHER_ADDR_LEN)
  97                 return;
  98
  99         strncpy(ifr.ifr_name, ifa->ifa_name, sizeof(ifr.ifr_name));
 100         memcpy(&ifr.ifr_addr, ifa->ifa_addr, sizeof(ifa->ifa_addr->sa_len));
 101         ifr.ifr_addr.sa_family = AF_LOCAL;
 102         if ((sock_hw = socket(AF_LOCAL, SOCK_DGRAM, 0)) < 0) {
 103                 warn("socket(AF_LOCAL,SOCK_DGRAM)");
 104                 return;
 105         }
 106         rc = ioctl(sock_hw, SIOCGHWADDR, &ifr);
 107         close(sock_hw);
 108         if (rc != 0)
 109                 return;
 110
 111         if (memcmp(ifr.ifr_addr.sa_data, laggaddr, sdl->sdl_alen) == 0)
 112                 goto pcp;
 113
 114         ether_format = ether_ntoa((const struct ether_addr *)
 115             &ifr.ifr_addr.sa_data);
 116         if (f_ether != NULL && strcmp(f_ether, "dash") == 0) {
 117                 for (format_char = strchr(ether_format, ':');
 118                      format_char != NULL;
 119                      format_char = strchr(ether_format, ':'))
 120                         *format_char = '-';
 121         }
 122         printf("\thwaddr %s\n", ether_format);
 123
 124 pcp:
 125         if (ioctl(s, SIOCGLANPCP, (caddr_t)&ifr) == 0 &&
 126             ifr.ifr_lan_pcp != IFNET_PCP_NONE)
 127                 printf("\tpcp %d\n", ifr.ifr_lan_pcp);
 128 }
 129
 130 static void
 131 link_getaddr(const char *addr, int which)
 132 {
 133         char *temp;
 134         struct sockaddr_dl sdl;
 135         struct sockaddr *sa = &link_ridreq.ifr_addr;
 136
 137         if (which != ADDR)
 138                 errx(1, "can't set link-level netmask or broadcast");
 139         if (!strcmp(addr, "random")) {
 140                 sdl.sdl_len = sizeof(sdl);
 141                 sdl.sdl_alen = ETHER_ADDR_LEN;
 142                 sdl.sdl_nlen = 0;
 143                 sdl.sdl_family = AF_LINK;
 144                 arc4random_buf(&sdl.sdl_data, ETHER_ADDR_LEN);
 145                 /* Non-multicast and claim it is locally administered. */
 146                 sdl.sdl_data[0] &= 0xfc;
 147                 sdl.sdl_data[0] |= 0x02;
 148         } else {
 149                 if ((temp = malloc(strlen(addr) + 2)) == NULL)
 150                         errx(1, "malloc failed");
 151                 temp[0] = ':';
 152                 strcpy(temp + 1, addr);
 153                 sdl.sdl_len = sizeof(sdl);
 154                 link_addr(temp, &sdl);
 155                 free(temp);
 156         }
 157         if (sdl.sdl_alen > sizeof(sa->sa_data))
 158                 errx(1, "malformed link-level address");
 159         sa->sa_family = AF_LINK;
 160         sa->sa_len = sdl.sdl_alen;
 161         bcopy(LLADDR(&sdl), sa->sa_data, sdl.sdl_alen);
 162 }
 163
 164 static struct afswtch af_link = {
 165         .af_name        = "link",
 166         .af_af          = AF_LINK,
 167         .af_status      = link_status,
 168         .af_getaddr     = link_getaddr,
 169         .af_aifaddr     = SIOCSIFLLADDR,
 170         .af_addreq      = &link_ridreq,
 171 };
 172 static struct afswtch af_ether = {
 173         .af_name        = "ether",
 174         .af_af          = AF_LINK,
 175         .af_status      = link_status,
 176         .af_getaddr     = link_getaddr,
 177         .af_aifaddr     = SIOCSIFLLADDR,
 178         .af_addreq      = &link_ridreq,
 179 };
 180 static struct afswtch af_lladdr = {
 181         .af_name        = "lladdr",
 182         .af_af          = AF_LINK,
 183         .af_status      = link_status,
 184         .af_getaddr     = link_getaddr,
 185         .af_aifaddr     = SIOCSIFLLADDR,
 186         .af_addreq      = &link_ridreq,
 187 };
 188
 189 static __constructor void
 190 link_ctor(void)
 191 {
 192         af_register(&af_link);
 193         af_register(&af_ether);
 194         af_register(&af_lladdr);
 195 }