| // SPDX-License-Identifier: GPL-2.0 |
| /* drivers/net/wireless/virt_wifi.c |
| * |
| * A fake implementation of cfg80211_ops that can be tacked on to an ethernet |
| * net_device to make it appear as a wireless connection. |
| * |
| * Copyright (C) 2018 Google, Inc. |
| * |
| * Author: schuffelen@google.com |
| */ |
| |
| #include <net/cfg80211.h> |
| #include <net/rtnetlink.h> |
| #include <linux/etherdevice.h> |
| #include <linux/math64.h> |
| #include <linux/module.h> |
| #include <net/virt_wifi.h> |
| |
| static struct wiphy *common_wiphy; |
| |
| struct virt_wifi_wiphy_priv { |
| struct delayed_work scan_result; |
| struct cfg80211_scan_request *scan_request; |
| bool being_deleted; |
| struct virt_wifi_network_simulation *network_simulation; |
| }; |
| |
| static struct ieee80211_channel channel_2ghz = { |
| .band = NL80211_BAND_2GHZ, |
| .center_freq = 2432, |
| .hw_value = 2432, |
| .max_power = 20, |
| }; |
| |
| static struct ieee80211_rate bitrates_2ghz[] = { |
| { .bitrate = 10 }, |
| { .bitrate = 20 }, |
| { .bitrate = 55 }, |
| { .bitrate = 110 }, |
| { .bitrate = 60 }, |
| { .bitrate = 120 }, |
| { .bitrate = 240 }, |
| }; |
| |
| static struct ieee80211_supported_band band_2ghz = { |
| .channels = &channel_2ghz, |
| .bitrates = bitrates_2ghz, |
| .band = NL80211_BAND_2GHZ, |
| .n_channels = 1, |
| .n_bitrates = ARRAY_SIZE(bitrates_2ghz), |
| .ht_cap = { |
| .ht_supported = true, |
| .cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | |
| IEEE80211_HT_CAP_GRN_FLD | |
| IEEE80211_HT_CAP_SGI_20 | |
| IEEE80211_HT_CAP_SGI_40 | |
| IEEE80211_HT_CAP_DSSSCCK40, |
| .ampdu_factor = 0x3, |
| .ampdu_density = 0x6, |
| .mcs = { |
| .rx_mask = {0xff, 0xff}, |
| .tx_params = IEEE80211_HT_MCS_TX_DEFINED, |
| }, |
| }, |
| }; |
| |
| static struct ieee80211_channel channel_5ghz = { |
| .band = NL80211_BAND_5GHZ, |
| .center_freq = 5240, |
| .hw_value = 5240, |
| .max_power = 20, |
| }; |
| |
| static struct ieee80211_rate bitrates_5ghz[] = { |
| { .bitrate = 60 }, |
| { .bitrate = 120 }, |
| { .bitrate = 240 }, |
| }; |
| |
| #define RX_MCS_MAP (IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 4 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 6 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 8 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 10 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 12 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 14) |
| |
| #define TX_MCS_MAP (IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 4 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 6 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 8 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 10 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 12 | \ |
| IEEE80211_VHT_MCS_SUPPORT_0_9 << 14) |
| |
| static struct ieee80211_supported_band band_5ghz = { |
| .channels = &channel_5ghz, |
| .bitrates = bitrates_5ghz, |
| .band = NL80211_BAND_5GHZ, |
| .n_channels = 1, |
| .n_bitrates = ARRAY_SIZE(bitrates_5ghz), |
| .ht_cap = { |
| .ht_supported = true, |
| .cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | |
| IEEE80211_HT_CAP_GRN_FLD | |
| IEEE80211_HT_CAP_SGI_20 | |
| IEEE80211_HT_CAP_SGI_40 | |
| IEEE80211_HT_CAP_DSSSCCK40, |
| .ampdu_factor = 0x3, |
| .ampdu_density = 0x6, |
| .mcs = { |
| .rx_mask = {0xff, 0xff}, |
| .tx_params = IEEE80211_HT_MCS_TX_DEFINED, |
| }, |
| }, |
| .vht_cap = { |
| .vht_supported = true, |
| .cap = IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454 | |
| IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ | |
| IEEE80211_VHT_CAP_RXLDPC | |
| IEEE80211_VHT_CAP_SHORT_GI_80 | |
| IEEE80211_VHT_CAP_SHORT_GI_160 | |
| IEEE80211_VHT_CAP_TXSTBC | |
| IEEE80211_VHT_CAP_RXSTBC_1 | |
| IEEE80211_VHT_CAP_RXSTBC_2 | |
| IEEE80211_VHT_CAP_RXSTBC_3 | |
| IEEE80211_VHT_CAP_RXSTBC_4 | |
| IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK, |
| .vht_mcs = { |
| .rx_mcs_map = cpu_to_le16(RX_MCS_MAP), |
| .tx_mcs_map = cpu_to_le16(TX_MCS_MAP), |
| } |
| }, |
| }; |
| |
| /* Assigned at module init. Guaranteed locally-administered and unicast. */ |
| static u8 fake_router_bssid[ETH_ALEN] __ro_after_init = {}; |
| |
| static void virt_wifi_inform_bss(struct wiphy *wiphy) |
| { |
| u64 tsf = div_u64(ktime_get_boottime_ns(), 1000); |
| struct cfg80211_bss *informed_bss; |
| static const struct { |
| u8 tag; |
| u8 len; |
| u8 ssid[8]; |
| } __packed ssid = { |
| .tag = WLAN_EID_SSID, |
| .len = 8, |
| .ssid = "VirtWifi", |
| }; |
| |
| informed_bss = cfg80211_inform_bss(wiphy, &channel_5ghz, |
| CFG80211_BSS_FTYPE_PRESP, |
| fake_router_bssid, tsf, |
| WLAN_CAPABILITY_ESS, 0, |
| (void *)&ssid, sizeof(ssid), |
| DBM_TO_MBM(-50), GFP_KERNEL); |
| cfg80211_put_bss(wiphy, informed_bss); |
| } |
| |
| /* Called with the rtnl lock held. */ |
| static int virt_wifi_scan(struct wiphy *wiphy, |
| struct cfg80211_scan_request *request) |
| { |
| struct virt_wifi_wiphy_priv *priv = wiphy_priv(wiphy); |
| |
| wiphy_debug(wiphy, "scan\n"); |
| |
| if (priv->scan_request || priv->being_deleted) |
| return -EBUSY; |
| |
| priv->scan_request = request; |
| schedule_delayed_work(&priv->scan_result, HZ * 2); |
| if (priv->network_simulation && |
| priv->network_simulation->notify_scan_trigger) |
| priv->network_simulation->notify_scan_trigger(wiphy, request); |
| |
| return 0; |
| } |
| |
| /* Acquires and releases the rdev BSS lock. */ |
| static void virt_wifi_scan_result(struct work_struct *work) |
| { |
| struct virt_wifi_wiphy_priv *priv = |
| container_of(work, struct virt_wifi_wiphy_priv, |
| scan_result.work); |
| struct wiphy *wiphy = priv_to_wiphy(priv); |
| struct cfg80211_scan_info scan_info = { .aborted = false }; |
| |
| virt_wifi_inform_bss(wiphy); |
| |
| if(priv->network_simulation && |
| priv->network_simulation->generate_virt_scan_result) { |
| if(priv->network_simulation->generate_virt_scan_result(wiphy)) |
| wiphy_err(wiphy, "Fail to generater the simulated scan result.\n"); |
| } |
| |
| /* Schedules work which acquires and releases the rtnl lock. */ |
| cfg80211_scan_done(priv->scan_request, &scan_info); |
| priv->scan_request = NULL; |
| } |
| |
| /* May acquire and release the rdev BSS lock. */ |
| static void virt_wifi_cancel_scan(struct wiphy *wiphy) |
| { |
| struct virt_wifi_wiphy_priv *priv = wiphy_priv(wiphy); |
| |
| cancel_delayed_work_sync(&priv->scan_result); |
| /* Clean up dangling callbacks if necessary. */ |
| if (priv->scan_request) { |
| struct cfg80211_scan_info scan_info = { .aborted = true }; |
| /* Schedules work which acquires and releases the rtnl lock. */ |
| cfg80211_scan_done(priv->scan_request, &scan_info); |
| priv->scan_request = NULL; |
| } |
| } |
| |
| struct virt_wifi_netdev_priv { |
| struct delayed_work connect; |
| struct net_device *lowerdev; |
| struct net_device *upperdev; |
| u32 tx_packets; |
| u32 tx_failed; |
| u8 connect_requested_bss[ETH_ALEN]; |
| bool is_up; |
| bool is_connected; |
| bool being_deleted; |
| }; |
| |
| /* Called with the rtnl lock held. */ |
| static int virt_wifi_connect(struct wiphy *wiphy, struct net_device *netdev, |
| struct cfg80211_connect_params *sme) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(netdev); |
| bool could_schedule; |
| |
| if (priv->being_deleted || !priv->is_up) |
| return -EBUSY; |
| |
| could_schedule = schedule_delayed_work(&priv->connect, HZ * 2); |
| if (!could_schedule) |
| return -EBUSY; |
| |
| if (sme->bssid) { |
| ether_addr_copy(priv->connect_requested_bss, sme->bssid); |
| } else { |
| virt_wifi_inform_bss(wiphy); |
| eth_zero_addr(priv->connect_requested_bss); |
| } |
| |
| wiphy_debug(wiphy, "connect\n"); |
| |
| return 0; |
| } |
| |
| /* Acquires and releases the rdev event lock. */ |
| static void virt_wifi_connect_complete(struct work_struct *work) |
| { |
| struct virt_wifi_netdev_priv *priv = |
| container_of(work, struct virt_wifi_netdev_priv, connect.work); |
| u8 *requested_bss = priv->connect_requested_bss; |
| bool right_addr = ether_addr_equal(requested_bss, fake_router_bssid); |
| u16 status = WLAN_STATUS_SUCCESS; |
| |
| if (is_zero_ether_addr(requested_bss)) |
| requested_bss = NULL; |
| |
| if (!priv->is_up || (requested_bss && !right_addr)) |
| status = WLAN_STATUS_UNSPECIFIED_FAILURE; |
| else |
| priv->is_connected = true; |
| |
| /* Schedules an event that acquires the rtnl lock. */ |
| cfg80211_connect_result(priv->upperdev, requested_bss, NULL, 0, NULL, 0, |
| status, GFP_KERNEL); |
| netif_carrier_on(priv->upperdev); |
| } |
| |
| /* May acquire and release the rdev event lock. */ |
| static void virt_wifi_cancel_connect(struct net_device *netdev) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(netdev); |
| |
| /* If there is work pending, clean up dangling callbacks. */ |
| if (cancel_delayed_work_sync(&priv->connect)) { |
| /* Schedules an event that acquires the rtnl lock. */ |
| cfg80211_connect_result(priv->upperdev, |
| priv->connect_requested_bss, NULL, 0, |
| NULL, 0, |
| WLAN_STATUS_UNSPECIFIED_FAILURE, |
| GFP_KERNEL); |
| } |
| } |
| |
| /* Called with the rtnl lock held. Acquires the rdev event lock. */ |
| static int virt_wifi_disconnect(struct wiphy *wiphy, struct net_device *netdev, |
| u16 reason_code) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(netdev); |
| |
| if (priv->being_deleted) |
| return -EBUSY; |
| |
| wiphy_debug(wiphy, "disconnect\n"); |
| virt_wifi_cancel_connect(netdev); |
| |
| cfg80211_disconnected(netdev, reason_code, NULL, 0, true, GFP_KERNEL); |
| priv->is_connected = false; |
| netif_carrier_off(netdev); |
| |
| return 0; |
| } |
| |
| /* Called with the rtnl lock held. */ |
| static int virt_wifi_get_station(struct wiphy *wiphy, struct net_device *dev, |
| const u8 *mac, struct station_info *sinfo) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(dev); |
| |
| wiphy_debug(wiphy, "get_station\n"); |
| |
| if (!priv->is_connected || !ether_addr_equal(mac, fake_router_bssid)) |
| return -ENOENT; |
| |
| sinfo->filled = BIT_ULL(NL80211_STA_INFO_TX_PACKETS) | |
| BIT_ULL(NL80211_STA_INFO_TX_FAILED) | |
| BIT_ULL(NL80211_STA_INFO_SIGNAL) | |
| BIT_ULL(NL80211_STA_INFO_TX_BITRATE); |
| sinfo->tx_packets = priv->tx_packets; |
| sinfo->tx_failed = priv->tx_failed; |
| /* For CFG80211_SIGNAL_TYPE_MBM, value is expressed in _dBm_ */ |
| sinfo->signal = -50; |
| sinfo->txrate = (struct rate_info) { |
| .legacy = 10, /* units are 100kbit/s */ |
| }; |
| return 0; |
| } |
| |
| /* Called with the rtnl lock held. */ |
| static int virt_wifi_dump_station(struct wiphy *wiphy, struct net_device *dev, |
| int idx, u8 *mac, struct station_info *sinfo) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(dev); |
| |
| wiphy_debug(wiphy, "dump_station\n"); |
| |
| if (idx != 0 || !priv->is_connected) |
| return -ENOENT; |
| |
| ether_addr_copy(mac, fake_router_bssid); |
| return virt_wifi_get_station(wiphy, dev, fake_router_bssid, sinfo); |
| } |
| |
| static const struct cfg80211_ops virt_wifi_cfg80211_ops = { |
| .scan = virt_wifi_scan, |
| |
| .connect = virt_wifi_connect, |
| .disconnect = virt_wifi_disconnect, |
| |
| .get_station = virt_wifi_get_station, |
| .dump_station = virt_wifi_dump_station, |
| }; |
| |
| /* Acquires and releases the rtnl lock. */ |
| static struct wiphy *virt_wifi_make_wiphy(void) |
| { |
| struct wiphy *wiphy; |
| struct virt_wifi_wiphy_priv *priv; |
| int err; |
| |
| wiphy = wiphy_new(&virt_wifi_cfg80211_ops, sizeof(*priv)); |
| |
| if (!wiphy) |
| return NULL; |
| |
| wiphy->max_scan_ssids = 4; |
| wiphy->max_scan_ie_len = 1000; |
| wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; |
| |
| wiphy->bands[NL80211_BAND_2GHZ] = &band_2ghz; |
| wiphy->bands[NL80211_BAND_5GHZ] = &band_5ghz; |
| wiphy->bands[NL80211_BAND_60GHZ] = NULL; |
| |
| wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION); |
| |
| priv = wiphy_priv(wiphy); |
| priv->being_deleted = false; |
| priv->scan_request = NULL; |
| priv->network_simulation = NULL; |
| |
| INIT_DELAYED_WORK(&priv->scan_result, virt_wifi_scan_result); |
| |
| err = wiphy_register(wiphy); |
| if (err < 0) { |
| wiphy_free(wiphy); |
| return NULL; |
| } |
| |
| return wiphy; |
| } |
| |
| /* Acquires and releases the rtnl lock. */ |
| static void virt_wifi_destroy_wiphy(struct wiphy *wiphy) |
| { |
| struct virt_wifi_wiphy_priv *priv; |
| WARN(!wiphy, "%s called with null wiphy", __func__); |
| if (!wiphy) |
| return; |
| |
| priv = wiphy_priv(wiphy); |
| priv->being_deleted = true; |
| virt_wifi_cancel_scan(wiphy); |
| |
| if (wiphy->registered) |
| wiphy_unregister(wiphy); |
| wiphy_free(wiphy); |
| } |
| |
| /* Enters and exits a RCU-bh critical section. */ |
| static netdev_tx_t virt_wifi_start_xmit(struct sk_buff *skb, |
| struct net_device *dev) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(dev); |
| |
| priv->tx_packets++; |
| if (!priv->is_connected) { |
| priv->tx_failed++; |
| return NET_XMIT_DROP; |
| } |
| |
| skb->dev = priv->lowerdev; |
| return dev_queue_xmit(skb); |
| } |
| |
| /* Called with rtnl lock held. */ |
| static int virt_wifi_net_device_open(struct net_device *dev) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(dev); |
| struct virt_wifi_wiphy_priv *w_priv; |
| priv->is_up = true; |
| w_priv = wiphy_priv(dev->ieee80211_ptr->wiphy); |
| if(w_priv->network_simulation && |
| w_priv->network_simulation->notify_device_open) |
| w_priv->network_simulation->notify_device_open(dev); |
| |
| return 0; |
| } |
| |
| /* Called with rtnl lock held. */ |
| static int virt_wifi_net_device_stop(struct net_device *dev) |
| { |
| struct virt_wifi_netdev_priv *n_priv = netdev_priv(dev); |
| struct virt_wifi_wiphy_priv *w_priv; |
| |
| n_priv->is_up = false; |
| |
| if (!dev->ieee80211_ptr) |
| return 0; |
| w_priv = wiphy_priv(dev->ieee80211_ptr->wiphy); |
| |
| virt_wifi_cancel_scan(dev->ieee80211_ptr->wiphy); |
| virt_wifi_cancel_connect(dev); |
| netif_carrier_off(dev); |
| |
| if (w_priv->network_simulation && |
| w_priv->network_simulation->notify_device_stop) |
| w_priv->network_simulation->notify_device_stop(dev); |
| |
| return 0; |
| } |
| |
| static int virt_wifi_net_device_get_iflink(const struct net_device *dev) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(dev); |
| |
| return priv->lowerdev->ifindex; |
| } |
| |
| static const struct net_device_ops virt_wifi_ops = { |
| .ndo_start_xmit = virt_wifi_start_xmit, |
| .ndo_open = virt_wifi_net_device_open, |
| .ndo_stop = virt_wifi_net_device_stop, |
| .ndo_get_iflink = virt_wifi_net_device_get_iflink, |
| }; |
| |
| /* Invoked as part of rtnl lock release. */ |
| static void virt_wifi_net_device_destructor(struct net_device *dev) |
| { |
| /* Delayed past dellink to allow nl80211 to react to the device being |
| * deleted. |
| */ |
| kfree(dev->ieee80211_ptr); |
| dev->ieee80211_ptr = NULL; |
| } |
| |
| /* No lock interaction. */ |
| static void virt_wifi_setup(struct net_device *dev) |
| { |
| ether_setup(dev); |
| dev->netdev_ops = &virt_wifi_ops; |
| dev->needs_free_netdev = true; |
| } |
| |
| /* Called in a RCU read critical section from netif_receive_skb */ |
| static rx_handler_result_t virt_wifi_rx_handler(struct sk_buff **pskb) |
| { |
| struct sk_buff *skb = *pskb; |
| struct virt_wifi_netdev_priv *priv = |
| rcu_dereference(skb->dev->rx_handler_data); |
| |
| if (!priv->is_connected) |
| return RX_HANDLER_PASS; |
| |
| /* GFP_ATOMIC because this is a packet interrupt handler. */ |
| skb = skb_share_check(skb, GFP_ATOMIC); |
| if (!skb) { |
| dev_err(&priv->upperdev->dev, "can't skb_share_check\n"); |
| return RX_HANDLER_CONSUMED; |
| } |
| |
| *pskb = skb; |
| skb->dev = priv->upperdev; |
| skb->pkt_type = PACKET_HOST; |
| return RX_HANDLER_ANOTHER; |
| } |
| |
| /* Called with rtnl lock held. */ |
| static int virt_wifi_newlink(struct net *src_net, struct net_device *dev, |
| struct nlattr *tb[], struct nlattr *data[], |
| struct netlink_ext_ack *extack) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(dev); |
| int err; |
| |
| if (!tb[IFLA_LINK]) |
| return -EINVAL; |
| |
| netif_carrier_off(dev); |
| |
| priv->upperdev = dev; |
| priv->lowerdev = __dev_get_by_index(src_net, |
| nla_get_u32(tb[IFLA_LINK])); |
| |
| if (!priv->lowerdev) |
| return -ENODEV; |
| if (!tb[IFLA_MTU]) |
| dev->mtu = priv->lowerdev->mtu; |
| else if (dev->mtu > priv->lowerdev->mtu) |
| return -EINVAL; |
| |
| err = netdev_rx_handler_register(priv->lowerdev, virt_wifi_rx_handler, |
| priv); |
| if (err) { |
| dev_err(&priv->lowerdev->dev, |
| "can't netdev_rx_handler_register: %d\n", err); |
| return err; |
| } |
| |
| eth_hw_addr_inherit(dev, priv->lowerdev); |
| netif_stacked_transfer_operstate(priv->lowerdev, dev); |
| |
| SET_NETDEV_DEV(dev, &priv->lowerdev->dev); |
| dev->ieee80211_ptr = kzalloc(sizeof(*dev->ieee80211_ptr), GFP_KERNEL); |
| |
| if (!dev->ieee80211_ptr) { |
| err = -ENOMEM; |
| goto remove_handler; |
| } |
| |
| dev->ieee80211_ptr->iftype = NL80211_IFTYPE_STATION; |
| dev->ieee80211_ptr->wiphy = common_wiphy; |
| |
| err = register_netdevice(dev); |
| if (err) { |
| dev_err(&priv->lowerdev->dev, "can't register_netdevice: %d\n", |
| err); |
| goto free_wireless_dev; |
| } |
| |
| err = netdev_upper_dev_link(priv->lowerdev, dev, extack); |
| if (err) { |
| dev_err(&priv->lowerdev->dev, "can't netdev_upper_dev_link: %d\n", |
| err); |
| goto unregister_netdev; |
| } |
| |
| dev->priv_destructor = virt_wifi_net_device_destructor; |
| priv->being_deleted = false; |
| priv->is_connected = false; |
| priv->is_up = false; |
| INIT_DELAYED_WORK(&priv->connect, virt_wifi_connect_complete); |
| __module_get(THIS_MODULE); |
| |
| return 0; |
| unregister_netdev: |
| unregister_netdevice(dev); |
| free_wireless_dev: |
| kfree(dev->ieee80211_ptr); |
| dev->ieee80211_ptr = NULL; |
| remove_handler: |
| netdev_rx_handler_unregister(priv->lowerdev); |
| |
| return err; |
| } |
| |
| /* Called with rtnl lock held. */ |
| static void virt_wifi_dellink(struct net_device *dev, |
| struct list_head *head) |
| { |
| struct virt_wifi_netdev_priv *priv = netdev_priv(dev); |
| |
| if (dev->ieee80211_ptr) |
| virt_wifi_cancel_scan(dev->ieee80211_ptr->wiphy); |
| |
| priv->being_deleted = true; |
| virt_wifi_cancel_connect(dev); |
| netif_carrier_off(dev); |
| |
| netdev_rx_handler_unregister(priv->lowerdev); |
| netdev_upper_dev_unlink(priv->lowerdev, dev); |
| |
| unregister_netdevice_queue(dev, head); |
| module_put(THIS_MODULE); |
| |
| /* Deleting the wiphy is handled in the module destructor. */ |
| } |
| |
| static struct rtnl_link_ops virt_wifi_link_ops = { |
| .kind = "virt_wifi", |
| .setup = virt_wifi_setup, |
| .newlink = virt_wifi_newlink, |
| .dellink = virt_wifi_dellink, |
| .priv_size = sizeof(struct virt_wifi_netdev_priv), |
| }; |
| |
| static bool netif_is_virt_wifi_dev(const struct net_device *dev) |
| { |
| return rcu_access_pointer(dev->rx_handler) == virt_wifi_rx_handler; |
| } |
| |
| static int virt_wifi_event(struct notifier_block *this, unsigned long event, |
| void *ptr) |
| { |
| struct net_device *lower_dev = netdev_notifier_info_to_dev(ptr); |
| struct virt_wifi_netdev_priv *priv; |
| struct net_device *upper_dev; |
| LIST_HEAD(list_kill); |
| |
| if (!netif_is_virt_wifi_dev(lower_dev)) |
| return NOTIFY_DONE; |
| |
| switch (event) { |
| case NETDEV_UNREGISTER: |
| priv = rtnl_dereference(lower_dev->rx_handler_data); |
| if (!priv) |
| return NOTIFY_DONE; |
| |
| upper_dev = priv->upperdev; |
| |
| upper_dev->rtnl_link_ops->dellink(upper_dev, &list_kill); |
| unregister_netdevice_many(&list_kill); |
| break; |
| } |
| |
| return NOTIFY_DONE; |
| } |
| |
| static struct notifier_block virt_wifi_notifier = { |
| .notifier_call = virt_wifi_event, |
| }; |
| |
| /* Acquires and releases the rtnl lock. */ |
| static int __init virt_wifi_init_module(void) |
| { |
| int err; |
| |
| /* Guaranteed to be locallly-administered and not multicast. */ |
| eth_random_addr(fake_router_bssid); |
| |
| err = register_netdevice_notifier(&virt_wifi_notifier); |
| if (err) |
| return err; |
| |
| err = -ENOMEM; |
| common_wiphy = virt_wifi_make_wiphy(); |
| if (!common_wiphy) |
| goto notifier; |
| |
| err = rtnl_link_register(&virt_wifi_link_ops); |
| if (err) |
| goto destroy_wiphy; |
| |
| return 0; |
| |
| destroy_wiphy: |
| virt_wifi_destroy_wiphy(common_wiphy); |
| notifier: |
| unregister_netdevice_notifier(&virt_wifi_notifier); |
| return err; |
| } |
| |
| /* Acquires and releases the rtnl lock. */ |
| static void __exit virt_wifi_cleanup_module(void) |
| { |
| /* Will delete any devices that depend on the wiphy. */ |
| rtnl_link_unregister(&virt_wifi_link_ops); |
| virt_wifi_destroy_wiphy(common_wiphy); |
| unregister_netdevice_notifier(&virt_wifi_notifier); |
| } |
| |
| int virt_wifi_register_network_simulation |
| (struct virt_wifi_network_simulation *ops) |
| { |
| struct virt_wifi_wiphy_priv *priv = wiphy_priv(common_wiphy); |
| if (priv->network_simulation) |
| return -EEXIST; |
| priv->network_simulation = ops; |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(virt_wifi_register_network_simulation); |
| |
| int virt_wifi_unregister_network_simulation(void) |
| { |
| struct virt_wifi_wiphy_priv *priv = wiphy_priv(common_wiphy); |
| if(!priv->network_simulation) |
| return -ENODATA; |
| priv->network_simulation = NULL; |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(virt_wifi_unregister_network_simulation); |
| |
| module_init(virt_wifi_init_module); |
| module_exit(virt_wifi_cleanup_module); |
| |
| MODULE_LICENSE("GPL v2"); |
| MODULE_AUTHOR("Cody Schuffelen <schuffelen@google.com>"); |
| MODULE_DESCRIPTION("Driver for a wireless wrapper of ethernet devices"); |
| MODULE_ALIAS_RTNL_LINK("virt_wifi"); |