contrib/wpa_supplicant/src/drivers/driver_wired_common.c

   1 /*
   2  * Common functions for Wired Ethernet driver interfaces
   3  * Copyright (c) 2005-2009, Jouni Malinen <j@w1.fi>
   4  * Copyright (c) 2004, Gunter Burchardt <tira@isx.de>
   5  *
   6  * This software may be distributed under the terms of the BSD license.
   7  * See README for more details.
   8  */
   9
  10 #include "includes.h"
  11
  12 #include "common.h"
  13 #include "eloop.h"
  14 #include "driver.h"
  15 #include "driver_wired_common.h"
  16
  17 #include <sys/ioctl.h>
  18 #include <net/if.h>
  19 #ifdef __linux__
  20 #include <netpacket/packet.h>
  21 #include <net/if_arp.h>
  22 #include <net/if.h>
  23 #endif /* __linux__ */
  24 #if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__)
  25 #include <net/if_dl.h>
  26 #include <net/if_media.h>
  27 #endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__) */
  28 #ifdef __sun__
  29 #include <sys/sockio.h>
  30 #endif /* __sun__ */
  31
  32
  33 static int driver_wired_get_ifflags(const char *ifname, int *flags)
  34 {
  35         struct ifreq ifr;
  36         int s;
  37
  38         s = socket(PF_INET, SOCK_DGRAM, 0);
  39         if (s < 0) {
  40                 wpa_printf(MSG_ERROR, "socket: %s", strerror(errno));
  41                 return -1;
  42         }
  43
  44         os_memset(&ifr, 0, sizeof(ifr));
  45         os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
  46         if (ioctl(s, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) {
  47                 wpa_printf(MSG_ERROR, "ioctl[SIOCGIFFLAGS]: %s",
  48                            strerror(errno));
  49                 close(s);
  50                 return -1;
  51         }
  52         close(s);
  53         *flags = ifr.ifr_flags & 0xffff;
  54         return 0;
  55 }
  56
  57
  58 static int driver_wired_set_ifflags(const char *ifname, int flags)
  59 {
  60         struct ifreq ifr;
  61         int s;
  62
  63         s = socket(PF_INET, SOCK_DGRAM, 0);
  64         if (s < 0) {
  65                 wpa_printf(MSG_ERROR, "socket: %s", strerror(errno));
  66                 return -1;
  67         }
  68
  69         os_memset(&ifr, 0, sizeof(ifr));
  70         os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
  71         ifr.ifr_flags = flags & 0xffff;
  72         if (ioctl(s, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) {
  73                 wpa_printf(MSG_ERROR, "ioctl[SIOCSIFFLAGS]: %s",
  74                            strerror(errno));
  75                 close(s);
  76                 return -1;
  77         }
  78         close(s);
  79         return 0;
  80 }
  81
  82
  83 static int driver_wired_multi(const char *ifname, const u8 *addr, int add)
  84 {
  85         struct ifreq ifr;
  86         int s;
  87
  88 #ifdef __sun__
  89         return -1;
  90 #endif /* __sun__ */
  91
  92         s = socket(PF_INET, SOCK_DGRAM, 0);
  93         if (s < 0) {
  94                 wpa_printf(MSG_ERROR, "socket: %s", strerror(errno));
  95                 return -1;
  96         }
  97
  98         os_memset(&ifr, 0, sizeof(ifr));
  99         os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
 100 #ifdef __linux__
 101         ifr.ifr_hwaddr.sa_family = AF_UNSPEC;
 102         os_memcpy(ifr.ifr_hwaddr.sa_data, addr, ETH_ALEN);
 103 #endif /* __linux__ */
 104 #if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__)
 105         {
 106                 struct sockaddr_dl *dlp;
 107
 108                 dlp = (struct sockaddr_dl *) &ifr.ifr_addr;
 109                 dlp->sdl_len = sizeof(struct sockaddr_dl);
 110                 dlp->sdl_family = AF_LINK;
 111                 dlp->sdl_index = 0;
 112                 dlp->sdl_nlen = 0;
 113                 dlp->sdl_alen = ETH_ALEN;
 114                 dlp->sdl_slen = 0;
 115                 os_memcpy(LLADDR(dlp), addr, ETH_ALEN);
 116         }
 117 #endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(FreeBSD_kernel__) */
 118 #if defined(__NetBSD__) || defined(__OpenBSD__) || defined(__APPLE__)
 119         {
 120                 struct sockaddr *sap;
 121
 122                 sap = (struct sockaddr *) &ifr.ifr_addr;
 123                 sap->sa_len = sizeof(struct sockaddr);
 124                 sap->sa_family = AF_UNSPEC;
 125                 os_memcpy(sap->sa_data, addr, ETH_ALEN);
 126         }
 127 #endif /* defined(__NetBSD__) || defined(__OpenBSD__) || defined(__APPLE__) */
 128
 129         if (ioctl(s, add ? SIOCADDMULTI : SIOCDELMULTI, (caddr_t) &ifr) < 0) {
 130                 wpa_printf(MSG_ERROR, "ioctl[SIOC{ADD/DEL}MULTI]: %s",
 131                            strerror(errno));
 132                 close(s);
 133                 return -1;
 134         }
 135         close(s);
 136         return 0;
 137 }
 138
 139
 140 int wired_multicast_membership(int sock, int ifindex, const u8 *addr, int add)
 141 {
 142 #ifdef __linux__
 143         struct packet_mreq mreq;
 144
 145         if (sock < 0)
 146                 return -1;
 147
 148         os_memset(&mreq, 0, sizeof(mreq));
 149         mreq.mr_ifindex = ifindex;
 150         mreq.mr_type = PACKET_MR_MULTICAST;
 151         mreq.mr_alen = ETH_ALEN;
 152         os_memcpy(mreq.mr_address, addr, ETH_ALEN);
 153
 154         if (setsockopt(sock, SOL_PACKET,
 155                        add ? PACKET_ADD_MEMBERSHIP : PACKET_DROP_MEMBERSHIP,
 156                        &mreq, sizeof(mreq)) < 0) {
 157                 wpa_printf(MSG_ERROR, "setsockopt: %s", strerror(errno));
 158                 return -1;
 159         }
 160         return 0;
 161 #else /* __linux__ */
 162         return -1;
 163 #endif /* __linux__ */
 164 }
 165
 166
 167 int driver_wired_get_ssid(void *priv, u8 *ssid)
 168 {
 169         ssid[0] = 0;
 170         return 0;
 171 }
 172
 173
 174 int driver_wired_get_bssid(void *priv, u8 *bssid)
 175 {
 176         /* Report PAE group address as the "BSSID" for wired connection. */
 177         os_memcpy(bssid, pae_group_addr, ETH_ALEN);
 178         return 0;
 179 }
 180
 181
 182 int driver_wired_get_capa(void *priv, struct wpa_driver_capa *capa)
 183 {
 184         os_memset(capa, 0, sizeof(*capa));
 185         capa->flags = WPA_DRIVER_FLAGS_WIRED;
 186         return 0;
 187 }
 188
 189
 190 #if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__)
 191 static int driver_wired_get_ifstatus(const char *ifname, int *status)
 192 {
 193         struct ifmediareq ifmr;
 194         int s;
 195
 196         s = socket(PF_INET, SOCK_DGRAM, 0);
 197         if (s < 0) {
 198                 wpa_printf(MSG_ERROR, "socket: %s", strerror(errno));
 199                 return -1;
 200         }
 201
 202         os_memset(&ifmr, 0, sizeof(ifmr));
 203         os_strlcpy(ifmr.ifm_name, ifname, IFNAMSIZ);
 204         if (ioctl(s, SIOCGIFMEDIA, (caddr_t) &ifmr) < 0) {
 205                 wpa_printf(MSG_ERROR, "ioctl[SIOCGIFMEDIA]: %s",
 206                            strerror(errno));
 207                 close(s);
 208                 return -1;
 209         }
 210         close(s);
 211         *status = (ifmr.ifm_status & (IFM_ACTIVE | IFM_AVALID)) ==
 212                 (IFM_ACTIVE | IFM_AVALID);
 213
 214         return 0;
 215 }
 216 #endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(FreeBSD_kernel__) */
 217
 218
 219 int driver_wired_init_common(struct driver_wired_common_data *common,
 220                              const char *ifname, void *ctx)
 221 {
 222         int flags;
 223
 224         os_strlcpy(common->ifname, ifname, sizeof(common->ifname));
 225         common->ctx = ctx;
 226
 227 #ifdef __linux__
 228         common->pf_sock = socket(PF_PACKET, SOCK_DGRAM, 0);
 229         if (common->pf_sock < 0)
 230                 wpa_printf(MSG_ERROR, "socket(PF_PACKET): %s", strerror(errno));
 231 #else /* __linux__ */
 232         common->pf_sock = -1;
 233 #endif /* __linux__ */
 234
 235         if (driver_wired_get_ifflags(ifname, &flags) == 0 &&
 236             !(flags & IFF_UP) &&
 237             driver_wired_set_ifflags(ifname, flags | IFF_UP) == 0)
 238                 common->iff_up = 1;
 239
 240         if (wired_multicast_membership(common->pf_sock,
 241                                        if_nametoindex(common->ifname),
 242                                        pae_group_addr, 1) == 0) {
 243                 wpa_printf(MSG_DEBUG,
 244                            "%s: Added multicast membership with packet socket",
 245                            __func__);
 246                 common->membership = 1;
 247         } else if (driver_wired_multi(ifname, pae_group_addr, 1) == 0) {
 248                 wpa_printf(MSG_DEBUG,
 249                            "%s: Added multicast membership with SIOCADDMULTI",
 250                            __func__);
 251                 common->multi = 1;
 252         } else if (driver_wired_get_ifflags(ifname, &flags) < 0) {
 253                 wpa_printf(MSG_INFO, "%s: Could not get interface flags",
 254                            __func__);
 255                 return -1;
 256         } else if (flags & IFF_ALLMULTI) {
 257                 wpa_printf(MSG_DEBUG,
 258                            "%s: Interface is already configured for multicast",
 259                            __func__);
 260         } else if (driver_wired_set_ifflags(ifname,
 261                                                 flags | IFF_ALLMULTI) < 0) {
 262                 wpa_printf(MSG_INFO, "%s: Failed to enable allmulti", __func__);
 263                 return -1;
 264         } else {
 265                 wpa_printf(MSG_DEBUG, "%s: Enabled allmulti mode", __func__);
 266                 common->iff_allmulti = 1;
 267         }
 268 #if defined(__FreeBSD__) || defined(__DragonFly__) || defined(__FreeBSD_kernel__)
 269         {
 270                 int status;
 271
 272                 wpa_printf(MSG_DEBUG, "%s: waiting for link to become active",
 273                            __func__);
 274                 while (driver_wired_get_ifstatus(ifname, &status) == 0 &&
 275                        status == 0)
 276                         sleep(1);
 277         }
 278 #endif /* defined(__FreeBSD__) || defined(__DragonFly__) || defined(FreeBSD_kernel__) */
 279
 280         return 0;
 281 }
 282
 283
 284 void driver_wired_deinit_common(struct driver_wired_common_data *common)
 285 {
 286         int flags;
 287
 288         if (common->membership &&
 289             wired_multicast_membership(common->pf_sock,
 290                                        if_nametoindex(common->ifname),
 291                                        pae_group_addr, 0) < 0) {
 292                 wpa_printf(MSG_DEBUG,
 293                            "%s: Failed to remove PAE multicast group (PACKET)",
 294                            __func__);
 295         }
 296
 297         if (common->multi &&
 298             driver_wired_multi(common->ifname, pae_group_addr, 0) < 0) {
 299                 wpa_printf(MSG_DEBUG,
 300                            "%s: Failed to remove PAE multicast group (SIOCDELMULTI)",
 301                            __func__);
 302         }
 303
 304         if (common->iff_allmulti &&
 305             (driver_wired_get_ifflags(common->ifname, &flags) < 0 ||
 306              driver_wired_set_ifflags(common->ifname,
 307                                       flags & ~IFF_ALLMULTI) < 0)) {
 308                 wpa_printf(MSG_DEBUG, "%s: Failed to disable allmulti mode",
 309                            __func__);
 310         }
 311
 312         if (common->iff_up &&
 313             driver_wired_get_ifflags(common->ifname, &flags) == 0 &&
 314             (flags & IFF_UP) &&
 315             driver_wired_set_ifflags(common->ifname, flags & ~IFF_UP) < 0) {
 316                 wpa_printf(MSG_DEBUG, "%s: Failed to set the interface down",
 317                            __func__);
 318         }
 319
 320         if (common->pf_sock != -1)
 321                 close(common->pf_sock);
 322 }