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 } 323