git.maemo.org Git - wpasupplicant/blob - src/drivers/driver_wired.c

   1 /*
   2  * WPA Supplicant - wired Ethernet driver interface
   3  * Copyright (c) 2005-2007, Jouni Malinen <j@w1.fi>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License version 2 as
   7  * published by the Free Software Foundation.
   8  *
   9  * Alternatively, this software may be distributed under the terms of BSD
  10  * license.
  11  *
  12  * See README and COPYING for more details.
  13  */
  14
  15 #include "includes.h"
  16 #include <sys/ioctl.h>
  17 #include <net/if.h>
  18 #ifdef __linux__
  19 #include <netpacket/packet.h>
  20 #endif /* __linux__ */
  21 #ifdef __FreeBSD__
  22 #include <net/if_dl.h>
  23 #endif /* __FreeBSD__ */
  24
  25 #include "common.h"
  26 #include "driver.h"
  27
  28
  29 static const u8 pae_group_addr[ETH_ALEN] =
  30 { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 };
  31
  32
  33 struct wpa_driver_wired_data {
  34         void *ctx;
  35         int pf_sock;
  36         char ifname[IFNAMSIZ + 1];
  37         int membership, multi, iff_allmulti, iff_up;
  38 };
  39
  40
  41 static int wpa_driver_wired_get_ssid(void *priv, u8 *ssid)
  42 {
  43         ssid[0] = 0;
  44         return 0;
  45 }
  46
  47
  48 static int wpa_driver_wired_get_bssid(void *priv, u8 *bssid)
  49 {
  50         /* Report PAE group address as the "BSSID" for wired connection. */
  51         os_memcpy(bssid, pae_group_addr, ETH_ALEN);
  52         return 0;
  53 }
  54
  55
  56 static int wpa_driver_wired_get_capa(void *priv, struct wpa_driver_capa *capa)
  57 {
  58         os_memset(capa, 0, sizeof(*capa));
  59         capa->flags = WPA_DRIVER_FLAGS_WIRED;
  60         return 0;
  61 }
  62
  63
  64 static int wpa_driver_wired_get_ifflags(const char *ifname, int *flags)
  65 {
  66         struct ifreq ifr;
  67         int s;
  68
  69         s = socket(PF_INET, SOCK_DGRAM, 0);
  70         if (s < 0) {
  71                 perror("socket");
  72                 return -1;
  73         }
  74
  75         os_memset(&ifr, 0, sizeof(ifr));
  76         os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
  77         if (ioctl(s, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) {
  78                 perror("ioctl[SIOCGIFFLAGS]");
  79                 close(s);
  80                 return -1;
  81         }
  82         close(s);
  83         *flags = ifr.ifr_flags & 0xffff;
  84         return 0;
  85 }
  86
  87
  88 static int wpa_driver_wired_set_ifflags(const char *ifname, int flags)
  89 {
  90         struct ifreq ifr;
  91         int s;
  92
  93         s = socket(PF_INET, SOCK_DGRAM, 0);
  94         if (s < 0) {
  95                 perror("socket");
  96                 return -1;
  97         }
  98
  99         os_memset(&ifr, 0, sizeof(ifr));
 100         os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
 101         ifr.ifr_flags = flags & 0xffff;
 102         if (ioctl(s, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) {
 103                 perror("ioctl[SIOCSIFFLAGS]");
 104                 close(s);
 105                 return -1;
 106         }
 107         close(s);
 108         return 0;
 109 }
 110
 111
 112 static int wpa_driver_wired_multi(const char *ifname, const u8 *addr, int add)
 113 {
 114         struct ifreq ifr;
 115         int s;
 116
 117         s = socket(PF_INET, SOCK_DGRAM, 0);
 118         if (s < 0) {
 119                 perror("socket");
 120                 return -1;
 121         }
 122
 123         os_memset(&ifr, 0, sizeof(ifr));
 124         os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
 125 #ifdef __linux__
 126         ifr.ifr_hwaddr.sa_family = AF_UNSPEC;
 127         os_memcpy(ifr.ifr_hwaddr.sa_data, addr, ETH_ALEN);
 128 #endif /* __linux__ */
 129 #ifdef __FreeBSD__
 130         {
 131                 struct sockaddr_dl *dlp;
 132                 dlp = (struct sockaddr_dl *) &ifr.ifr_addr;
 133                 dlp->sdl_len = sizeof(struct sockaddr_dl);
 134                 dlp->sdl_family = AF_LINK;
 135                 dlp->sdl_index = 0;
 136                 dlp->sdl_nlen = 0;
 137                 dlp->sdl_alen = ETH_ALEN;
 138                 dlp->sdl_slen = 0;
 139                 os_memcpy(LLADDR(dlp), addr, ETH_ALEN);
 140         }
 141 #endif /* __FreeBSD__ */
 142
 143         if (ioctl(s, add ? SIOCADDMULTI : SIOCDELMULTI, (caddr_t) &ifr) < 0) {
 144                 perror("ioctl[SIOC{ADD/DEL}MULTI]");
 145                 close(s);
 146                 return -1;
 147         }
 148         close(s);
 149         return 0;
 150 }
 151
 152
 153 static int wpa_driver_wired_membership(struct wpa_driver_wired_data *drv,
 154                                        const u8 *addr, int add)
 155 {
 156 #ifdef __linux__
 157         struct packet_mreq mreq;
 158
 159         if (drv->pf_sock == -1)
 160                 return -1;
 161
 162         os_memset(&mreq, 0, sizeof(mreq));
 163         mreq.mr_ifindex = if_nametoindex(drv->ifname);
 164         mreq.mr_type = PACKET_MR_MULTICAST;
 165         mreq.mr_alen = ETH_ALEN;
 166         os_memcpy(mreq.mr_address, addr, ETH_ALEN);
 167
 168         if (setsockopt(drv->pf_sock, SOL_PACKET,
 169                        add ? PACKET_ADD_MEMBERSHIP : PACKET_DROP_MEMBERSHIP,
 170                        &mreq, sizeof(mreq)) < 0) {
 171                 perror("setsockopt");
 172                 return -1;
 173         }
 174         return 0;
 175 #else /* __linux__ */
 176         return -1;
 177 #endif /* __linux__ */
 178 }
 179
 180
 181 static void * wpa_driver_wired_init(void *ctx, const char *ifname)
 182 {
 183         struct wpa_driver_wired_data *drv;
 184         int flags;
 185
 186         drv = os_zalloc(sizeof(*drv));
 187         if (drv == NULL)
 188                 return NULL;
 189         os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
 190         drv->ctx = ctx;
 191
 192 #ifdef __linux__
 193         drv->pf_sock = socket(PF_PACKET, SOCK_DGRAM, 0);
 194         if (drv->pf_sock < 0)
 195                 perror("socket(PF_PACKET)");
 196 #else /* __linux__ */
 197         drv->pf_sock = -1;
 198 #endif /* __linux__ */
 199
 200         if (wpa_driver_wired_get_ifflags(ifname, &flags) == 0 &&
 201             !(flags & IFF_UP) &&
 202             wpa_driver_wired_set_ifflags(ifname, flags | IFF_UP) == 0) {
 203                 drv->iff_up = 1;
 204         }
 205
 206         if (wpa_driver_wired_membership(drv, pae_group_addr, 1) == 0) {
 207                 wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
 208                            "packet socket", __func__);
 209                 drv->membership = 1;
 210         } else if (wpa_driver_wired_multi(ifname, pae_group_addr, 1) == 0) {
 211                 wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
 212                            "SIOCADDMULTI", __func__);
 213                 drv->multi = 1;
 214         } else if (wpa_driver_wired_get_ifflags(ifname, &flags) < 0) {
 215                 wpa_printf(MSG_INFO, "%s: Could not get interface "
 216                            "flags", __func__);
 217                 os_free(drv);
 218                 return NULL;
 219         } else if (flags & IFF_ALLMULTI) {
 220                 wpa_printf(MSG_DEBUG, "%s: Interface is already configured "
 221                            "for multicast", __func__);
 222         } else if (wpa_driver_wired_set_ifflags(ifname,
 223                                                 flags | IFF_ALLMULTI) < 0) {
 224                 wpa_printf(MSG_INFO, "%s: Failed to enable allmulti",
 225                            __func__);
 226                 os_free(drv);
 227                 return NULL;
 228         } else {
 229                 wpa_printf(MSG_DEBUG, "%s: Enabled allmulti mode",
 230                            __func__);
 231                 drv->iff_allmulti = 1;
 232         }
 233
 234         return drv;
 235 }
 236
 237
 238 static void wpa_driver_wired_deinit(void *priv)
 239 {
 240         struct wpa_driver_wired_data *drv = priv;
 241         int flags;
 242
 243         if (drv->membership &&
 244             wpa_driver_wired_membership(drv, pae_group_addr, 0) < 0) {
 245                 wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
 246                            "group (PACKET)", __func__);
 247         }
 248
 249         if (drv->multi &&
 250             wpa_driver_wired_multi(drv->ifname, pae_group_addr, 0) < 0) {
 251                 wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
 252                            "group (SIOCDELMULTI)", __func__);
 253         }
 254
 255         if (drv->iff_allmulti &&
 256             (wpa_driver_wired_get_ifflags(drv->ifname, &flags) < 0 ||
 257              wpa_driver_wired_set_ifflags(drv->ifname,
 258                                           flags & ~IFF_ALLMULTI) < 0)) {
 259                 wpa_printf(MSG_DEBUG, "%s: Failed to disable allmulti mode",
 260                            __func__);
 261         }
 262
 263         if (drv->iff_up &&
 264             wpa_driver_wired_get_ifflags(drv->ifname, &flags) == 0 &&
 265             (flags & IFF_UP) &&
 266             wpa_driver_wired_set_ifflags(drv->ifname, flags & ~IFF_UP) < 0) {
 267                 wpa_printf(MSG_DEBUG, "%s: Failed to set the interface down",
 268                            __func__);
 269         }
 270
 271         if (drv->pf_sock != -1)
 272                 close(drv->pf_sock);
 273
 274         os_free(drv);
 275 }
 276
 277
 278 const struct wpa_driver_ops wpa_driver_wired_ops = {
 279         .name = "wired",
 280         .desc = "wpa_supplicant wired Ethernet driver",
 281         .get_ssid = wpa_driver_wired_get_ssid,
 282         .get_bssid = wpa_driver_wired_get_bssid,
 283         .get_capa = wpa_driver_wired_get_capa,
 284         .init = wpa_driver_wired_init,
 285         .deinit = wpa_driver_wired_deinit,
 286 };