Kernel

Kernel Git Source Tree

Root/drivers/net/wireless/mac80211_hwsim.c

1	/*
2	* mac80211_hwsim - software simulator of 802.11 radio(s) for mac80211
3	* Copyright (c) 2008, 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
10	/*
11	* TODO:
12	* - IBSS mode simulation (Beacon transmission with competition for "air time")
13	* - RX filtering based on filter configuration (data->rx_filter)
14	*/
15
16	#include <linux/list.h>
17	#include <linux/spinlock.h>
18	#include <net/mac80211.h>
19	#include <net/ieee80211_radiotap.h>
20	#include <linux/if_arp.h>
21	#include <linux/rtnetlink.h>
22	#include <linux/etherdevice.h>
23	#include <linux/debugfs.h>
24
25	MODULE_AUTHOR("Jouni Malinen");
26	MODULE_DESCRIPTION("Software simulator of 802.11 radio(s) for mac80211");
27	MODULE_LICENSE("GPL");
28
29	static int radios = 2;
30	module_param(radios, int, 0444);
31	MODULE_PARM_DESC(radios, "Number of simulated radios");
32
33	/**
34	* enum hwsim_regtest - the type of regulatory tests we offer
35	*
36	* These are the different values you can use for the regtest
37	* module parameter. This is useful to help test world roaming
38	* and the driver regulatory_hint() call and combinations of these.
39	* If you want to do specific alpha2 regulatory domain tests simply
40	* use the userspace regulatory request as that will be respected as
41	* well without the need of this module parameter. This is designed
42	* only for testing the driver regulatory request, world roaming
43	* and all possible combinations.
44	*
45	* @HWSIM_REGTEST_DISABLED: No regulatory tests are performed,
46	* this is the default value.
47	* @HWSIM_REGTEST_DRIVER_REG_FOLLOW: Used for testing the driver regulatory
48	* hint, only one driver regulatory hint will be sent as such the
49	* secondary radios are expected to follow.
50	* @HWSIM_REGTEST_DRIVER_REG_ALL: Used for testing the driver regulatory
51	* request with all radios reporting the same regulatory domain.
52	* @HWSIM_REGTEST_DIFF_COUNTRY: Used for testing the drivers calling
53	* different regulatory domains requests. Expected behaviour is for
54	* an intersection to occur but each device will still use their
55	* respective regulatory requested domains. Subsequent radios will
56	* use the resulting intersection.
57	* @HWSIM_REGTEST_WORLD_ROAM: Used for testing the world roaming. We acomplish
58	* this by using a custom beacon-capable regulatory domain for the first
59	* radio. All other device world roam.
60	* @HWSIM_REGTEST_CUSTOM_WORLD: Used for testing the custom world regulatory
61	* domain requests. All radios will adhere to this custom world regulatory
62	* domain.
63	* @HWSIM_REGTEST_CUSTOM_WORLD_2: Used for testing 2 custom world regulatory
64	* domain requests. The first radio will adhere to the first custom world
65	* regulatory domain, the second one to the second custom world regulatory
66	* domain. All other devices will world roam.
67	* @HWSIM_REGTEST_STRICT_FOLLOW_: Used for testing strict regulatory domain
68	* settings, only the first radio will send a regulatory domain request
69	* and use strict settings. The rest of the radios are expected to follow.
70	* @HWSIM_REGTEST_STRICT_ALL: Used for testing strict regulatory domain
71	* settings. All radios will adhere to this.
72	* @HWSIM_REGTEST_STRICT_AND_DRIVER_REG: Used for testing strict regulatory
73	* domain settings, combined with secondary driver regulatory domain
74	* settings. The first radio will get a strict regulatory domain setting
75	* using the first driver regulatory request and the second radio will use
76	* non-strict settings using the second driver regulatory request. All
77	* other devices should follow the intersection created between the
78	* first two.
79	* @HWSIM_REGTEST_ALL: Used for testing every possible mix. You will need
80	* at least 6 radios for a complete test. We will test in this order:
81	* 1 - driver custom world regulatory domain
82	* 2 - second custom world regulatory domain
83	* 3 - first driver regulatory domain request
84	* 4 - second driver regulatory domain request
85	* 5 - strict regulatory domain settings using the third driver regulatory
86	* domain request
87	* 6 and on - should follow the intersection of the 3rd, 4rth and 5th radio
88	* regulatory requests.
89	*/
90	enum hwsim_regtest {
91	HWSIM_REGTEST_DISABLED = 0,
92	HWSIM_REGTEST_DRIVER_REG_FOLLOW = 1,
93	HWSIM_REGTEST_DRIVER_REG_ALL = 2,
94	HWSIM_REGTEST_DIFF_COUNTRY = 3,
95	HWSIM_REGTEST_WORLD_ROAM = 4,
96	HWSIM_REGTEST_CUSTOM_WORLD = 5,
97	HWSIM_REGTEST_CUSTOM_WORLD_2 = 6,
98	HWSIM_REGTEST_STRICT_FOLLOW = 7,
99	HWSIM_REGTEST_STRICT_ALL = 8,
100	HWSIM_REGTEST_STRICT_AND_DRIVER_REG = 9,
101	HWSIM_REGTEST_ALL = 10,
102	};
103
104	/* Set to one of the HWSIM_REGTEST_* values above */
105	static int regtest = HWSIM_REGTEST_DISABLED;
106	module_param(regtest, int, 0444);
107	MODULE_PARM_DESC(regtest, "The type of regulatory test we want to run");
108
109	static const char *hwsim_alpha2s[] = {
110	"FI",
111	"AL",
112	"US",
113	"DE",
114	"JP",
115	"AL",
116	};
117
118	static const struct ieee80211_regdomain hwsim_world_regdom_custom_01 = {
119	.n_reg_rules = 4,
120	.alpha2 = "99",
121	.reg_rules = {
122	REG_RULE(2412-10, 2462+10, 40, 0, 20, 0),
123	REG_RULE(2484-10, 2484+10, 40, 0, 20, 0),
124	REG_RULE(5150-10, 5240+10, 40, 0, 30, 0),
125	REG_RULE(5745-10, 5825+10, 40, 0, 30, 0),
126	}
127	};
128
129	static const struct ieee80211_regdomain hwsim_world_regdom_custom_02 = {
130	.n_reg_rules = 2,
131	.alpha2 = "99",
132	.reg_rules = {
133	REG_RULE(2412-10, 2462+10, 40, 0, 20, 0),
134	REG_RULE(5725-10, 5850+10, 40, 0, 30,
135	NL80211_RRF_PASSIVE_SCAN \| NL80211_RRF_NO_IBSS),
136	}
137	};
138
139	struct hwsim_vif_priv {
140	u32 magic;
141	u8 bssid[ETH_ALEN];
142	bool assoc;
143	u16 aid;
144	};
145
146	#define HWSIM_VIF_MAGIC 0x69537748
147
148	static inline void hwsim_check_magic(struct ieee80211_vif *vif)
149	{
150	struct hwsim_vif_priv vp = (void )vif->drv_priv;
151	WARN_ON(vp->magic != HWSIM_VIF_MAGIC);
152	}
153
154	static inline void hwsim_set_magic(struct ieee80211_vif *vif)
155	{
156	struct hwsim_vif_priv vp = (void )vif->drv_priv;
157	vp->magic = HWSIM_VIF_MAGIC;
158	}
159
160	static inline void hwsim_clear_magic(struct ieee80211_vif *vif)
161	{
162	struct hwsim_vif_priv vp = (void )vif->drv_priv;
163	vp->magic = 0;
164	}
165
166	struct hwsim_sta_priv {
167	u32 magic;
168	};
169
170	#define HWSIM_STA_MAGIC 0x6d537748
171
172	static inline void hwsim_check_sta_magic(struct ieee80211_sta *sta)
173	{
174	struct hwsim_sta_priv sp = (void )sta->drv_priv;
175	WARN_ON(sp->magic != HWSIM_STA_MAGIC);
176	}
177
178	static inline void hwsim_set_sta_magic(struct ieee80211_sta *sta)
179	{
180	struct hwsim_sta_priv sp = (void )sta->drv_priv;
181	sp->magic = HWSIM_STA_MAGIC;
182	}
183
184	static inline void hwsim_clear_sta_magic(struct ieee80211_sta *sta)
185	{
186	struct hwsim_sta_priv sp = (void )sta->drv_priv;
187	sp->magic = 0;
188	}
189
190	static struct class *hwsim_class;
191
192	static struct net_device hwsim_mon; / global monitor netdev */
193
194	#define CHAN2G(_freq) { \
195	.band = IEEE80211_BAND_2GHZ, \
196	.center_freq = (_freq), \
197	.hw_value = (_freq), \
198	.max_power = 20, \
199	}
200
201	#define CHAN5G(_freq) { \
202	.band = IEEE80211_BAND_5GHZ, \
203	.center_freq = (_freq), \
204	.hw_value = (_freq), \
205	.max_power = 20, \
206	}
207
208	static const struct ieee80211_channel hwsim_channels_2ghz[] = {
209	CHAN2G(2412), /* Channel 1 */
210	CHAN2G(2417), /* Channel 2 */
211	CHAN2G(2422), /* Channel 3 */
212	CHAN2G(2427), /* Channel 4 */
213	CHAN2G(2432), /* Channel 5 */
214	CHAN2G(2437), /* Channel 6 */
215	CHAN2G(2442), /* Channel 7 */
216	CHAN2G(2447), /* Channel 8 */
217	CHAN2G(2452), /* Channel 9 */
218	CHAN2G(2457), /* Channel 10 */
219	CHAN2G(2462), /* Channel 11 */
220	CHAN2G(2467), /* Channel 12 */
221	CHAN2G(2472), /* Channel 13 */
222	CHAN2G(2484), /* Channel 14 */
223	};
224
225	static const struct ieee80211_channel hwsim_channels_5ghz[] = {
226	CHAN5G(5180), /* Channel 36 */
227	CHAN5G(5200), /* Channel 40 */
228	CHAN5G(5220), /* Channel 44 */
229	CHAN5G(5240), /* Channel 48 */
230
231	CHAN5G(5260), /* Channel 52 */
232	CHAN5G(5280), /* Channel 56 */
233	CHAN5G(5300), /* Channel 60 */
234	CHAN5G(5320), /* Channel 64 */
235
236	CHAN5G(5500), /* Channel 100 */
237	CHAN5G(5520), /* Channel 104 */
238	CHAN5G(5540), /* Channel 108 */
239	CHAN5G(5560), /* Channel 112 */
240	CHAN5G(5580), /* Channel 116 */
241	CHAN5G(5600), /* Channel 120 */
242	CHAN5G(5620), /* Channel 124 */
243	CHAN5G(5640), /* Channel 128 */
244	CHAN5G(5660), /* Channel 132 */
245	CHAN5G(5680), /* Channel 136 */
246	CHAN5G(5700), /* Channel 140 */
247
248	CHAN5G(5745), /* Channel 149 */
249	CHAN5G(5765), /* Channel 153 */
250	CHAN5G(5785), /* Channel 157 */
251	CHAN5G(5805), /* Channel 161 */
252	CHAN5G(5825), /* Channel 165 */
253	};
254
255	static const struct ieee80211_rate hwsim_rates[] = {
256	{ .bitrate = 10 },
257	{ .bitrate = 20, .flags = IEEE80211_RATE_SHORT_PREAMBLE },
258	{ .bitrate = 55, .flags = IEEE80211_RATE_SHORT_PREAMBLE },
259	{ .bitrate = 110, .flags = IEEE80211_RATE_SHORT_PREAMBLE },
260	{ .bitrate = 60 },
261	{ .bitrate = 90 },
262	{ .bitrate = 120 },
263	{ .bitrate = 180 },
264	{ .bitrate = 240 },
265	{ .bitrate = 360 },
266	{ .bitrate = 480 },
267	{ .bitrate = 540 }
268	};
269
270	static spinlock_t hwsim_radio_lock;
271	static struct list_head hwsim_radios;
272
273	struct mac80211_hwsim_data {
274	struct list_head list;
275	struct ieee80211_hw *hw;
276	struct device *dev;
277	struct ieee80211_supported_band bands[2];
278	struct ieee80211_channel channels_2ghz[ARRAY_SIZE(hwsim_channels_2ghz)];
279	struct ieee80211_channel channels_5ghz[ARRAY_SIZE(hwsim_channels_5ghz)];
280	struct ieee80211_rate rates[ARRAY_SIZE(hwsim_rates)];
281
282	struct ieee80211_channel *channel;
283	unsigned long beacon_int; /* in jiffies unit */
284	unsigned int rx_filter;
285	int started;
286	struct timer_list beacon_timer;
287	enum ps_mode {
288	PS_DISABLED, PS_ENABLED, PS_AUTO_POLL, PS_MANUAL_POLL
289	} ps;
290	bool ps_poll_pending;
291	struct dentry *debugfs;
292	struct dentry *debugfs_ps;
293
294	/*
295	* Only radios in the same group can communicate together (the
296	* channel has to match too). Each bit represents a group. A
297	* radio can be in more then one group.
298	*/
299	u64 group;
300	struct dentry *debugfs_group;
301	};
302
303
304	struct hwsim_radiotap_hdr {
305	struct ieee80211_radiotap_header hdr;
306	u8 rt_flags;
307	u8 rt_rate;
308	__le16 rt_channel;
309	__le16 rt_chbitmask;
310	} __attribute__ ((packed));
311
312
313	static int hwsim_mon_xmit(struct sk_buff skb, struct net_device dev)
314	{
315	/* TODO: allow packet injection */
316	dev_kfree_skb(skb);
317	return 0;
318	}
319
320
321	static void mac80211_hwsim_monitor_rx(struct ieee80211_hw *hw,
322	struct sk_buff *tx_skb)
323	{
324	struct mac80211_hwsim_data *data = hw->priv;
325	struct sk_buff *skb;
326	struct hwsim_radiotap_hdr *hdr;
327	u16 flags;
328	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(tx_skb);
329	struct ieee80211_rate *txrate = ieee80211_get_tx_rate(hw, info);
330
331	if (!netif_running(hwsim_mon))
332	return;
333
334	skb = skb_copy_expand(tx_skb, sizeof(*hdr), 0, GFP_ATOMIC);
335	if (skb == NULL)
336	return;
337
338	hdr = (struct hwsim_radiotap_hdr ) skb_push(skb, sizeof(hdr));
339	hdr->hdr.it_version = PKTHDR_RADIOTAP_VERSION;
340	hdr->hdr.it_pad = 0;
341	hdr->hdr.it_len = cpu_to_le16(sizeof(*hdr));
342	hdr->hdr.it_present = cpu_to_le32((1 << IEEE80211_RADIOTAP_FLAGS) \|
343	(1 << IEEE80211_RADIOTAP_RATE) \|
344	(1 << IEEE80211_RADIOTAP_CHANNEL));
345	hdr->rt_flags = 0;
346	hdr->rt_rate = txrate->bitrate / 5;
347	hdr->rt_channel = cpu_to_le16(data->channel->center_freq);
348	flags = IEEE80211_CHAN_2GHZ;
349	if (txrate->flags & IEEE80211_RATE_ERP_G)
350	flags \|= IEEE80211_CHAN_OFDM;
351	else
352	flags \|= IEEE80211_CHAN_CCK;
353	hdr->rt_chbitmask = cpu_to_le16(flags);
354
355	skb->dev = hwsim_mon;
356	skb_set_mac_header(skb, 0);
357	skb->ip_summed = CHECKSUM_UNNECESSARY;
358	skb->pkt_type = PACKET_OTHERHOST;
359	skb->protocol = htons(ETH_P_802_2);
360	memset(skb->cb, 0, sizeof(skb->cb));
361	netif_rx(skb);
362	}
363
364
365	static bool hwsim_ps_rx_ok(struct mac80211_hwsim_data *data,
366	struct sk_buff *skb)
367	{
368	switch (data->ps) {
369	case PS_DISABLED:
370	return true;
371	case PS_ENABLED:
372	return false;
373	case PS_AUTO_POLL:
374	/* TODO: accept (some) Beacons by default and other frames only
375	* if pending PS-Poll has been sent */
376	return true;
377	case PS_MANUAL_POLL:
378	/* Allow unicast frames to own address if there is a pending
379	* PS-Poll */
380	if (data->ps_poll_pending &&
381	memcmp(data->hw->wiphy->perm_addr, skb->data + 4,
382	ETH_ALEN) == 0) {
383	data->ps_poll_pending = false;
384	return true;
385	}
386	return false;
387	}
388
389	return true;
390	}
391
392
393	static bool mac80211_hwsim_tx_frame(struct ieee80211_hw *hw,
394	struct sk_buff *skb)
395	{
396	struct mac80211_hwsim_data data = hw->priv, data2;
397	bool ack = false;
398	struct ieee80211_hdr hdr = (struct ieee80211_hdr ) skb->data;
399	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
400	struct ieee80211_rx_status rx_status;
401
402	memset(&rx_status, 0, sizeof(rx_status));
403	/* TODO: set mactime */
404	rx_status.freq = data->channel->center_freq;
405	rx_status.band = data->channel->band;
406	rx_status.rate_idx = info->control.rates[0].idx;
407	/* TODO: simulate signal strength (and optional packet drop) */
408
409	if (data->ps != PS_DISABLED)
410	hdr->frame_control \|= cpu_to_le16(IEEE80211_FCTL_PM);
411
412	/* Copy skb to all enabled radios that are on the current frequency */
413	spin_lock(&hwsim_radio_lock);
414	list_for_each_entry(data2, &hwsim_radios, list) {
415	struct sk_buff *nskb;
416
417	if (data == data2)
418	continue;
419
420	if (!data2->started \|\| !hwsim_ps_rx_ok(data2, skb) \|\|
421	!data->channel \|\| !data2->channel \|\|
422	data->channel->center_freq != data2->channel->center_freq \|\|
423	!(data->group & data2->group))
424	continue;
425
426	nskb = skb_copy(skb, GFP_ATOMIC);
427	if (nskb == NULL)
428	continue;
429
430	if (memcmp(hdr->addr1, data2->hw->wiphy->perm_addr,
431	ETH_ALEN) == 0)
432	ack = true;
433	ieee80211_rx_irqsafe(data2->hw, nskb, &rx_status);
434	}
435	spin_unlock(&hwsim_radio_lock);
436
437	return ack;
438	}
439
440
441	static int mac80211_hwsim_tx(struct ieee80211_hw hw, struct sk_buff skb)
442	{
443	bool ack;
444	struct ieee80211_tx_info *txi;
445
446	mac80211_hwsim_monitor_rx(hw, skb);
447
448	if (skb->len < 10) {
449	/* Should not happen; just a sanity check for addr1 use */
450	dev_kfree_skb(skb);
451	return NETDEV_TX_OK;
452	}
453
454	ack = mac80211_hwsim_tx_frame(hw, skb);
455
456	txi = IEEE80211_SKB_CB(skb);
457
458	if (txi->control.vif)
459	hwsim_check_magic(txi->control.vif);
460	if (txi->control.sta)
461	hwsim_check_sta_magic(txi->control.sta);
462
463	ieee80211_tx_info_clear_status(txi);
464	if (!(txi->flags & IEEE80211_TX_CTL_NO_ACK) && ack)
465	txi->flags \|= IEEE80211_TX_STAT_ACK;
466	ieee80211_tx_status_irqsafe(hw, skb);
467	return NETDEV_TX_OK;
468	}
469
470
471	static int mac80211_hwsim_start(struct ieee80211_hw *hw)
472	{
473	struct mac80211_hwsim_data *data = hw->priv;
474	printk(KERN_DEBUG "%s:%s\n", wiphy_name(hw->wiphy), __func__);
475	data->started = 1;
476	return 0;
477	}
478
479
480	static void mac80211_hwsim_stop(struct ieee80211_hw *hw)
481	{
482	struct mac80211_hwsim_data *data = hw->priv;
483	data->started = 0;
484	del_timer(&data->beacon_timer);
485	printk(KERN_DEBUG "%s:%s\n", wiphy_name(hw->wiphy), __func__);
486	}
487
488
489	static int mac80211_hwsim_add_interface(struct ieee80211_hw *hw,
490	struct ieee80211_if_init_conf *conf)
491	{
492	printk(KERN_DEBUG "%s:%s (type=%d mac_addr=%pM)\n",
493	wiphy_name(hw->wiphy), __func__, conf->type,
494	conf->mac_addr);
495	hwsim_set_magic(conf->vif);
496	return 0;
497	}
498
499
500	static void mac80211_hwsim_remove_interface(
501	struct ieee80211_hw hw, struct ieee80211_if_init_conf conf)
502	{
503	printk(KERN_DEBUG "%s:%s (type=%d mac_addr=%pM)\n",
504	wiphy_name(hw->wiphy), __func__, conf->type,
505	conf->mac_addr);
506	hwsim_check_magic(conf->vif);
507	hwsim_clear_magic(conf->vif);
508	}
509
510
511	static void mac80211_hwsim_beacon_tx(void arg, u8 mac,
512	struct ieee80211_vif *vif)
513	{
514	struct ieee80211_hw *hw = arg;
515	struct sk_buff *skb;
516	struct ieee80211_tx_info *info;
517
518	hwsim_check_magic(vif);
519
520	if (vif->type != NL80211_IFTYPE_AP &&
521	vif->type != NL80211_IFTYPE_MESH_POINT)
522	return;
523
524	skb = ieee80211_beacon_get(hw, vif);
525	if (skb == NULL)
526	return;
527	info = IEEE80211_SKB_CB(skb);
528
529	mac80211_hwsim_monitor_rx(hw, skb);
530	mac80211_hwsim_tx_frame(hw, skb);
531	dev_kfree_skb(skb);
532	}
533
534
535	static void mac80211_hwsim_beacon(unsigned long arg)
536	{
537	struct ieee80211_hw hw = (struct ieee80211_hw ) arg;
538	struct mac80211_hwsim_data *data = hw->priv;
539
540	if (!data->started)
541	return;
542
543	ieee80211_iterate_active_interfaces_atomic(
544	hw, mac80211_hwsim_beacon_tx, hw);
545
546	data->beacon_timer.expires = jiffies + data->beacon_int;
547	add_timer(&data->beacon_timer);
548	}
549
550
551	static int mac80211_hwsim_config(struct ieee80211_hw *hw, u32 changed)
552	{
553	struct mac80211_hwsim_data *data = hw->priv;
554	struct ieee80211_conf *conf = &hw->conf;
555
556	printk(KERN_DEBUG "%s:%s (freq=%d idle=%d ps=%d)\n",
557	wiphy_name(hw->wiphy), __func__,
558	conf->channel->center_freq,
559	!!(conf->flags & IEEE80211_CONF_IDLE),
560	!!(conf->flags & IEEE80211_CONF_PS));
561
562	data->channel = conf->channel;
563	if (!data->started \|\| !data->beacon_int)
564	del_timer(&data->beacon_timer);
565	else
566	mod_timer(&data->beacon_timer, jiffies + data->beacon_int);
567
568	return 0;
569	}
570
571
572	static void mac80211_hwsim_configure_filter(struct ieee80211_hw *hw,
573	unsigned int changed_flags,
574	unsigned int *total_flags,
575	int mc_count,
576	struct dev_addr_list *mc_list)
577	{
578	struct mac80211_hwsim_data *data = hw->priv;
579
580	printk(KERN_DEBUG "%s:%s\n", wiphy_name(hw->wiphy), __func__);
581
582	data->rx_filter = 0;
583	if (*total_flags & FIF_PROMISC_IN_BSS)
584	data->rx_filter \|= FIF_PROMISC_IN_BSS;
585	if (*total_flags & FIF_ALLMULTI)
586	data->rx_filter \|= FIF_ALLMULTI;
587
588	*total_flags = data->rx_filter;
589	}
590
591	static void mac80211_hwsim_bss_info_changed(struct ieee80211_hw *hw,
592	struct ieee80211_vif *vif,
593	struct ieee80211_bss_conf *info,
594	u32 changed)
595	{
596	struct hwsim_vif_priv vp = (void )vif->drv_priv;
597	struct mac80211_hwsim_data *data = hw->priv;
598
599	hwsim_check_magic(vif);
600
601	printk(KERN_DEBUG "%s:%s(changed=0x%x)\n",
602	wiphy_name(hw->wiphy), __func__, changed);
603
604	if (changed & BSS_CHANGED_BSSID) {
605	printk(KERN_DEBUG "%s:%s: BSSID changed: %pM\n",
606	wiphy_name(hw->wiphy), __func__,
607	info->bssid);
608	memcpy(vp->bssid, info->bssid, ETH_ALEN);
609	}
610
611	if (changed & BSS_CHANGED_ASSOC) {
612	printk(KERN_DEBUG " %s: ASSOC: assoc=%d aid=%d\n",
613	wiphy_name(hw->wiphy), info->assoc, info->aid);
614	vp->assoc = info->assoc;
615	vp->aid = info->aid;
616	}
617
618	if (changed & BSS_CHANGED_BEACON_INT) {
619	printk(KERN_DEBUG " %s: BCNINT: %d\n",
620	wiphy_name(hw->wiphy), info->beacon_int);
621	data->beacon_int = 1024 * info->beacon_int / 1000 * HZ / 1000;
622	if (WARN_ON(!data->beacon_int))
623	data->beacon_int = 1;
624	}
625
626	if (changed & BSS_CHANGED_ERP_CTS_PROT) {
627	printk(KERN_DEBUG " %s: ERP_CTS_PROT: %d\n",
628	wiphy_name(hw->wiphy), info->use_cts_prot);
629	}
630
631	if (changed & BSS_CHANGED_ERP_PREAMBLE) {
632	printk(KERN_DEBUG " %s: ERP_PREAMBLE: %d\n",
633	wiphy_name(hw->wiphy), info->use_short_preamble);
634	}
635
636	if (changed & BSS_CHANGED_ERP_SLOT) {
637	printk(KERN_DEBUG " %s: ERP_SLOT: %d\n",
638	wiphy_name(hw->wiphy), info->use_short_slot);
639	}
640
641	if (changed & BSS_CHANGED_HT) {
642	printk(KERN_DEBUG " %s: HT: op_mode=0x%x\n",
643	wiphy_name(hw->wiphy),
644	info->ht_operation_mode);
645	}
646
647	if (changed & BSS_CHANGED_BASIC_RATES) {
648	printk(KERN_DEBUG " %s: BASIC_RATES: 0x%llx\n",
649	wiphy_name(hw->wiphy),
650	(unsigned long long) info->basic_rates);
651	}
652	}
653
654	static void mac80211_hwsim_sta_notify(struct ieee80211_hw *hw,
655	struct ieee80211_vif *vif,
656	enum sta_notify_cmd cmd,
657	struct ieee80211_sta *sta)
658	{
659	hwsim_check_magic(vif);
660	switch (cmd) {
661	case STA_NOTIFY_ADD:
662	hwsim_set_sta_magic(sta);
663	break;
664	case STA_NOTIFY_REMOVE:
665	hwsim_clear_sta_magic(sta);
666	break;
667	case STA_NOTIFY_SLEEP:
668	case STA_NOTIFY_AWAKE:
669	/* TODO: make good use of these flags */
670	break;
671	}
672	}
673
674	static int mac80211_hwsim_set_tim(struct ieee80211_hw *hw,
675	struct ieee80211_sta *sta,
676	bool set)
677	{
678	hwsim_check_sta_magic(sta);
679	return 0;
680	}
681
682	static int mac80211_hwsim_conf_tx(
683	struct ieee80211_hw *hw, u16 queue,
684	const struct ieee80211_tx_queue_params *params)
685	{
686	printk(KERN_DEBUG "%s:%s (queue=%d txop=%d cw_min=%d cw_max=%d "
687	"aifs=%d)\n",
688	wiphy_name(hw->wiphy), __func__, queue,
689	params->txop, params->cw_min, params->cw_max, params->aifs);
690	return 0;
691	}
692
693	static const struct ieee80211_ops mac80211_hwsim_ops =
694	{
695	.tx = mac80211_hwsim_tx,
696	.start = mac80211_hwsim_start,
697	.stop = mac80211_hwsim_stop,
698	.add_interface = mac80211_hwsim_add_interface,
699	.remove_interface = mac80211_hwsim_remove_interface,
700	.config = mac80211_hwsim_config,
701	.configure_filter = mac80211_hwsim_configure_filter,
702	.bss_info_changed = mac80211_hwsim_bss_info_changed,
703	.sta_notify = mac80211_hwsim_sta_notify,
704	.set_tim = mac80211_hwsim_set_tim,
705	.conf_tx = mac80211_hwsim_conf_tx,
706	};
707
708
709	static void mac80211_hwsim_free(void)
710	{
711	struct list_head tmplist, i, tmp;
712	struct mac80211_hwsim_data data, tmpdata;
713
714	INIT_LIST_HEAD(&tmplist);
715
716	spin_lock_bh(&hwsim_radio_lock);
717	list_for_each_safe(i, tmp, &hwsim_radios)
718	list_move(i, &tmplist);
719	spin_unlock_bh(&hwsim_radio_lock);
720
721	list_for_each_entry_safe(data, tmpdata, &tmplist, list) {
722	debugfs_remove(data->debugfs_group);
723	debugfs_remove(data->debugfs_ps);
724	debugfs_remove(data->debugfs);
725	ieee80211_unregister_hw(data->hw);
726	device_unregister(data->dev);
727	ieee80211_free_hw(data->hw);
728	}
729	class_destroy(hwsim_class);
730	}
731
732
733	static struct device_driver mac80211_hwsim_driver = {
734	.name = "mac80211_hwsim"
735	};
736
737	static const struct net_device_ops hwsim_netdev_ops = {
738	.ndo_start_xmit = hwsim_mon_xmit,
739	.ndo_change_mtu = eth_change_mtu,
740	.ndo_set_mac_address = eth_mac_addr,
741	.ndo_validate_addr = eth_validate_addr,
742	};
743
744	static void hwsim_mon_setup(struct net_device *dev)
745	{
746	dev->netdev_ops = &hwsim_netdev_ops;
747	dev->destructor = free_netdev;
748	ether_setup(dev);
749	dev->tx_queue_len = 0;
750	dev->type = ARPHRD_IEEE80211_RADIOTAP;
751	memset(dev->dev_addr, 0, ETH_ALEN);
752	dev->dev_addr[0] = 0x12;
753	}
754
755
756	static void hwsim_send_ps_poll(void dat, u8 mac, struct ieee80211_vif *vif)
757	{
758	struct mac80211_hwsim_data *data = dat;
759	struct hwsim_vif_priv vp = (void )vif->drv_priv;
760	DECLARE_MAC_BUF(buf);
761	struct sk_buff *skb;
762	struct ieee80211_pspoll *pspoll;
763
764	if (!vp->assoc)
765	return;
766
767	printk(KERN_DEBUG "%s:%s: send PS-Poll to %pM for aid %d\n",
768	wiphy_name(data->hw->wiphy), __func__, vp->bssid, vp->aid);
769
770	skb = dev_alloc_skb(sizeof(*pspoll));
771	if (!skb)
772	return;
773	pspoll = (void ) skb_put(skb, sizeof(pspoll));
774	pspoll->frame_control = cpu_to_le16(IEEE80211_FTYPE_CTL \|
775	IEEE80211_STYPE_PSPOLL \|
776	IEEE80211_FCTL_PM);
777	pspoll->aid = cpu_to_le16(0xc000 \| vp->aid);
778	memcpy(pspoll->bssid, vp->bssid, ETH_ALEN);
779	memcpy(pspoll->ta, mac, ETH_ALEN);
780	if (!mac80211_hwsim_tx_frame(data->hw, skb))
781	printk(KERN_DEBUG "%s: PS-Poll frame not ack'ed\n", __func__);
782	dev_kfree_skb(skb);
783	}
784
785
786	static void hwsim_send_nullfunc(struct mac80211_hwsim_data data, u8 mac,
787	struct ieee80211_vif *vif, int ps)
788	{
789	struct hwsim_vif_priv vp = (void )vif->drv_priv;
790	DECLARE_MAC_BUF(buf);
791	struct sk_buff *skb;
792	struct ieee80211_hdr *hdr;
793
794	if (!vp->assoc)
795	return;
796
797	printk(KERN_DEBUG "%s:%s: send data::nullfunc to %pM ps=%d\n",
798	wiphy_name(data->hw->wiphy), __func__, vp->bssid, ps);
799
800	skb = dev_alloc_skb(sizeof(*hdr));
801	if (!skb)
802	return;
803	hdr = (void ) skb_put(skb, sizeof(hdr) - ETH_ALEN);
804	hdr->frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA \|
805	IEEE80211_STYPE_NULLFUNC \|
806	(ps ? IEEE80211_FCTL_PM : 0));
807	hdr->duration_id = cpu_to_le16(0);
808	memcpy(hdr->addr1, vp->bssid, ETH_ALEN);
809	memcpy(hdr->addr2, mac, ETH_ALEN);
810	memcpy(hdr->addr3, vp->bssid, ETH_ALEN);
811	if (!mac80211_hwsim_tx_frame(data->hw, skb))
812	printk(KERN_DEBUG "%s: nullfunc frame not ack'ed\n", __func__);
813	dev_kfree_skb(skb);
814	}
815
816
817	static void hwsim_send_nullfunc_ps(void dat, u8 mac,
818	struct ieee80211_vif *vif)
819	{
820	struct mac80211_hwsim_data *data = dat;
821	hwsim_send_nullfunc(data, mac, vif, 1);
822	}
823
824
825	static void hwsim_send_nullfunc_no_ps(void dat, u8 mac,
826	struct ieee80211_vif *vif)
827	{
828	struct mac80211_hwsim_data *data = dat;
829	hwsim_send_nullfunc(data, mac, vif, 0);
830	}
831
832
833	static int hwsim_fops_ps_read(void dat, u64 val)
834	{
835	struct mac80211_hwsim_data *data = dat;
836	*val = data->ps;
837	return 0;
838	}
839
840	static int hwsim_fops_ps_write(void *dat, u64 val)
841	{
842	struct mac80211_hwsim_data *data = dat;
843	enum ps_mode old_ps;
844
845	if (val != PS_DISABLED && val != PS_ENABLED && val != PS_AUTO_POLL &&
846	val != PS_MANUAL_POLL)
847	return -EINVAL;
848
849	old_ps = data->ps;
850	data->ps = val;
851
852	if (val == PS_MANUAL_POLL) {
853	ieee80211_iterate_active_interfaces(data->hw,
854	hwsim_send_ps_poll, data);
855	data->ps_poll_pending = true;
856	} else if (old_ps == PS_DISABLED && val != PS_DISABLED) {
857	ieee80211_iterate_active_interfaces(data->hw,
858	hwsim_send_nullfunc_ps,
859	data);
860	} else if (old_ps != PS_DISABLED && val == PS_DISABLED) {
861	ieee80211_iterate_active_interfaces(data->hw,
862	hwsim_send_nullfunc_no_ps,
863	data);
864	}
865
866	return 0;
867	}
868
869	DEFINE_SIMPLE_ATTRIBUTE(hwsim_fops_ps, hwsim_fops_ps_read, hwsim_fops_ps_write,
870	"%llu\n");
871
872
873	static int hwsim_fops_group_read(void dat, u64 val)
874	{
875	struct mac80211_hwsim_data *data = dat;
876	*val = data->group;
877	return 0;
878	}
879
880	static int hwsim_fops_group_write(void *dat, u64 val)
881	{
882	struct mac80211_hwsim_data *data = dat;
883	data->group = val;
884	return 0;
885	}
886
887	DEFINE_SIMPLE_ATTRIBUTE(hwsim_fops_group,
888	hwsim_fops_group_read, hwsim_fops_group_write,
889	"%llx\n");
890
891	static int __init init_mac80211_hwsim(void)
892	{
893	int i, err = 0;
894	u8 addr[ETH_ALEN];
895	struct mac80211_hwsim_data *data;
896	struct ieee80211_hw *hw;
897	enum ieee80211_band band;
898
899	if (radios < 1 \|\| radios > 100)
900	return -EINVAL;
901
902	spin_lock_init(&hwsim_radio_lock);
903	INIT_LIST_HEAD(&hwsim_radios);
904
905	hwsim_class = class_create(THIS_MODULE, "mac80211_hwsim");
906	if (IS_ERR(hwsim_class))
907	return PTR_ERR(hwsim_class);
908
909	memset(addr, 0, ETH_ALEN);
910	addr[0] = 0x02;
911
912	for (i = 0; i < radios; i++) {
913	printk(KERN_DEBUG "mac80211_hwsim: Initializing radio %d\n",
914	i);
915	hw = ieee80211_alloc_hw(sizeof(*data), &mac80211_hwsim_ops);
916	if (!hw) {
917	printk(KERN_DEBUG "mac80211_hwsim: ieee80211_alloc_hw "
918	"failed\n");
919	err = -ENOMEM;
920	goto failed;
921	}
922	data = hw->priv;
923	data->hw = hw;
924
925	data->dev = device_create(hwsim_class, NULL, 0, hw,
926	"hwsim%d", i);
927	if (IS_ERR(data->dev)) {
928	printk(KERN_DEBUG
929	"mac80211_hwsim: device_create "
930	"failed (%ld)\n", PTR_ERR(data->dev));
931	err = -ENOMEM;
932	goto failed_drvdata;
933	}
934	data->dev->driver = &mac80211_hwsim_driver;
935
936	SET_IEEE80211_DEV(hw, data->dev);
937	addr[3] = i >> 8;
938	addr[4] = i;
939	SET_IEEE80211_PERM_ADDR(hw, addr);
940
941	hw->channel_change_time = 1;
942	hw->queues = 4;
943	hw->wiphy->interface_modes =
944	BIT(NL80211_IFTYPE_STATION) \|
945	BIT(NL80211_IFTYPE_AP) \|
946	BIT(NL80211_IFTYPE_MESH_POINT);
947
948	hw->flags = IEEE80211_HW_MFP_CAPABLE;
949
950	/* ask mac80211 to reserve space for magic */
951	hw->vif_data_size = sizeof(struct hwsim_vif_priv);
952	hw->sta_data_size = sizeof(struct hwsim_sta_priv);
953
954	memcpy(data->channels_2ghz, hwsim_channels_2ghz,
955	sizeof(hwsim_channels_2ghz));
956	memcpy(data->channels_5ghz, hwsim_channels_5ghz,
957	sizeof(hwsim_channels_5ghz));
958	memcpy(data->rates, hwsim_rates, sizeof(hwsim_rates));
959
960	for (band = IEEE80211_BAND_2GHZ; band < IEEE80211_NUM_BANDS; band++) {
961	struct ieee80211_supported_band *sband = &data->bands[band];
962	switch (band) {
963	case IEEE80211_BAND_2GHZ:
964	sband->channels = data->channels_2ghz;
965	sband->n_channels =
966	ARRAY_SIZE(hwsim_channels_2ghz);
967	break;
968	case IEEE80211_BAND_5GHZ:
969	sband->channels = data->channels_5ghz;
970	sband->n_channels =
971	ARRAY_SIZE(hwsim_channels_5ghz);
972	break;
973	default:
974	break;
975	}
976
977	sband->bitrates = data->rates;
978	sband->n_bitrates = ARRAY_SIZE(hwsim_rates);
979
980	sband->ht_cap.ht_supported = true;
981	sband->ht_cap.cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 \|
982	IEEE80211_HT_CAP_GRN_FLD \|
983	IEEE80211_HT_CAP_SGI_40 \|
984	IEEE80211_HT_CAP_DSSSCCK40;
985	sband->ht_cap.ampdu_factor = 0x3;
986	sband->ht_cap.ampdu_density = 0x6;
987	memset(&sband->ht_cap.mcs, 0,
988	sizeof(sband->ht_cap.mcs));
989	sband->ht_cap.mcs.rx_mask[0] = 0xff;
990	sband->ht_cap.mcs.rx_mask[1] = 0xff;
991	sband->ht_cap.mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
992
993	hw->wiphy->bands[band] = sband;
994	}
995	/* By default all radios are belonging to the first group */
996	data->group = 1;
997
998	/* Work to be done prior to ieee80211_register_hw() */
999	switch (regtest) {
1000	case HWSIM_REGTEST_DISABLED:
1001	case HWSIM_REGTEST_DRIVER_REG_FOLLOW:
1002	case HWSIM_REGTEST_DRIVER_REG_ALL:
1003	case HWSIM_REGTEST_DIFF_COUNTRY:
1004	/*
1005	* Nothing to be done for driver regulatory domain
1006	* hints prior to ieee80211_register_hw()
1007	*/
1008	break;
1009	case HWSIM_REGTEST_WORLD_ROAM:
1010	if (i == 0) {
1011	hw->wiphy->custom_regulatory = true;
1012	wiphy_apply_custom_regulatory(hw->wiphy,
1013	&hwsim_world_regdom_custom_01);
1014	}
1015	break;
1016	case HWSIM_REGTEST_CUSTOM_WORLD:
1017	hw->wiphy->custom_regulatory = true;
1018	wiphy_apply_custom_regulatory(hw->wiphy,
1019	&hwsim_world_regdom_custom_01);
1020	break;
1021	case HWSIM_REGTEST_CUSTOM_WORLD_2:
1022	if (i == 0) {
1023	hw->wiphy->custom_regulatory = true;
1024	wiphy_apply_custom_regulatory(hw->wiphy,
1025	&hwsim_world_regdom_custom_01);
1026	} else if (i == 1) {
1027	hw->wiphy->custom_regulatory = true;
1028	wiphy_apply_custom_regulatory(hw->wiphy,
1029	&hwsim_world_regdom_custom_02);
1030	}
1031	break;
1032	case HWSIM_REGTEST_STRICT_ALL:
1033	hw->wiphy->strict_regulatory = true;
1034	break;
1035	case HWSIM_REGTEST_STRICT_FOLLOW:
1036	case HWSIM_REGTEST_STRICT_AND_DRIVER_REG:
1037	if (i == 0)
1038	hw->wiphy->strict_regulatory = true;
1039	break;
1040	case HWSIM_REGTEST_ALL:
1041	if (i == 0) {
1042	hw->wiphy->custom_regulatory = true;
1043	wiphy_apply_custom_regulatory(hw->wiphy,
1044	&hwsim_world_regdom_custom_01);
1045	} else if (i == 1) {
1046	hw->wiphy->custom_regulatory = true;
1047	wiphy_apply_custom_regulatory(hw->wiphy,
1048	&hwsim_world_regdom_custom_02);
1049	} else if (i == 4)
1050	hw->wiphy->strict_regulatory = true;
1051	break;
1052	default:
1053	break;
1054	}
1055
1056	/* give the regulatory workqueue a chance to run */
1057	if (regtest)
1058	schedule_timeout_interruptible(1);
1059	err = ieee80211_register_hw(hw);
1060	if (err < 0) {
1061	printk(KERN_DEBUG "mac80211_hwsim: "
1062	"ieee80211_register_hw failed (%d)\n", err);
1063	goto failed_hw;
1064	}
1065
1066	/* Work to be done after to ieee80211_register_hw() */
1067	switch (regtest) {
1068	case HWSIM_REGTEST_WORLD_ROAM:
1069	case HWSIM_REGTEST_DISABLED:
1070	break;
1071	case HWSIM_REGTEST_DRIVER_REG_FOLLOW:
1072	if (!i)
1073	regulatory_hint(hw->wiphy, hwsim_alpha2s[0]);
1074	break;
1075	case HWSIM_REGTEST_DRIVER_REG_ALL:
1076	case HWSIM_REGTEST_STRICT_ALL:
1077	regulatory_hint(hw->wiphy, hwsim_alpha2s[0]);
1078	break;
1079	case HWSIM_REGTEST_DIFF_COUNTRY:
1080	if (i < ARRAY_SIZE(hwsim_alpha2s))
1081	regulatory_hint(hw->wiphy, hwsim_alpha2s[i]);
1082	break;
1083	case HWSIM_REGTEST_CUSTOM_WORLD:
1084	case HWSIM_REGTEST_CUSTOM_WORLD_2:
1085	/*
1086	* Nothing to be done for custom world regulatory
1087	* domains after to ieee80211_register_hw
1088	*/
1089	break;
1090	case HWSIM_REGTEST_STRICT_FOLLOW:
1091	if (i == 0)
1092	regulatory_hint(hw->wiphy, hwsim_alpha2s[0]);
1093	break;
1094	case HWSIM_REGTEST_STRICT_AND_DRIVER_REG:
1095	if (i == 0)
1096	regulatory_hint(hw->wiphy, hwsim_alpha2s[0]);
1097	else if (i == 1)
1098	regulatory_hint(hw->wiphy, hwsim_alpha2s[1]);
1099	break;
1100	case HWSIM_REGTEST_ALL:
1101	if (i == 2)
1102	regulatory_hint(hw->wiphy, hwsim_alpha2s[0]);
1103	else if (i == 3)
1104	regulatory_hint(hw->wiphy, hwsim_alpha2s[1]);
1105	else if (i == 4)
1106	regulatory_hint(hw->wiphy, hwsim_alpha2s[2]);
1107	break;
1108	default:
1109	break;
1110	}
1111
1112	printk(KERN_DEBUG "%s: hwaddr %pM registered\n",
1113	wiphy_name(hw->wiphy),
1114	hw->wiphy->perm_addr);
1115
1116	data->debugfs = debugfs_create_dir("hwsim",
1117	hw->wiphy->debugfsdir);
1118	data->debugfs_ps = debugfs_create_file("ps", 0666,
1119	data->debugfs, data,
1120	&hwsim_fops_ps);
1121	data->debugfs_group = debugfs_create_file("group", 0666,
1122	data->debugfs, data,
1123	&hwsim_fops_group);
1124
1125	setup_timer(&data->beacon_timer, mac80211_hwsim_beacon,
1126	(unsigned long) hw);
1127
1128	list_add_tail(&data->list, &hwsim_radios);
1129	}
1130
1131	hwsim_mon = alloc_netdev(0, "hwsim%d", hwsim_mon_setup);
1132	if (hwsim_mon == NULL)
1133	goto failed;
1134
1135	rtnl_lock();
1136
1137	err = dev_alloc_name(hwsim_mon, hwsim_mon->name);
1138	if (err < 0)
1139	goto failed_mon;
1140
1141
1142	err = register_netdevice(hwsim_mon);
1143	if (err < 0)
1144	goto failed_mon;
1145
1146	rtnl_unlock();
1147
1148	return 0;
1149
1150	failed_mon:
1151	rtnl_unlock();
1152	free_netdev(hwsim_mon);
1153	mac80211_hwsim_free();
1154	return err;
1155
1156	failed_hw:
1157	device_unregister(data->dev);
1158	failed_drvdata:
1159	ieee80211_free_hw(hw);
1160	failed:
1161	mac80211_hwsim_free();
1162	return err;
1163	}
1164
1165
1166	static void __exit exit_mac80211_hwsim(void)
1167	{
1168	printk(KERN_DEBUG "mac80211_hwsim: unregister radios\n");
1169
1170	mac80211_hwsim_free();
1171	unregister_netdev(hwsim_mon);
1172	}
1173
1174
1175	module_init(init_mac80211_hwsim);
1176	module_exit(exit_mac80211_hwsim);
1177

Download this file

Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.2
jz-3.3
jz-3.4
jz47xx
jz47xx-2.6.38
master
xiangfu/openwrt/v3.0.0
xiangfu/openwrt/v3.2.1

Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7

Kernel

Kernel Git Source Tree

Root/drivers/net/wireless/mac80211_hwsim.c

interactive