xref: /OK3568_Linux_fs/kernel/drivers/net/wireless/virt_wifi.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /* drivers/net/wireless/virt_wifi.c
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * A fake implementation of cfg80211_ops that can be tacked on to an ethernet
5*4882a593Smuzhiyun  * net_device to make it appear as a wireless connection.
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Copyright (C) 2018 Google, Inc.
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * Author: schuffelen@google.com
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <net/cfg80211.h>
13*4882a593Smuzhiyun #include <net/rtnetlink.h>
14*4882a593Smuzhiyun #include <linux/etherdevice.h>
15*4882a593Smuzhiyun #include <linux/math64.h>
16*4882a593Smuzhiyun #include <linux/module.h>
17*4882a593Smuzhiyun #include <net/virt_wifi.h>
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun static struct wiphy *common_wiphy;
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun struct virt_wifi_wiphy_priv {
22*4882a593Smuzhiyun 	struct delayed_work scan_result;
23*4882a593Smuzhiyun 	struct cfg80211_scan_request *scan_request;
24*4882a593Smuzhiyun 	bool being_deleted;
25*4882a593Smuzhiyun 	struct virt_wifi_network_simulation *network_simulation;
26*4882a593Smuzhiyun };
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun static struct ieee80211_channel channel_2ghz = {
29*4882a593Smuzhiyun 	.band = NL80211_BAND_2GHZ,
30*4882a593Smuzhiyun 	.center_freq = 2432,
31*4882a593Smuzhiyun 	.hw_value = 2432,
32*4882a593Smuzhiyun 	.max_power = 20,
33*4882a593Smuzhiyun };
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun static struct ieee80211_rate bitrates_2ghz[] = {
36*4882a593Smuzhiyun 	{ .bitrate = 10 },
37*4882a593Smuzhiyun 	{ .bitrate = 20 },
38*4882a593Smuzhiyun 	{ .bitrate = 55 },
39*4882a593Smuzhiyun 	{ .bitrate = 110 },
40*4882a593Smuzhiyun 	{ .bitrate = 60 },
41*4882a593Smuzhiyun 	{ .bitrate = 120 },
42*4882a593Smuzhiyun 	{ .bitrate = 240 },
43*4882a593Smuzhiyun };
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun static struct ieee80211_supported_band band_2ghz = {
46*4882a593Smuzhiyun 	.channels = &channel_2ghz,
47*4882a593Smuzhiyun 	.bitrates = bitrates_2ghz,
48*4882a593Smuzhiyun 	.band = NL80211_BAND_2GHZ,
49*4882a593Smuzhiyun 	.n_channels = 1,
50*4882a593Smuzhiyun 	.n_bitrates = ARRAY_SIZE(bitrates_2ghz),
51*4882a593Smuzhiyun 	.ht_cap = {
52*4882a593Smuzhiyun 		.ht_supported = true,
53*4882a593Smuzhiyun 		.cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 |
54*4882a593Smuzhiyun 		       IEEE80211_HT_CAP_GRN_FLD |
55*4882a593Smuzhiyun 		       IEEE80211_HT_CAP_SGI_20 |
56*4882a593Smuzhiyun 		       IEEE80211_HT_CAP_SGI_40 |
57*4882a593Smuzhiyun 		       IEEE80211_HT_CAP_DSSSCCK40,
58*4882a593Smuzhiyun 		.ampdu_factor = 0x3,
59*4882a593Smuzhiyun 		.ampdu_density = 0x6,
60*4882a593Smuzhiyun 		.mcs = {
61*4882a593Smuzhiyun 			.rx_mask = {0xff, 0xff},
62*4882a593Smuzhiyun 			.tx_params = IEEE80211_HT_MCS_TX_DEFINED,
63*4882a593Smuzhiyun 		},
64*4882a593Smuzhiyun 	},
65*4882a593Smuzhiyun };
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun static struct ieee80211_channel channel_5ghz = {
68*4882a593Smuzhiyun 	.band = NL80211_BAND_5GHZ,
69*4882a593Smuzhiyun 	.center_freq = 5240,
70*4882a593Smuzhiyun 	.hw_value = 5240,
71*4882a593Smuzhiyun 	.max_power = 20,
72*4882a593Smuzhiyun };
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun static struct ieee80211_rate bitrates_5ghz[] = {
75*4882a593Smuzhiyun 	{ .bitrate = 60 },
76*4882a593Smuzhiyun 	{ .bitrate = 120 },
77*4882a593Smuzhiyun 	{ .bitrate = 240 },
78*4882a593Smuzhiyun };
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun #define RX_MCS_MAP (IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 | \
81*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 | \
82*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 4 | \
83*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 6 | \
84*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 8 | \
85*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 10 | \
86*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 12 | \
87*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 14)
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun #define TX_MCS_MAP (IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 | \
90*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 | \
91*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 4 | \
92*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 6 | \
93*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 8 | \
94*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 10 | \
95*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 12 | \
96*4882a593Smuzhiyun 		    IEEE80211_VHT_MCS_SUPPORT_0_9 << 14)
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun static struct ieee80211_supported_band band_5ghz = {
99*4882a593Smuzhiyun 	.channels = &channel_5ghz,
100*4882a593Smuzhiyun 	.bitrates = bitrates_5ghz,
101*4882a593Smuzhiyun 	.band = NL80211_BAND_5GHZ,
102*4882a593Smuzhiyun 	.n_channels = 1,
103*4882a593Smuzhiyun 	.n_bitrates = ARRAY_SIZE(bitrates_5ghz),
104*4882a593Smuzhiyun 	.ht_cap = {
105*4882a593Smuzhiyun 		.ht_supported = true,
106*4882a593Smuzhiyun 		.cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 |
107*4882a593Smuzhiyun 		       IEEE80211_HT_CAP_GRN_FLD |
108*4882a593Smuzhiyun 		       IEEE80211_HT_CAP_SGI_20 |
109*4882a593Smuzhiyun 		       IEEE80211_HT_CAP_SGI_40 |
110*4882a593Smuzhiyun 		       IEEE80211_HT_CAP_DSSSCCK40,
111*4882a593Smuzhiyun 		.ampdu_factor = 0x3,
112*4882a593Smuzhiyun 		.ampdu_density = 0x6,
113*4882a593Smuzhiyun 		.mcs = {
114*4882a593Smuzhiyun 			.rx_mask = {0xff, 0xff},
115*4882a593Smuzhiyun 			.tx_params = IEEE80211_HT_MCS_TX_DEFINED,
116*4882a593Smuzhiyun 		},
117*4882a593Smuzhiyun 	},
118*4882a593Smuzhiyun 	.vht_cap = {
119*4882a593Smuzhiyun 		.vht_supported = true,
120*4882a593Smuzhiyun 		.cap = IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454 |
121*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ |
122*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_RXLDPC |
123*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_SHORT_GI_80 |
124*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_SHORT_GI_160 |
125*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_TXSTBC |
126*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_RXSTBC_1 |
127*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_RXSTBC_2 |
128*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_RXSTBC_3 |
129*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_RXSTBC_4 |
130*4882a593Smuzhiyun 		       IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK,
131*4882a593Smuzhiyun 		.vht_mcs = {
132*4882a593Smuzhiyun 			.rx_mcs_map = cpu_to_le16(RX_MCS_MAP),
133*4882a593Smuzhiyun 			.tx_mcs_map = cpu_to_le16(TX_MCS_MAP),
134*4882a593Smuzhiyun 		}
135*4882a593Smuzhiyun 	},
136*4882a593Smuzhiyun };
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun /* Assigned at module init. Guaranteed locally-administered and unicast. */
139*4882a593Smuzhiyun static u8 fake_router_bssid[ETH_ALEN] __ro_after_init = {};
140*4882a593Smuzhiyun 
virt_wifi_inform_bss(struct wiphy * wiphy)141*4882a593Smuzhiyun static void virt_wifi_inform_bss(struct wiphy *wiphy)
142*4882a593Smuzhiyun {
143*4882a593Smuzhiyun 	u64 tsf = div_u64(ktime_get_boottime_ns(), 1000);
144*4882a593Smuzhiyun 	struct cfg80211_bss *informed_bss;
145*4882a593Smuzhiyun 	static const struct {
146*4882a593Smuzhiyun 		u8 tag;
147*4882a593Smuzhiyun 		u8 len;
148*4882a593Smuzhiyun 		u8 ssid[8];
149*4882a593Smuzhiyun 	} __packed ssid = {
150*4882a593Smuzhiyun 		.tag = WLAN_EID_SSID,
151*4882a593Smuzhiyun 		.len = 8,
152*4882a593Smuzhiyun 		.ssid = "VirtWifi",
153*4882a593Smuzhiyun 	};
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	informed_bss = cfg80211_inform_bss(wiphy, &channel_5ghz,
156*4882a593Smuzhiyun 					   CFG80211_BSS_FTYPE_PRESP,
157*4882a593Smuzhiyun 					   fake_router_bssid, tsf,
158*4882a593Smuzhiyun 					   WLAN_CAPABILITY_ESS, 0,
159*4882a593Smuzhiyun 					   (void *)&ssid, sizeof(ssid),
160*4882a593Smuzhiyun 					   DBM_TO_MBM(-50), GFP_KERNEL);
161*4882a593Smuzhiyun 	cfg80211_put_bss(wiphy, informed_bss);
162*4882a593Smuzhiyun }
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun /* Called with the rtnl lock held. */
virt_wifi_scan(struct wiphy * wiphy,struct cfg80211_scan_request * request)165*4882a593Smuzhiyun static int virt_wifi_scan(struct wiphy *wiphy,
166*4882a593Smuzhiyun 			  struct cfg80211_scan_request *request)
167*4882a593Smuzhiyun {
168*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *priv = wiphy_priv(wiphy);
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	wiphy_debug(wiphy, "scan\n");
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	if (priv->scan_request || priv->being_deleted)
173*4882a593Smuzhiyun 		return -EBUSY;
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun 	priv->scan_request = request;
176*4882a593Smuzhiyun 	schedule_delayed_work(&priv->scan_result, HZ * 2);
177*4882a593Smuzhiyun 	if (priv->network_simulation &&
178*4882a593Smuzhiyun 	    priv->network_simulation->notify_scan_trigger)
179*4882a593Smuzhiyun 		priv->network_simulation->notify_scan_trigger(wiphy, request);
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	return 0;
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun /* Acquires and releases the rdev BSS lock. */
virt_wifi_scan_result(struct work_struct * work)185*4882a593Smuzhiyun static void virt_wifi_scan_result(struct work_struct *work)
186*4882a593Smuzhiyun {
187*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *priv =
188*4882a593Smuzhiyun 		container_of(work, struct virt_wifi_wiphy_priv,
189*4882a593Smuzhiyun 			     scan_result.work);
190*4882a593Smuzhiyun 	struct wiphy *wiphy = priv_to_wiphy(priv);
191*4882a593Smuzhiyun 	struct cfg80211_scan_info scan_info = { .aborted = false };
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 	virt_wifi_inform_bss(wiphy);
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun 	if(priv->network_simulation &&
196*4882a593Smuzhiyun 	   priv->network_simulation->generate_virt_scan_result) {
197*4882a593Smuzhiyun 		if(priv->network_simulation->generate_virt_scan_result(wiphy))
198*4882a593Smuzhiyun 			wiphy_err(wiphy, "Fail to generater the simulated scan result.\n");
199*4882a593Smuzhiyun 	}
200*4882a593Smuzhiyun 
201*4882a593Smuzhiyun 	/* Schedules work which acquires and releases the rtnl lock. */
202*4882a593Smuzhiyun 	cfg80211_scan_done(priv->scan_request, &scan_info);
203*4882a593Smuzhiyun 	priv->scan_request = NULL;
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun /* May acquire and release the rdev BSS lock. */
virt_wifi_cancel_scan(struct wiphy * wiphy)207*4882a593Smuzhiyun static void virt_wifi_cancel_scan(struct wiphy *wiphy)
208*4882a593Smuzhiyun {
209*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *priv = wiphy_priv(wiphy);
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	cancel_delayed_work_sync(&priv->scan_result);
212*4882a593Smuzhiyun 	/* Clean up dangling callbacks if necessary. */
213*4882a593Smuzhiyun 	if (priv->scan_request) {
214*4882a593Smuzhiyun 		struct cfg80211_scan_info scan_info = { .aborted = true };
215*4882a593Smuzhiyun 		/* Schedules work which acquires and releases the rtnl lock. */
216*4882a593Smuzhiyun 		cfg80211_scan_done(priv->scan_request, &scan_info);
217*4882a593Smuzhiyun 		priv->scan_request = NULL;
218*4882a593Smuzhiyun 	}
219*4882a593Smuzhiyun }
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun struct virt_wifi_netdev_priv {
222*4882a593Smuzhiyun 	struct delayed_work connect;
223*4882a593Smuzhiyun 	struct net_device *lowerdev;
224*4882a593Smuzhiyun 	struct net_device *upperdev;
225*4882a593Smuzhiyun 	u32 tx_packets;
226*4882a593Smuzhiyun 	u32 tx_failed;
227*4882a593Smuzhiyun 	u8 connect_requested_bss[ETH_ALEN];
228*4882a593Smuzhiyun 	bool is_up;
229*4882a593Smuzhiyun 	bool is_connected;
230*4882a593Smuzhiyun 	bool being_deleted;
231*4882a593Smuzhiyun };
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun /* Called with the rtnl lock held. */
virt_wifi_connect(struct wiphy * wiphy,struct net_device * netdev,struct cfg80211_connect_params * sme)234*4882a593Smuzhiyun static int virt_wifi_connect(struct wiphy *wiphy, struct net_device *netdev,
235*4882a593Smuzhiyun 			     struct cfg80211_connect_params *sme)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(netdev);
238*4882a593Smuzhiyun 	bool could_schedule;
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun 	if (priv->being_deleted || !priv->is_up)
241*4882a593Smuzhiyun 		return -EBUSY;
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	could_schedule = schedule_delayed_work(&priv->connect, HZ * 2);
244*4882a593Smuzhiyun 	if (!could_schedule)
245*4882a593Smuzhiyun 		return -EBUSY;
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	if (sme->bssid) {
248*4882a593Smuzhiyun 		ether_addr_copy(priv->connect_requested_bss, sme->bssid);
249*4882a593Smuzhiyun 	} else {
250*4882a593Smuzhiyun 		virt_wifi_inform_bss(wiphy);
251*4882a593Smuzhiyun 		eth_zero_addr(priv->connect_requested_bss);
252*4882a593Smuzhiyun 	}
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	wiphy_debug(wiphy, "connect\n");
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 	return 0;
257*4882a593Smuzhiyun }
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun /* Acquires and releases the rdev event lock. */
virt_wifi_connect_complete(struct work_struct * work)260*4882a593Smuzhiyun static void virt_wifi_connect_complete(struct work_struct *work)
261*4882a593Smuzhiyun {
262*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv =
263*4882a593Smuzhiyun 		container_of(work, struct virt_wifi_netdev_priv, connect.work);
264*4882a593Smuzhiyun 	u8 *requested_bss = priv->connect_requested_bss;
265*4882a593Smuzhiyun 	bool right_addr = ether_addr_equal(requested_bss, fake_router_bssid);
266*4882a593Smuzhiyun 	u16 status = WLAN_STATUS_SUCCESS;
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	if (is_zero_ether_addr(requested_bss))
269*4882a593Smuzhiyun 		requested_bss = NULL;
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 	if (!priv->is_up || (requested_bss && !right_addr))
272*4882a593Smuzhiyun 		status = WLAN_STATUS_UNSPECIFIED_FAILURE;
273*4882a593Smuzhiyun 	else
274*4882a593Smuzhiyun 		priv->is_connected = true;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	/* Schedules an event that acquires the rtnl lock. */
277*4882a593Smuzhiyun 	cfg80211_connect_result(priv->upperdev, requested_bss, NULL, 0, NULL, 0,
278*4882a593Smuzhiyun 				status, GFP_KERNEL);
279*4882a593Smuzhiyun 	netif_carrier_on(priv->upperdev);
280*4882a593Smuzhiyun }
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun /* May acquire and release the rdev event lock. */
virt_wifi_cancel_connect(struct net_device * netdev)283*4882a593Smuzhiyun static void virt_wifi_cancel_connect(struct net_device *netdev)
284*4882a593Smuzhiyun {
285*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(netdev);
286*4882a593Smuzhiyun 
287*4882a593Smuzhiyun 	/* If there is work pending, clean up dangling callbacks. */
288*4882a593Smuzhiyun 	if (cancel_delayed_work_sync(&priv->connect)) {
289*4882a593Smuzhiyun 		/* Schedules an event that acquires the rtnl lock. */
290*4882a593Smuzhiyun 		cfg80211_connect_result(priv->upperdev,
291*4882a593Smuzhiyun 					priv->connect_requested_bss, NULL, 0,
292*4882a593Smuzhiyun 					NULL, 0,
293*4882a593Smuzhiyun 					WLAN_STATUS_UNSPECIFIED_FAILURE,
294*4882a593Smuzhiyun 					GFP_KERNEL);
295*4882a593Smuzhiyun 	}
296*4882a593Smuzhiyun }
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun /* Called with the rtnl lock held. Acquires the rdev event lock. */
virt_wifi_disconnect(struct wiphy * wiphy,struct net_device * netdev,u16 reason_code)299*4882a593Smuzhiyun static int virt_wifi_disconnect(struct wiphy *wiphy, struct net_device *netdev,
300*4882a593Smuzhiyun 				u16 reason_code)
301*4882a593Smuzhiyun {
302*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(netdev);
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	if (priv->being_deleted)
305*4882a593Smuzhiyun 		return -EBUSY;
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun 	wiphy_debug(wiphy, "disconnect\n");
308*4882a593Smuzhiyun 	virt_wifi_cancel_connect(netdev);
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	cfg80211_disconnected(netdev, reason_code, NULL, 0, true, GFP_KERNEL);
311*4882a593Smuzhiyun 	priv->is_connected = false;
312*4882a593Smuzhiyun 	netif_carrier_off(netdev);
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	return 0;
315*4882a593Smuzhiyun }
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun /* Called with the rtnl lock held. */
virt_wifi_get_station(struct wiphy * wiphy,struct net_device * dev,const u8 * mac,struct station_info * sinfo)318*4882a593Smuzhiyun static int virt_wifi_get_station(struct wiphy *wiphy, struct net_device *dev,
319*4882a593Smuzhiyun 				 const u8 *mac, struct station_info *sinfo)
320*4882a593Smuzhiyun {
321*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(dev);
322*4882a593Smuzhiyun 
323*4882a593Smuzhiyun 	wiphy_debug(wiphy, "get_station\n");
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	if (!priv->is_connected || !ether_addr_equal(mac, fake_router_bssid))
326*4882a593Smuzhiyun 		return -ENOENT;
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	sinfo->filled = BIT_ULL(NL80211_STA_INFO_TX_PACKETS) |
329*4882a593Smuzhiyun 		BIT_ULL(NL80211_STA_INFO_TX_FAILED) |
330*4882a593Smuzhiyun 		BIT_ULL(NL80211_STA_INFO_SIGNAL) |
331*4882a593Smuzhiyun 		BIT_ULL(NL80211_STA_INFO_TX_BITRATE);
332*4882a593Smuzhiyun 	sinfo->tx_packets = priv->tx_packets;
333*4882a593Smuzhiyun 	sinfo->tx_failed = priv->tx_failed;
334*4882a593Smuzhiyun 	/* For CFG80211_SIGNAL_TYPE_MBM, value is expressed in _dBm_ */
335*4882a593Smuzhiyun 	sinfo->signal = -50;
336*4882a593Smuzhiyun 	sinfo->txrate = (struct rate_info) {
337*4882a593Smuzhiyun 		.legacy = 10, /* units are 100kbit/s */
338*4882a593Smuzhiyun 	};
339*4882a593Smuzhiyun 	return 0;
340*4882a593Smuzhiyun }
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun /* Called with the rtnl lock held. */
virt_wifi_dump_station(struct wiphy * wiphy,struct net_device * dev,int idx,u8 * mac,struct station_info * sinfo)343*4882a593Smuzhiyun static int virt_wifi_dump_station(struct wiphy *wiphy, struct net_device *dev,
344*4882a593Smuzhiyun 				  int idx, u8 *mac, struct station_info *sinfo)
345*4882a593Smuzhiyun {
346*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(dev);
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	wiphy_debug(wiphy, "dump_station\n");
349*4882a593Smuzhiyun 
350*4882a593Smuzhiyun 	if (idx != 0 || !priv->is_connected)
351*4882a593Smuzhiyun 		return -ENOENT;
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 	ether_addr_copy(mac, fake_router_bssid);
354*4882a593Smuzhiyun 	return virt_wifi_get_station(wiphy, dev, fake_router_bssid, sinfo);
355*4882a593Smuzhiyun }
356*4882a593Smuzhiyun 
357*4882a593Smuzhiyun static const struct cfg80211_ops virt_wifi_cfg80211_ops = {
358*4882a593Smuzhiyun 	.scan = virt_wifi_scan,
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 	.connect = virt_wifi_connect,
361*4882a593Smuzhiyun 	.disconnect = virt_wifi_disconnect,
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	.get_station = virt_wifi_get_station,
364*4882a593Smuzhiyun 	.dump_station = virt_wifi_dump_station,
365*4882a593Smuzhiyun };
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun /* Acquires and releases the rtnl lock. */
virt_wifi_make_wiphy(void)368*4882a593Smuzhiyun static struct wiphy *virt_wifi_make_wiphy(void)
369*4882a593Smuzhiyun {
370*4882a593Smuzhiyun 	struct wiphy *wiphy;
371*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *priv;
372*4882a593Smuzhiyun 	int err;
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun 	wiphy = wiphy_new(&virt_wifi_cfg80211_ops, sizeof(*priv));
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun 	if (!wiphy)
377*4882a593Smuzhiyun 		return NULL;
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 	wiphy->max_scan_ssids = 4;
380*4882a593Smuzhiyun 	wiphy->max_scan_ie_len = 1000;
381*4882a593Smuzhiyun 	wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	wiphy->bands[NL80211_BAND_2GHZ] = &band_2ghz;
384*4882a593Smuzhiyun 	wiphy->bands[NL80211_BAND_5GHZ] = &band_5ghz;
385*4882a593Smuzhiyun 	wiphy->bands[NL80211_BAND_60GHZ] = NULL;
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 	wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun 	priv = wiphy_priv(wiphy);
390*4882a593Smuzhiyun 	priv->being_deleted = false;
391*4882a593Smuzhiyun 	priv->scan_request = NULL;
392*4882a593Smuzhiyun 	priv->network_simulation = NULL;
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun 	INIT_DELAYED_WORK(&priv->scan_result, virt_wifi_scan_result);
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 	err = wiphy_register(wiphy);
397*4882a593Smuzhiyun 	if (err < 0) {
398*4882a593Smuzhiyun 		wiphy_free(wiphy);
399*4882a593Smuzhiyun 		return NULL;
400*4882a593Smuzhiyun 	}
401*4882a593Smuzhiyun 
402*4882a593Smuzhiyun 	return wiphy;
403*4882a593Smuzhiyun }
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun /* Acquires and releases the rtnl lock. */
virt_wifi_destroy_wiphy(struct wiphy * wiphy)406*4882a593Smuzhiyun static void virt_wifi_destroy_wiphy(struct wiphy *wiphy)
407*4882a593Smuzhiyun {
408*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *priv;
409*4882a593Smuzhiyun 	WARN(!wiphy, "%s called with null wiphy", __func__);
410*4882a593Smuzhiyun 	if (!wiphy)
411*4882a593Smuzhiyun 		return;
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 	priv = wiphy_priv(wiphy);
414*4882a593Smuzhiyun 	priv->being_deleted = true;
415*4882a593Smuzhiyun 	virt_wifi_cancel_scan(wiphy);
416*4882a593Smuzhiyun 
417*4882a593Smuzhiyun 	if (wiphy->registered)
418*4882a593Smuzhiyun 		wiphy_unregister(wiphy);
419*4882a593Smuzhiyun 	wiphy_free(wiphy);
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun 
422*4882a593Smuzhiyun /* Enters and exits a RCU-bh critical section. */
virt_wifi_start_xmit(struct sk_buff * skb,struct net_device * dev)423*4882a593Smuzhiyun static netdev_tx_t virt_wifi_start_xmit(struct sk_buff *skb,
424*4882a593Smuzhiyun 					struct net_device *dev)
425*4882a593Smuzhiyun {
426*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(dev);
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	priv->tx_packets++;
429*4882a593Smuzhiyun 	if (!priv->is_connected) {
430*4882a593Smuzhiyun 		priv->tx_failed++;
431*4882a593Smuzhiyun 		return NET_XMIT_DROP;
432*4882a593Smuzhiyun 	}
433*4882a593Smuzhiyun 
434*4882a593Smuzhiyun 	skb->dev = priv->lowerdev;
435*4882a593Smuzhiyun 	return dev_queue_xmit(skb);
436*4882a593Smuzhiyun }
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun /* Called with rtnl lock held. */
virt_wifi_net_device_open(struct net_device * dev)439*4882a593Smuzhiyun static int virt_wifi_net_device_open(struct net_device *dev)
440*4882a593Smuzhiyun {
441*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(dev);
442*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *w_priv;
443*4882a593Smuzhiyun 	priv->is_up = true;
444*4882a593Smuzhiyun 	w_priv = wiphy_priv(dev->ieee80211_ptr->wiphy);
445*4882a593Smuzhiyun 	if(w_priv->network_simulation &&
446*4882a593Smuzhiyun 	   w_priv->network_simulation->notify_device_open)
447*4882a593Smuzhiyun 		w_priv->network_simulation->notify_device_open(dev);
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun 	return 0;
450*4882a593Smuzhiyun }
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun /* Called with rtnl lock held. */
virt_wifi_net_device_stop(struct net_device * dev)453*4882a593Smuzhiyun static int virt_wifi_net_device_stop(struct net_device *dev)
454*4882a593Smuzhiyun {
455*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *n_priv = netdev_priv(dev);
456*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *w_priv;
457*4882a593Smuzhiyun 
458*4882a593Smuzhiyun 	n_priv->is_up = false;
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 	if (!dev->ieee80211_ptr)
461*4882a593Smuzhiyun 		return 0;
462*4882a593Smuzhiyun 	w_priv = wiphy_priv(dev->ieee80211_ptr->wiphy);
463*4882a593Smuzhiyun 
464*4882a593Smuzhiyun 	virt_wifi_cancel_scan(dev->ieee80211_ptr->wiphy);
465*4882a593Smuzhiyun 	virt_wifi_cancel_connect(dev);
466*4882a593Smuzhiyun 	netif_carrier_off(dev);
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	if (w_priv->network_simulation &&
469*4882a593Smuzhiyun 	    w_priv->network_simulation->notify_device_stop)
470*4882a593Smuzhiyun 		w_priv->network_simulation->notify_device_stop(dev);
471*4882a593Smuzhiyun 
472*4882a593Smuzhiyun 	return 0;
473*4882a593Smuzhiyun }
474*4882a593Smuzhiyun 
virt_wifi_net_device_get_iflink(const struct net_device * dev)475*4882a593Smuzhiyun static int virt_wifi_net_device_get_iflink(const struct net_device *dev)
476*4882a593Smuzhiyun {
477*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(dev);
478*4882a593Smuzhiyun 
479*4882a593Smuzhiyun 	return priv->lowerdev->ifindex;
480*4882a593Smuzhiyun }
481*4882a593Smuzhiyun 
482*4882a593Smuzhiyun static const struct net_device_ops virt_wifi_ops = {
483*4882a593Smuzhiyun 	.ndo_start_xmit = virt_wifi_start_xmit,
484*4882a593Smuzhiyun 	.ndo_open	= virt_wifi_net_device_open,
485*4882a593Smuzhiyun 	.ndo_stop	= virt_wifi_net_device_stop,
486*4882a593Smuzhiyun 	.ndo_get_iflink = virt_wifi_net_device_get_iflink,
487*4882a593Smuzhiyun };
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun /* Invoked as part of rtnl lock release. */
virt_wifi_net_device_destructor(struct net_device * dev)490*4882a593Smuzhiyun static void virt_wifi_net_device_destructor(struct net_device *dev)
491*4882a593Smuzhiyun {
492*4882a593Smuzhiyun 	/* Delayed past dellink to allow nl80211 to react to the device being
493*4882a593Smuzhiyun 	 * deleted.
494*4882a593Smuzhiyun 	 */
495*4882a593Smuzhiyun 	kfree(dev->ieee80211_ptr);
496*4882a593Smuzhiyun 	dev->ieee80211_ptr = NULL;
497*4882a593Smuzhiyun }
498*4882a593Smuzhiyun 
499*4882a593Smuzhiyun /* No lock interaction. */
virt_wifi_setup(struct net_device * dev)500*4882a593Smuzhiyun static void virt_wifi_setup(struct net_device *dev)
501*4882a593Smuzhiyun {
502*4882a593Smuzhiyun 	ether_setup(dev);
503*4882a593Smuzhiyun 	dev->netdev_ops = &virt_wifi_ops;
504*4882a593Smuzhiyun 	dev->needs_free_netdev  = true;
505*4882a593Smuzhiyun }
506*4882a593Smuzhiyun 
507*4882a593Smuzhiyun /* Called in a RCU read critical section from netif_receive_skb */
virt_wifi_rx_handler(struct sk_buff ** pskb)508*4882a593Smuzhiyun static rx_handler_result_t virt_wifi_rx_handler(struct sk_buff **pskb)
509*4882a593Smuzhiyun {
510*4882a593Smuzhiyun 	struct sk_buff *skb = *pskb;
511*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv =
512*4882a593Smuzhiyun 		rcu_dereference(skb->dev->rx_handler_data);
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun 	if (!priv->is_connected)
515*4882a593Smuzhiyun 		return RX_HANDLER_PASS;
516*4882a593Smuzhiyun 
517*4882a593Smuzhiyun 	/* GFP_ATOMIC because this is a packet interrupt handler. */
518*4882a593Smuzhiyun 	skb = skb_share_check(skb, GFP_ATOMIC);
519*4882a593Smuzhiyun 	if (!skb) {
520*4882a593Smuzhiyun 		dev_err(&priv->upperdev->dev, "can't skb_share_check\n");
521*4882a593Smuzhiyun 		return RX_HANDLER_CONSUMED;
522*4882a593Smuzhiyun 	}
523*4882a593Smuzhiyun 
524*4882a593Smuzhiyun 	*pskb = skb;
525*4882a593Smuzhiyun 	skb->dev = priv->upperdev;
526*4882a593Smuzhiyun 	skb->pkt_type = PACKET_HOST;
527*4882a593Smuzhiyun 	return RX_HANDLER_ANOTHER;
528*4882a593Smuzhiyun }
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun /* Called with rtnl lock held. */
virt_wifi_newlink(struct net * src_net,struct net_device * dev,struct nlattr * tb[],struct nlattr * data[],struct netlink_ext_ack * extack)531*4882a593Smuzhiyun static int virt_wifi_newlink(struct net *src_net, struct net_device *dev,
532*4882a593Smuzhiyun 			     struct nlattr *tb[], struct nlattr *data[],
533*4882a593Smuzhiyun 			     struct netlink_ext_ack *extack)
534*4882a593Smuzhiyun {
535*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(dev);
536*4882a593Smuzhiyun 	int err;
537*4882a593Smuzhiyun 
538*4882a593Smuzhiyun 	if (!tb[IFLA_LINK])
539*4882a593Smuzhiyun 		return -EINVAL;
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun 	netif_carrier_off(dev);
542*4882a593Smuzhiyun 
543*4882a593Smuzhiyun 	priv->upperdev = dev;
544*4882a593Smuzhiyun 	priv->lowerdev = __dev_get_by_index(src_net,
545*4882a593Smuzhiyun 					    nla_get_u32(tb[IFLA_LINK]));
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	if (!priv->lowerdev)
548*4882a593Smuzhiyun 		return -ENODEV;
549*4882a593Smuzhiyun 	if (!tb[IFLA_MTU])
550*4882a593Smuzhiyun 		dev->mtu = priv->lowerdev->mtu;
551*4882a593Smuzhiyun 	else if (dev->mtu > priv->lowerdev->mtu)
552*4882a593Smuzhiyun 		return -EINVAL;
553*4882a593Smuzhiyun 
554*4882a593Smuzhiyun 	err = netdev_rx_handler_register(priv->lowerdev, virt_wifi_rx_handler,
555*4882a593Smuzhiyun 					 priv);
556*4882a593Smuzhiyun 	if (err) {
557*4882a593Smuzhiyun 		dev_err(&priv->lowerdev->dev,
558*4882a593Smuzhiyun 			"can't netdev_rx_handler_register: %d\n", err);
559*4882a593Smuzhiyun 		return err;
560*4882a593Smuzhiyun 	}
561*4882a593Smuzhiyun 
562*4882a593Smuzhiyun 	eth_hw_addr_inherit(dev, priv->lowerdev);
563*4882a593Smuzhiyun 	netif_stacked_transfer_operstate(priv->lowerdev, dev);
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun 	SET_NETDEV_DEV(dev, &priv->lowerdev->dev);
566*4882a593Smuzhiyun 	dev->ieee80211_ptr = kzalloc(sizeof(*dev->ieee80211_ptr), GFP_KERNEL);
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	if (!dev->ieee80211_ptr) {
569*4882a593Smuzhiyun 		err = -ENOMEM;
570*4882a593Smuzhiyun 		goto remove_handler;
571*4882a593Smuzhiyun 	}
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun 	dev->ieee80211_ptr->iftype = NL80211_IFTYPE_STATION;
574*4882a593Smuzhiyun 	dev->ieee80211_ptr->wiphy = common_wiphy;
575*4882a593Smuzhiyun 
576*4882a593Smuzhiyun 	err = register_netdevice(dev);
577*4882a593Smuzhiyun 	if (err) {
578*4882a593Smuzhiyun 		dev_err(&priv->lowerdev->dev, "can't register_netdevice: %d\n",
579*4882a593Smuzhiyun 			err);
580*4882a593Smuzhiyun 		goto free_wireless_dev;
581*4882a593Smuzhiyun 	}
582*4882a593Smuzhiyun 
583*4882a593Smuzhiyun 	err = netdev_upper_dev_link(priv->lowerdev, dev, extack);
584*4882a593Smuzhiyun 	if (err) {
585*4882a593Smuzhiyun 		dev_err(&priv->lowerdev->dev, "can't netdev_upper_dev_link: %d\n",
586*4882a593Smuzhiyun 			err);
587*4882a593Smuzhiyun 		goto unregister_netdev;
588*4882a593Smuzhiyun 	}
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 	dev->priv_destructor = virt_wifi_net_device_destructor;
591*4882a593Smuzhiyun 	priv->being_deleted = false;
592*4882a593Smuzhiyun 	priv->is_connected = false;
593*4882a593Smuzhiyun 	priv->is_up = false;
594*4882a593Smuzhiyun 	INIT_DELAYED_WORK(&priv->connect, virt_wifi_connect_complete);
595*4882a593Smuzhiyun 	__module_get(THIS_MODULE);
596*4882a593Smuzhiyun 
597*4882a593Smuzhiyun 	return 0;
598*4882a593Smuzhiyun unregister_netdev:
599*4882a593Smuzhiyun 	unregister_netdevice(dev);
600*4882a593Smuzhiyun free_wireless_dev:
601*4882a593Smuzhiyun 	kfree(dev->ieee80211_ptr);
602*4882a593Smuzhiyun 	dev->ieee80211_ptr = NULL;
603*4882a593Smuzhiyun remove_handler:
604*4882a593Smuzhiyun 	netdev_rx_handler_unregister(priv->lowerdev);
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun 	return err;
607*4882a593Smuzhiyun }
608*4882a593Smuzhiyun 
609*4882a593Smuzhiyun /* Called with rtnl lock held. */
virt_wifi_dellink(struct net_device * dev,struct list_head * head)610*4882a593Smuzhiyun static void virt_wifi_dellink(struct net_device *dev,
611*4882a593Smuzhiyun 			      struct list_head *head)
612*4882a593Smuzhiyun {
613*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv = netdev_priv(dev);
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun 	if (dev->ieee80211_ptr)
616*4882a593Smuzhiyun 		virt_wifi_cancel_scan(dev->ieee80211_ptr->wiphy);
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	priv->being_deleted = true;
619*4882a593Smuzhiyun 	virt_wifi_cancel_connect(dev);
620*4882a593Smuzhiyun 	netif_carrier_off(dev);
621*4882a593Smuzhiyun 
622*4882a593Smuzhiyun 	netdev_rx_handler_unregister(priv->lowerdev);
623*4882a593Smuzhiyun 	netdev_upper_dev_unlink(priv->lowerdev, dev);
624*4882a593Smuzhiyun 
625*4882a593Smuzhiyun 	unregister_netdevice_queue(dev, head);
626*4882a593Smuzhiyun 	module_put(THIS_MODULE);
627*4882a593Smuzhiyun 
628*4882a593Smuzhiyun 	/* Deleting the wiphy is handled in the module destructor. */
629*4882a593Smuzhiyun }
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun static struct rtnl_link_ops virt_wifi_link_ops = {
632*4882a593Smuzhiyun 	.kind		= "virt_wifi",
633*4882a593Smuzhiyun 	.setup		= virt_wifi_setup,
634*4882a593Smuzhiyun 	.newlink	= virt_wifi_newlink,
635*4882a593Smuzhiyun 	.dellink	= virt_wifi_dellink,
636*4882a593Smuzhiyun 	.priv_size	= sizeof(struct virt_wifi_netdev_priv),
637*4882a593Smuzhiyun };
638*4882a593Smuzhiyun 
netif_is_virt_wifi_dev(const struct net_device * dev)639*4882a593Smuzhiyun static bool netif_is_virt_wifi_dev(const struct net_device *dev)
640*4882a593Smuzhiyun {
641*4882a593Smuzhiyun 	return rcu_access_pointer(dev->rx_handler) == virt_wifi_rx_handler;
642*4882a593Smuzhiyun }
643*4882a593Smuzhiyun 
virt_wifi_event(struct notifier_block * this,unsigned long event,void * ptr)644*4882a593Smuzhiyun static int virt_wifi_event(struct notifier_block *this, unsigned long event,
645*4882a593Smuzhiyun 			   void *ptr)
646*4882a593Smuzhiyun {
647*4882a593Smuzhiyun 	struct net_device *lower_dev = netdev_notifier_info_to_dev(ptr);
648*4882a593Smuzhiyun 	struct virt_wifi_netdev_priv *priv;
649*4882a593Smuzhiyun 	struct net_device *upper_dev;
650*4882a593Smuzhiyun 	LIST_HEAD(list_kill);
651*4882a593Smuzhiyun 
652*4882a593Smuzhiyun 	if (!netif_is_virt_wifi_dev(lower_dev))
653*4882a593Smuzhiyun 		return NOTIFY_DONE;
654*4882a593Smuzhiyun 
655*4882a593Smuzhiyun 	switch (event) {
656*4882a593Smuzhiyun 	case NETDEV_UNREGISTER:
657*4882a593Smuzhiyun 		priv = rtnl_dereference(lower_dev->rx_handler_data);
658*4882a593Smuzhiyun 		if (!priv)
659*4882a593Smuzhiyun 			return NOTIFY_DONE;
660*4882a593Smuzhiyun 
661*4882a593Smuzhiyun 		upper_dev = priv->upperdev;
662*4882a593Smuzhiyun 
663*4882a593Smuzhiyun 		upper_dev->rtnl_link_ops->dellink(upper_dev, &list_kill);
664*4882a593Smuzhiyun 		unregister_netdevice_many(&list_kill);
665*4882a593Smuzhiyun 		break;
666*4882a593Smuzhiyun 	}
667*4882a593Smuzhiyun 
668*4882a593Smuzhiyun 	return NOTIFY_DONE;
669*4882a593Smuzhiyun }
670*4882a593Smuzhiyun 
671*4882a593Smuzhiyun static struct notifier_block virt_wifi_notifier = {
672*4882a593Smuzhiyun 	.notifier_call = virt_wifi_event,
673*4882a593Smuzhiyun };
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun /* Acquires and releases the rtnl lock. */
virt_wifi_init_module(void)676*4882a593Smuzhiyun static int __init virt_wifi_init_module(void)
677*4882a593Smuzhiyun {
678*4882a593Smuzhiyun 	int err;
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun 	/* Guaranteed to be locallly-administered and not multicast. */
681*4882a593Smuzhiyun 	eth_random_addr(fake_router_bssid);
682*4882a593Smuzhiyun 
683*4882a593Smuzhiyun 	err = register_netdevice_notifier(&virt_wifi_notifier);
684*4882a593Smuzhiyun 	if (err)
685*4882a593Smuzhiyun 		return err;
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 	err = -ENOMEM;
688*4882a593Smuzhiyun 	common_wiphy = virt_wifi_make_wiphy();
689*4882a593Smuzhiyun 	if (!common_wiphy)
690*4882a593Smuzhiyun 		goto notifier;
691*4882a593Smuzhiyun 
692*4882a593Smuzhiyun 	err = rtnl_link_register(&virt_wifi_link_ops);
693*4882a593Smuzhiyun 	if (err)
694*4882a593Smuzhiyun 		goto destroy_wiphy;
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun 	return 0;
697*4882a593Smuzhiyun 
698*4882a593Smuzhiyun destroy_wiphy:
699*4882a593Smuzhiyun 	virt_wifi_destroy_wiphy(common_wiphy);
700*4882a593Smuzhiyun notifier:
701*4882a593Smuzhiyun 	unregister_netdevice_notifier(&virt_wifi_notifier);
702*4882a593Smuzhiyun 	return err;
703*4882a593Smuzhiyun }
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun /* Acquires and releases the rtnl lock. */
virt_wifi_cleanup_module(void)706*4882a593Smuzhiyun static void __exit virt_wifi_cleanup_module(void)
707*4882a593Smuzhiyun {
708*4882a593Smuzhiyun 	/* Will delete any devices that depend on the wiphy. */
709*4882a593Smuzhiyun 	rtnl_link_unregister(&virt_wifi_link_ops);
710*4882a593Smuzhiyun 	virt_wifi_destroy_wiphy(common_wiphy);
711*4882a593Smuzhiyun 	unregister_netdevice_notifier(&virt_wifi_notifier);
712*4882a593Smuzhiyun }
713*4882a593Smuzhiyun 
virt_wifi_register_network_simulation(struct virt_wifi_network_simulation * ops)714*4882a593Smuzhiyun int virt_wifi_register_network_simulation
715*4882a593Smuzhiyun 	(struct virt_wifi_network_simulation *ops)
716*4882a593Smuzhiyun {
717*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *priv = wiphy_priv(common_wiphy);
718*4882a593Smuzhiyun 	if (priv->network_simulation)
719*4882a593Smuzhiyun 		return -EEXIST;
720*4882a593Smuzhiyun 	priv->network_simulation = ops;
721*4882a593Smuzhiyun 	return 0;
722*4882a593Smuzhiyun }
723*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(virt_wifi_register_network_simulation);
724*4882a593Smuzhiyun 
virt_wifi_unregister_network_simulation(void)725*4882a593Smuzhiyun int virt_wifi_unregister_network_simulation(void)
726*4882a593Smuzhiyun {
727*4882a593Smuzhiyun 	struct virt_wifi_wiphy_priv *priv = wiphy_priv(common_wiphy);
728*4882a593Smuzhiyun 	if(!priv->network_simulation)
729*4882a593Smuzhiyun 		return -ENODATA;
730*4882a593Smuzhiyun 	priv->network_simulation = NULL;
731*4882a593Smuzhiyun 	return 0;
732*4882a593Smuzhiyun }
733*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(virt_wifi_unregister_network_simulation);
734*4882a593Smuzhiyun 
735*4882a593Smuzhiyun module_init(virt_wifi_init_module);
736*4882a593Smuzhiyun module_exit(virt_wifi_cleanup_module);
737*4882a593Smuzhiyun 
738*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
739*4882a593Smuzhiyun MODULE_AUTHOR("Cody Schuffelen <schuffelen@google.com>");
740*4882a593Smuzhiyun MODULE_DESCRIPTION("Driver for a wireless wrapper of ethernet devices");
741*4882a593Smuzhiyun MODULE_ALIAS_RTNL_LINK("virt_wifi");
742