text: /*
   * WPA Supplicant - wired Ethernet driver interface
   * Copyright (c) 2005, Jouni Malinen <jkmaline@cc.hut.fi>
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   *
   * Alternatively, this software may be distributed under the terms of BSD
   * license.
   *
   * See README and COPYING for more details.
   */
  
  #include <stdlib.h>
  #include <stdio.h>
  #include <string.h>
  #include <unistd.h>
  #include <sys/ioctl.h>
  #include <sys/types.h>
  #include <sys/socket.h>
  #include <netpacket/packet.h>
  #include <net/if.h>
  
  #include "common.h"
  #include "driver.h"
  #include "wpa_supplicant.h"
  
  
  static const u8 pae_group_addr[ETH_ALEN] =
  { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 };
  
  
  struct wpa_driver_wired_data {
  	void *ctx;
  	int pf_sock;
  	char ifname[IFNAMSIZ + 1];
  	int membership, multi, iff_allmulti, iff_up;
  };
  
  
  static int wpa_driver_wired_set_wpa(void *priv, int enabled)
  {
  	return 0;
  }
  
  
  static int wpa_driver_wired_get_ssid(void *priv, u8 *ssid)
  {
  	ssid[0] = 0;
  	return 0;
  }
  
  
  static int wpa_driver_wired_get_bssid(void *priv, u8 *bssid)
  {
  	/* Report PAE group address as the "BSSID" for wired connection. */
  	memcpy(bssid, pae_group_addr, ETH_ALEN);
  	return 0;
  }
  
  
  static int wpa_driver_wired_get_ifflags(const char *ifname, int *flags)
  {
  	struct ifreq ifr;
  	int s;
  
  	s = socket(PF_INET, SOCK_DGRAM, 0);
  	if (s < 0) {
  		perror("socket");
  		return -1;
  	}
  
  	memset(&ifr, 0, sizeof(ifr));
  	strncpy(ifr.ifr_name, ifname, IFNAMSIZ);
  	if (ioctl(s, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) {
  		perror("ioctl[SIOCGIFFLAGS]");
  		close(s);
  		return -1;
  	}
  	close(s);
  	*flags = ifr.ifr_flags & 0xffff;
  	return 0;
  }
  
  
  static int wpa_driver_wired_set_ifflags(const char *ifname, int flags)
  {
  	struct ifreq ifr;
  	int s;
  
  	s = socket(PF_INET, SOCK_DGRAM, 0);
  	if (s < 0) {
  		perror("socket");
  		return -1;
  	}
  
  	memset(&ifr, 0, sizeof(ifr));
  	strncpy(ifr.ifr_name, ifname, IFNAMSIZ);
  	ifr.ifr_flags = flags & 0xffff;
  	if (ioctl(s, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) {
  		perror("ioctl[SIOCSIFFLAGS]");
  		close(s);
  		return -1;
  	}
  	close(s);
  	return 0;
  }
  
  
  static int wpa_driver_wired_multi(const char *ifname, const u8 *addr, int add)
  {
  	struct ifreq ifr;
  	int s;
  
  	s = socket(PF_INET, SOCK_DGRAM, 0);
  	if (s < 0) {
  		perror("socket");
  		return -1;
  	}
  
  	memset(&ifr, 0, sizeof(ifr));
  	strncpy(ifr.ifr_name, ifname, IFNAMSIZ);
  	ifr.ifr_hwaddr.sa_family = AF_UNSPEC;
  	memcpy(ifr.ifr_hwaddr.sa_data, addr, ETH_ALEN);
  
  	if (ioctl(s, add ? SIOCADDMULTI : SIOCDELMULTI, (caddr_t) &ifr) < 0) {
  		perror("ioctl[SIOC{ADD/DEL}MULTI]");
  		close(s);
  		return -1;
  	}
  	close(s);
  	return 0;
  }
  
  
  static int wpa_driver_wired_membership(struct wpa_driver_wired_data *drv,
  				       const u8 *addr, int add)
  {
  #ifdef __linux__
  	struct packet_mreq mreq;
  
  	if (drv->pf_sock == -1)
  		return -1;
  
  	memset(&mreq, 0, sizeof(mreq));
  	mreq.mr_ifindex = if_nametoindex(drv->ifname);
  	mreq.mr_type = PACKET_MR_MULTICAST;
  	mreq.mr_alen = ETH_ALEN;
  	memcpy(mreq.mr_address, addr, ETH_ALEN);
  
  	if (setsockopt(drv->pf_sock, SOL_PACKET,
  		       add ? PACKET_ADD_MEMBERSHIP : PACKET_DROP_MEMBERSHIP,
  		       &mreq, sizeof(mreq)) < 0) {
  		perror("setsockopt");
  		return -1;
  	}
  	return 0;
  #else /* __linux__ */
  	return -1;
  #endif /* __linux__ */
  }
  
  
  static void * wpa_driver_wired_init(void *ctx, const char *ifname)
  {
  	struct wpa_driver_wired_data *drv;
  	int flags;
  
  	drv = malloc(sizeof(*drv));
  	if (drv == NULL)
  		return NULL;
  	memset(drv, 0, sizeof(*drv));
  	strncpy(drv->ifname, ifname, sizeof(drv->ifname));
  	drv->ctx = ctx;
  
  #ifdef __linux__
  	drv->pf_sock = socket(PF_PACKET, SOCK_DGRAM, 0);
  	if (drv->pf_sock < 0)
  		perror("socket(PF_PACKET)");
  #else
  	drv->pf_sock = -1;       
  #endif
  	
  	if (wpa_driver_wired_get_ifflags(ifname, &flags) == 0 &&
  	    !(flags & IFF_UP) &&
  	    wpa_driver_wired_set_ifflags(ifname, flags | IFF_UP) == 0) {
  		drv->iff_up = 1;
  	}
  
  	if (wpa_driver_wired_membership(drv, pae_group_addr, 1) == 0) {
  		wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
  			   "packet socket", __func__);
  		drv->membership = 1;
  	} else if (wpa_driver_wired_multi(ifname, pae_group_addr, 1) == 0) {
  		wpa_printf(MSG_DEBUG, "%s: Added multicast membership with "
  			   "SIOCADDMULTI", __func__);
  		drv->multi = 1;
  	} else if (wpa_driver_wired_get_ifflags(ifname, &flags) < 0) {
  		wpa_printf(MSG_INFO, "%s: Could not get interface "
  			   "flags", __func__);
  		free(drv);
  		return NULL;
  	} else if (flags & IFF_ALLMULTI) {
  		wpa_printf(MSG_DEBUG, "%s: Interface is already configured "
  			   "for multicast", __func__);
  	} else if (wpa_driver_wired_set_ifflags(ifname,
  						flags | IFF_ALLMULTI) < 0) {
  		wpa_printf(MSG_INFO, "%s: Failed to enable allmulti",
  			   __func__);
  		free(drv);
  		return NULL;
  	} else {
  		wpa_printf(MSG_DEBUG, "%s: Enabled allmulti mode",
  			   __func__);
  		drv->iff_allmulti = 1;
  	}
  
  	return drv;
  }
  
  
  static void wpa_driver_wired_deinit(void *priv)
  {
  	struct wpa_driver_wired_data *drv = priv;
  	int flags;
  
  	if (drv->membership &&
  	    wpa_driver_wired_membership(drv, pae_group_addr, 0) < 0) {
  		wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
  			   "group (PACKET)", __func__);
  	}
  
  	if (drv->multi &&
  	    wpa_driver_wired_multi(drv->ifname, pae_group_addr, 0) < 0) {
  		wpa_printf(MSG_DEBUG, "%s: Failed to remove PAE multicast "
  			   "group (SIOCDELMULTI)", __func__);
  	}
  
  	if (drv->iff_allmulti &&
  	    (wpa_driver_wired_get_ifflags(drv->ifname, &flags) < 0 ||
  	     wpa_driver_wired_set_ifflags(drv->ifname,
  					  flags & ~IFF_ALLMULTI) < 0)) {
  		wpa_printf(MSG_DEBUG, "%s: Failed to disable allmulti mode",
  			   __func__);
  	}
  
  	if (drv->iff_up &&
  	    wpa_driver_wired_get_ifflags(drv->ifname, &flags) == 0 &&
  	    (flags & IFF_UP) &&
  	    wpa_driver_wired_set_ifflags(drv->ifname, flags & ~IFF_UP) < 0) {
  		wpa_printf(MSG_DEBUG, "%s: Failed to set the interface down",
  			   __func__);
  	}
  
  	if (drv->pf_sock != -1)
  		close(drv->pf_sock);
  	
  	free(drv);
  }
  
  
  const struct wpa_driver_ops wpa_driver_wired_ops = {
  	.name = "wired",
  	.desc = "wpa_supplicant wired Ethernet driver",
  	.set_wpa = wpa_driver_wired_set_wpa,
  	.get_ssid = wpa_driver_wired_get_ssid,
  	.get_bssid = wpa_driver_wired_get_bssid,
  	.init = wpa_driver_wired_init,
  	.deinit = wpa_driver_wired_deinit,
  };
  