1/*-
2 * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
3 * Copyright (c) 2004-2005 Atheros Communications, Inc.
4 * Copyright (c) 2006 Devicescape Software, Inc.
5 * Copyright (c) 2007 Jiri Slaby <jirislaby@gmail.com>
6 * Copyright (c) 2007 Luis R. Rodriguez <mcgrof@winlab.rutgers.edu>
7 * Copyright (c) 2010 Bruno Randolf <br1@einfach.org>
8 *
9 * All rights reserved.
10 *
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
13 * are met:
14 * 1. Redistributions of source code must retain the above copyright
15 *    notice, this list of conditions and the following disclaimer,
16 *    without modification.
17 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
18 *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
19 *    redistribution must be conditioned upon including a substantially
20 *    similar Disclaimer requirement for further binary redistribution.
21 * 3. Neither the names of the above-listed copyright holders nor the names
22 *    of any contributors may be used to endorse or promote products derived
23 *    from this software without specific prior written permission.
24 *
25 * Alternatively, this software may be distributed under the terms of the
26 * GNU General Public License ("GPL") version 2 as published by the Free
27 * Software Foundation.
28 *
29 * NO WARRANTY
30 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
31 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
32 * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
33 * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
34 * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
35 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
36 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
37 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
38 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
39 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
40 * THE POSSIBILITY OF SUCH DAMAGES.
41 *
42 */
43
44#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
45
46#include <net/mac80211.h>
47#include <asm/unaligned.h>
48
49#include "ath5k.h"
50#include "base.h"
51#include "reg.h"
52
53/********************\
54* Mac80211 functions *
55\********************/
56
57static void
58ath5k_tx(struct ieee80211_hw *hw, struct ieee80211_tx_control *control,
59	 struct sk_buff *skb)
60{
61	struct ath5k_hw *ah = hw->priv;
62	u16 qnum = skb_get_queue_mapping(skb);
63
64	if (WARN_ON(qnum >= ah->ah_capabilities.cap_queues.q_tx_num)) {
65		ieee80211_free_txskb(hw, skb);
66		return;
67	}
68
69	ath5k_tx_queue(hw, skb, &ah->txqs[qnum], control);
70}
71
72
73static int
74ath5k_add_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
75{
76	struct ath5k_hw *ah = hw->priv;
77	int ret;
78	struct ath5k_vif *avf = (void *)vif->drv_priv;
79
80	mutex_lock(&ah->lock);
81
82	if ((vif->type == NL80211_IFTYPE_AP ||
83	     vif->type == NL80211_IFTYPE_ADHOC)
84	    && (ah->num_ap_vifs + ah->num_adhoc_vifs) >= ATH_BCBUF) {
85		ret = -ELNRNG;
86		goto end;
87	}
88
89	/* Don't allow other interfaces if one ad-hoc is configured.
90	 * TODO: Fix the problems with ad-hoc and multiple other interfaces.
91	 * We would need to operate the HW in ad-hoc mode to allow TSF updates
92	 * for the IBSS, but this breaks with additional AP or STA interfaces
93	 * at the moment. */
94	if (ah->num_adhoc_vifs ||
95	    (ah->nvifs && vif->type == NL80211_IFTYPE_ADHOC)) {
96		ATH5K_ERR(ah, "Only one single ad-hoc interface is allowed.\n");
97		ret = -ELNRNG;
98		goto end;
99	}
100
101	switch (vif->type) {
102	case NL80211_IFTYPE_AP:
103	case NL80211_IFTYPE_STATION:
104	case NL80211_IFTYPE_ADHOC:
105	case NL80211_IFTYPE_MESH_POINT:
106		avf->opmode = vif->type;
107		break;
108	default:
109		ret = -EOPNOTSUPP;
110		goto end;
111	}
112
113	ah->nvifs++;
114	ATH5K_DBG(ah, ATH5K_DEBUG_MODE, "add interface mode %d\n", avf->opmode);
115
116	/* Assign the vap/adhoc to a beacon xmit slot. */
117	if ((avf->opmode == NL80211_IFTYPE_AP) ||
118	    (avf->opmode == NL80211_IFTYPE_ADHOC) ||
119	    (avf->opmode == NL80211_IFTYPE_MESH_POINT)) {
120		int slot;
121
122		WARN_ON(list_empty(&ah->bcbuf));
123		avf->bbuf = list_first_entry(&ah->bcbuf, struct ath5k_buf,
124					     list);
125		list_del(&avf->bbuf->list);
126
127		avf->bslot = 0;
128		for (slot = 0; slot < ATH_BCBUF; slot++) {
129			if (!ah->bslot[slot]) {
130				avf->bslot = slot;
131				break;
132			}
133		}
134		BUG_ON(ah->bslot[avf->bslot] != NULL);
135		ah->bslot[avf->bslot] = vif;
136		if (avf->opmode == NL80211_IFTYPE_AP)
137			ah->num_ap_vifs++;
138		else if (avf->opmode == NL80211_IFTYPE_ADHOC)
139			ah->num_adhoc_vifs++;
140		else if (avf->opmode == NL80211_IFTYPE_MESH_POINT)
141			ah->num_mesh_vifs++;
142	}
143
144	/* Any MAC address is fine, all others are included through the
145	 * filter.
146	 */
147	ath5k_hw_set_lladdr(ah, vif->addr);
148
149	ath5k_update_bssid_mask_and_opmode(ah, vif);
150	ret = 0;
151end:
152	mutex_unlock(&ah->lock);
153	return ret;
154}
155
156
157static void
158ath5k_remove_interface(struct ieee80211_hw *hw,
159		       struct ieee80211_vif *vif)
160{
161	struct ath5k_hw *ah = hw->priv;
162	struct ath5k_vif *avf = (void *)vif->drv_priv;
163	unsigned int i;
164
165	mutex_lock(&ah->lock);
166	ah->nvifs--;
167
168	if (avf->bbuf) {
169		ath5k_txbuf_free_skb(ah, avf->bbuf);
170		list_add_tail(&avf->bbuf->list, &ah->bcbuf);
171		for (i = 0; i < ATH_BCBUF; i++) {
172			if (ah->bslot[i] == vif) {
173				ah->bslot[i] = NULL;
174				break;
175			}
176		}
177		avf->bbuf = NULL;
178	}
179	if (avf->opmode == NL80211_IFTYPE_AP)
180		ah->num_ap_vifs--;
181	else if (avf->opmode == NL80211_IFTYPE_ADHOC)
182		ah->num_adhoc_vifs--;
183	else if (avf->opmode == NL80211_IFTYPE_MESH_POINT)
184		ah->num_mesh_vifs--;
185
186	ath5k_update_bssid_mask_and_opmode(ah, NULL);
187	mutex_unlock(&ah->lock);
188}
189
190
191/*
192 * TODO: Phy disable/diversity etc
193 */
194static int
195ath5k_config(struct ieee80211_hw *hw, u32 changed)
196{
197	struct ath5k_hw *ah = hw->priv;
198	struct ieee80211_conf *conf = &hw->conf;
199	int ret = 0;
200	int i;
201
202	mutex_lock(&ah->lock);
203
204	if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
205		ret = ath5k_chan_set(ah, &conf->chandef);
206		if (ret < 0)
207			goto unlock;
208	}
209
210	if ((changed & IEEE80211_CONF_CHANGE_POWER) &&
211	(ah->ah_txpower.txp_requested != conf->power_level)) {
212		ah->ah_txpower.txp_requested = conf->power_level;
213
214		/* Half dB steps */
215		ath5k_hw_set_txpower_limit(ah, (conf->power_level * 2));
216	}
217
218	if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) {
219		ah->ah_retry_long = conf->long_frame_max_tx_count;
220		ah->ah_retry_short = conf->short_frame_max_tx_count;
221
222		for (i = 0; i < ah->ah_capabilities.cap_queues.q_tx_num; i++)
223			ath5k_hw_set_tx_retry_limits(ah, i);
224	}
225
226	/* TODO:
227	 * 1) Move this on config_interface and handle each case
228	 * separately eg. when we have only one STA vif, use
229	 * AR5K_ANTMODE_SINGLE_AP
230	 *
231	 * 2) Allow the user to change antenna mode eg. when only
232	 * one antenna is present
233	 *
234	 * 3) Allow the user to set default/tx antenna when possible
235	 *
236	 * 4) Default mode should handle 90% of the cases, together
237	 * with fixed a/b and single AP modes we should be able to
238	 * handle 99%. Sectored modes are extreme cases and i still
239	 * haven't found a usage for them. If we decide to support them,
240	 * then we must allow the user to set how many tx antennas we
241	 * have available
242	 */
243	ath5k_hw_set_antenna_mode(ah, ah->ah_ant_mode);
244
245unlock:
246	mutex_unlock(&ah->lock);
247	return ret;
248}
249
250
251static void
252ath5k_bss_info_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
253		       struct ieee80211_bss_conf *bss_conf, u32 changes)
254{
255	struct ath5k_vif *avf = (void *)vif->drv_priv;
256	struct ath5k_hw *ah = hw->priv;
257	struct ath_common *common = ath5k_hw_common(ah);
258
259	mutex_lock(&ah->lock);
260
261	if (changes & BSS_CHANGED_BSSID) {
262		/* Cache for later use during resets */
263		memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
264		common->curaid = 0;
265		ath5k_hw_set_bssid(ah);
266		mmiowb();
267	}
268
269	if (changes & BSS_CHANGED_BEACON_INT)
270		ah->bintval = bss_conf->beacon_int;
271
272	if (changes & BSS_CHANGED_ERP_SLOT) {
273		int slot_time;
274
275		ah->ah_short_slot = bss_conf->use_short_slot;
276		slot_time = ath5k_hw_get_default_slottime(ah) +
277			    3 * ah->ah_coverage_class;
278		ath5k_hw_set_ifs_intervals(ah, slot_time);
279	}
280
281	if (changes & BSS_CHANGED_ASSOC) {
282		avf->assoc = bss_conf->assoc;
283		if (bss_conf->assoc)
284			ah->assoc = bss_conf->assoc;
285		else
286			ah->assoc = ath5k_any_vif_assoc(ah);
287
288		if (ah->opmode == NL80211_IFTYPE_STATION)
289			ath5k_set_beacon_filter(hw, ah->assoc);
290		ath5k_hw_set_ledstate(ah, ah->assoc ?
291			AR5K_LED_ASSOC : AR5K_LED_INIT);
292		if (bss_conf->assoc) {
293			ATH5K_DBG(ah, ATH5K_DEBUG_ANY,
294				  "Bss Info ASSOC %d, bssid: %pM\n",
295				  bss_conf->aid, common->curbssid);
296			common->curaid = bss_conf->aid;
297			ath5k_hw_set_bssid(ah);
298			/* Once ANI is available you would start it here */
299		}
300	}
301
302	if (changes & BSS_CHANGED_BEACON) {
303		spin_lock_bh(&ah->block);
304		ath5k_beacon_update(hw, vif);
305		spin_unlock_bh(&ah->block);
306	}
307
308	if (changes & BSS_CHANGED_BEACON_ENABLED)
309		ah->enable_beacon = bss_conf->enable_beacon;
310
311	if (changes & (BSS_CHANGED_BEACON | BSS_CHANGED_BEACON_ENABLED |
312		       BSS_CHANGED_BEACON_INT))
313		ath5k_beacon_config(ah);
314
315	mutex_unlock(&ah->lock);
316}
317
318
319static u64
320ath5k_prepare_multicast(struct ieee80211_hw *hw,
321			struct netdev_hw_addr_list *mc_list)
322{
323	u32 mfilt[2], val;
324	u8 pos;
325	struct netdev_hw_addr *ha;
326
327	mfilt[0] = 0;
328	mfilt[1] = 0;
329
330	netdev_hw_addr_list_for_each(ha, mc_list) {
331		/* calculate XOR of eight 6-bit values */
332		val = get_unaligned_le32(ha->addr + 0);
333		pos = (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
334		val = get_unaligned_le32(ha->addr + 3);
335		pos ^= (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
336		pos &= 0x3f;
337		mfilt[pos / 32] |= (1 << (pos % 32));
338		/* XXX: we might be able to just do this instead,
339		* but not sure, needs testing, if we do use this we'd
340		* need to inform below not to reset the mcast */
341		/* ath5k_hw_set_mcast_filterindex(ah,
342		 *      ha->addr[5]); */
343	}
344
345	return ((u64)(mfilt[1]) << 32) | mfilt[0];
346}
347
348
349/*
350 * o always accept unicast, broadcast, and multicast traffic
351 * o multicast traffic for all BSSIDs will be enabled if mac80211
352 *   says it should be
353 * o maintain current state of phy ofdm or phy cck error reception.
354 *   If the hardware detects any of these type of errors then
355 *   ath5k_hw_get_rx_filter() will pass to us the respective
356 *   hardware filters to be able to receive these type of frames.
357 * o probe request frames are accepted only when operating in
358 *   hostap, adhoc, or monitor modes
359 * o enable promiscuous mode according to the interface state
360 * o accept beacons:
361 *   - when operating in adhoc mode so the 802.11 layer creates
362 *     node table entries for peers,
363 *   - when operating in station mode for collecting rssi data when
364 *     the station is otherwise quiet, or
365 *   - when scanning
366 */
367static void
368ath5k_configure_filter(struct ieee80211_hw *hw, unsigned int changed_flags,
369		       unsigned int *new_flags, u64 multicast)
370{
371#define SUPPORTED_FIF_FLAGS \
372	(FIF_PROMISC_IN_BSS |  FIF_ALLMULTI | FIF_FCSFAIL | \
373	FIF_PLCPFAIL | FIF_CONTROL | FIF_OTHER_BSS | \
374	FIF_BCN_PRBRESP_PROMISC)
375
376	struct ath5k_hw *ah = hw->priv;
377	u32 mfilt[2], rfilt;
378	struct ath5k_vif_iter_data iter_data; /* to count STA interfaces */
379
380	mutex_lock(&ah->lock);
381
382	mfilt[0] = multicast;
383	mfilt[1] = multicast >> 32;
384
385	/* Only deal with supported flags */
386	changed_flags &= SUPPORTED_FIF_FLAGS;
387	*new_flags &= SUPPORTED_FIF_FLAGS;
388
389	/* If HW detects any phy or radar errors, leave those filters on.
390	 * Also, always enable Unicast, Broadcasts and Multicast
391	 * XXX: move unicast, bssid broadcasts and multicast to mac80211 */
392	rfilt = (ath5k_hw_get_rx_filter(ah) & (AR5K_RX_FILTER_PHYERR)) |
393		(AR5K_RX_FILTER_UCAST | AR5K_RX_FILTER_BCAST |
394		AR5K_RX_FILTER_MCAST);
395
396	if (changed_flags & (FIF_PROMISC_IN_BSS | FIF_OTHER_BSS)) {
397		if (*new_flags & FIF_PROMISC_IN_BSS)
398			__set_bit(ATH_STAT_PROMISC, ah->status);
399		else
400			__clear_bit(ATH_STAT_PROMISC, ah->status);
401	}
402
403	if (test_bit(ATH_STAT_PROMISC, ah->status))
404		rfilt |= AR5K_RX_FILTER_PROM;
405
406	/* Note, AR5K_RX_FILTER_MCAST is already enabled */
407	if (*new_flags & FIF_ALLMULTI) {
408		mfilt[0] =  ~0;
409		mfilt[1] =  ~0;
410	}
411
412	/* This is the best we can do */
413	if (*new_flags & (FIF_FCSFAIL | FIF_PLCPFAIL))
414		rfilt |= AR5K_RX_FILTER_PHYERR;
415
416	/* FIF_BCN_PRBRESP_PROMISC really means to enable beacons
417	* and probes for any BSSID */
418	if ((*new_flags & FIF_BCN_PRBRESP_PROMISC) || (ah->nvifs > 1))
419		rfilt |= AR5K_RX_FILTER_BEACON;
420
421	/* FIF_CONTROL doc says that if FIF_PROMISC_IN_BSS is not
422	 * set we should only pass on control frames for this
423	 * station. This needs testing. I believe right now this
424	 * enables *all* control frames, which is OK.. but
425	 * but we should see if we can improve on granularity */
426	if (*new_flags & FIF_CONTROL)
427		rfilt |= AR5K_RX_FILTER_CONTROL;
428
429	/* Additional settings per mode -- this is per ath5k */
430
431	/* XXX move these to mac80211, and add a beacon IFF flag to mac80211 */
432
433	switch (ah->opmode) {
434	case NL80211_IFTYPE_MESH_POINT:
435		rfilt |= AR5K_RX_FILTER_CONTROL |
436			 AR5K_RX_FILTER_BEACON |
437			 AR5K_RX_FILTER_PROBEREQ |
438			 AR5K_RX_FILTER_PROM;
439		break;
440	case NL80211_IFTYPE_AP:
441	case NL80211_IFTYPE_ADHOC:
442		rfilt |= AR5K_RX_FILTER_PROBEREQ |
443			 AR5K_RX_FILTER_BEACON;
444		break;
445	case NL80211_IFTYPE_STATION:
446		if (ah->assoc)
447			rfilt |= AR5K_RX_FILTER_BEACON;
448	default:
449		break;
450	}
451
452	iter_data.hw_macaddr = NULL;
453	iter_data.n_stas = 0;
454	iter_data.need_set_hw_addr = false;
455	ieee80211_iterate_active_interfaces_atomic(
456		ah->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
457		ath5k_vif_iter, &iter_data);
458
459	/* Set up RX Filter */
460	if (iter_data.n_stas > 1) {
461		/* If you have multiple STA interfaces connected to
462		 * different APs, ARPs are not received (most of the time?)
463		 * Enabling PROMISC appears to fix that problem.
464		 */
465		rfilt |= AR5K_RX_FILTER_PROM;
466	}
467
468	/* Set filters */
469	ath5k_hw_set_rx_filter(ah, rfilt);
470
471	/* Set multicast bits */
472	ath5k_hw_set_mcast_filter(ah, mfilt[0], mfilt[1]);
473	/* Set the cached hw filter flags, this will later actually
474	 * be set in HW */
475	ah->filter_flags = rfilt;
476	/* Store current FIF filter flags */
477	ah->fif_filter_flags = *new_flags;
478
479	mutex_unlock(&ah->lock);
480}
481
482
483static int
484ath5k_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
485	      struct ieee80211_vif *vif, struct ieee80211_sta *sta,
486	      struct ieee80211_key_conf *key)
487{
488	struct ath5k_hw *ah = hw->priv;
489	struct ath_common *common = ath5k_hw_common(ah);
490	int ret = 0;
491
492	if (ath5k_modparam_nohwcrypt)
493		return -EOPNOTSUPP;
494
495	if (key->flags & IEEE80211_KEY_FLAG_RX_MGMT)
496		return -EOPNOTSUPP;
497
498	if (vif->type == NL80211_IFTYPE_ADHOC &&
499	    (key->cipher == WLAN_CIPHER_SUITE_TKIP ||
500	     key->cipher == WLAN_CIPHER_SUITE_CCMP) &&
501	    !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) {
502		/* don't program group keys when using IBSS_RSN */
503		return -EOPNOTSUPP;
504	}
505
506	switch (key->cipher) {
507	case WLAN_CIPHER_SUITE_WEP40:
508	case WLAN_CIPHER_SUITE_WEP104:
509	case WLAN_CIPHER_SUITE_TKIP:
510		break;
511	case WLAN_CIPHER_SUITE_CCMP:
512		if (common->crypt_caps & ATH_CRYPT_CAP_CIPHER_AESCCM)
513			break;
514		return -EOPNOTSUPP;
515	default:
516		WARN_ON(1);
517		return -EINVAL;
518	}
519
520	mutex_lock(&ah->lock);
521
522	switch (cmd) {
523	case SET_KEY:
524		ret = ath_key_config(common, vif, sta, key);
525		if (ret >= 0) {
526			key->hw_key_idx = ret;
527			/* push IV and Michael MIC generation to stack */
528			key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
529			if (key->cipher == WLAN_CIPHER_SUITE_TKIP)
530				key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
531			if (key->cipher == WLAN_CIPHER_SUITE_CCMP)
532				key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
533			ret = 0;
534		}
535		break;
536	case DISABLE_KEY:
537		ath_key_delete(common, key);
538		break;
539	default:
540		ret = -EINVAL;
541	}
542
543	mmiowb();
544	mutex_unlock(&ah->lock);
545	return ret;
546}
547
548
549static void
550ath5k_sw_scan_start(struct ieee80211_hw *hw,
551		    struct ieee80211_vif *vif,
552		    const u8 *mac_addr)
553{
554	struct ath5k_hw *ah = hw->priv;
555	if (!ah->assoc)
556		ath5k_hw_set_ledstate(ah, AR5K_LED_SCAN);
557}
558
559
560static void
561ath5k_sw_scan_complete(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
562{
563	struct ath5k_hw *ah = hw->priv;
564	ath5k_hw_set_ledstate(ah, ah->assoc ?
565		AR5K_LED_ASSOC : AR5K_LED_INIT);
566}
567
568
569static int
570ath5k_get_stats(struct ieee80211_hw *hw,
571		struct ieee80211_low_level_stats *stats)
572{
573	struct ath5k_hw *ah = hw->priv;
574
575	/* Force update */
576	ath5k_hw_update_mib_counters(ah);
577
578	stats->dot11ACKFailureCount = ah->stats.ack_fail;
579	stats->dot11RTSFailureCount = ah->stats.rts_fail;
580	stats->dot11RTSSuccessCount = ah->stats.rts_ok;
581	stats->dot11FCSErrorCount = ah->stats.fcs_error;
582
583	return 0;
584}
585
586
587static int
588ath5k_conf_tx(struct ieee80211_hw *hw, struct ieee80211_vif *vif, u16 queue,
589	      const struct ieee80211_tx_queue_params *params)
590{
591	struct ath5k_hw *ah = hw->priv;
592	struct ath5k_txq_info qi;
593	int ret = 0;
594
595	if (queue >= ah->ah_capabilities.cap_queues.q_tx_num)
596		return 0;
597
598	mutex_lock(&ah->lock);
599
600	ath5k_hw_get_tx_queueprops(ah, queue, &qi);
601
602	qi.tqi_aifs = params->aifs;
603	qi.tqi_cw_min = params->cw_min;
604	qi.tqi_cw_max = params->cw_max;
605	qi.tqi_burst_time = params->txop * 32;
606
607	ATH5K_DBG(ah, ATH5K_DEBUG_ANY,
608		  "Configure tx [queue %d],  "
609		  "aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
610		  queue, params->aifs, params->cw_min,
611		  params->cw_max, params->txop);
612
613	if (ath5k_hw_set_tx_queueprops(ah, queue, &qi)) {
614		ATH5K_ERR(ah,
615			  "Unable to update hardware queue %u!\n", queue);
616		ret = -EIO;
617	} else
618		ath5k_hw_reset_tx_queue(ah, queue);
619
620	mutex_unlock(&ah->lock);
621
622	return ret;
623}
624
625
626static u64
627ath5k_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
628{
629	struct ath5k_hw *ah = hw->priv;
630
631	return ath5k_hw_get_tsf64(ah);
632}
633
634
635static void
636ath5k_set_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif, u64 tsf)
637{
638	struct ath5k_hw *ah = hw->priv;
639
640	ath5k_hw_set_tsf64(ah, tsf);
641}
642
643
644static void
645ath5k_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
646{
647	struct ath5k_hw *ah = hw->priv;
648
649	/*
650	 * in IBSS mode we need to update the beacon timers too.
651	 * this will also reset the TSF if we call it with 0
652	 */
653	if (ah->opmode == NL80211_IFTYPE_ADHOC)
654		ath5k_beacon_update_timers(ah, 0);
655	else
656		ath5k_hw_reset_tsf(ah);
657}
658
659
660static int
661ath5k_get_survey(struct ieee80211_hw *hw, int idx, struct survey_info *survey)
662{
663	struct ath5k_hw *ah = hw->priv;
664	struct ieee80211_conf *conf = &hw->conf;
665	struct ath_common *common = ath5k_hw_common(ah);
666	struct ath_cycle_counters *cc = &common->cc_survey;
667	unsigned int div = common->clockrate * 1000;
668
669	if (idx != 0)
670		return -ENOENT;
671
672	spin_lock_bh(&common->cc_lock);
673	ath_hw_cycle_counters_update(common);
674	if (cc->cycles > 0) {
675		ah->survey.time += cc->cycles / div;
676		ah->survey.time_busy += cc->rx_busy / div;
677		ah->survey.time_rx += cc->rx_frame / div;
678		ah->survey.time_tx += cc->tx_frame / div;
679	}
680	memset(cc, 0, sizeof(*cc));
681	spin_unlock_bh(&common->cc_lock);
682
683	memcpy(survey, &ah->survey, sizeof(*survey));
684
685	survey->channel = conf->chandef.chan;
686	survey->noise = ah->ah_noise_floor;
687	survey->filled = SURVEY_INFO_NOISE_DBM |
688			SURVEY_INFO_IN_USE |
689			SURVEY_INFO_TIME |
690			SURVEY_INFO_TIME_BUSY |
691			SURVEY_INFO_TIME_RX |
692			SURVEY_INFO_TIME_TX;
693
694	return 0;
695}
696
697
698/**
699 * ath5k_set_coverage_class - Set IEEE 802.11 coverage class
700 *
701 * @hw: struct ieee80211_hw pointer
702 * @coverage_class: IEEE 802.11 coverage class number
703 *
704 * Mac80211 callback. Sets slot time, ACK timeout and CTS timeout for given
705 * coverage class. The values are persistent, they are restored after device
706 * reset.
707 */
708static void
709ath5k_set_coverage_class(struct ieee80211_hw *hw, s16 coverage_class)
710{
711	struct ath5k_hw *ah = hw->priv;
712
713	mutex_lock(&ah->lock);
714	ath5k_hw_set_coverage_class(ah, coverage_class);
715	mutex_unlock(&ah->lock);
716}
717
718
719static int
720ath5k_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant)
721{
722	struct ath5k_hw *ah = hw->priv;
723
724	if (tx_ant == 1 && rx_ant == 1)
725		ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_FIXED_A);
726	else if (tx_ant == 2 && rx_ant == 2)
727		ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_FIXED_B);
728	else if ((tx_ant & 3) == 3 && (rx_ant & 3) == 3)
729		ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_DEFAULT);
730	else
731		return -EINVAL;
732	return 0;
733}
734
735
736static int
737ath5k_get_antenna(struct ieee80211_hw *hw, u32 *tx_ant, u32 *rx_ant)
738{
739	struct ath5k_hw *ah = hw->priv;
740
741	switch (ah->ah_ant_mode) {
742	case AR5K_ANTMODE_FIXED_A:
743		*tx_ant = 1; *rx_ant = 1; break;
744	case AR5K_ANTMODE_FIXED_B:
745		*tx_ant = 2; *rx_ant = 2; break;
746	case AR5K_ANTMODE_DEFAULT:
747		*tx_ant = 3; *rx_ant = 3; break;
748	}
749	return 0;
750}
751
752
753static void ath5k_get_ringparam(struct ieee80211_hw *hw,
754				u32 *tx, u32 *tx_max, u32 *rx, u32 *rx_max)
755{
756	struct ath5k_hw *ah = hw->priv;
757
758	*tx = ah->txqs[AR5K_TX_QUEUE_ID_DATA_MIN].txq_max;
759
760	*tx_max = ATH5K_TXQ_LEN_MAX;
761	*rx = *rx_max = ATH_RXBUF;
762}
763
764
765static int ath5k_set_ringparam(struct ieee80211_hw *hw, u32 tx, u32 rx)
766{
767	struct ath5k_hw *ah = hw->priv;
768	u16 qnum;
769
770	/* only support setting tx ring size for now */
771	if (rx != ATH_RXBUF)
772		return -EINVAL;
773
774	/* restrict tx ring size min/max */
775	if (!tx || tx > ATH5K_TXQ_LEN_MAX)
776		return -EINVAL;
777
778	for (qnum = 0; qnum < ARRAY_SIZE(ah->txqs); qnum++) {
779		if (!ah->txqs[qnum].setup)
780			continue;
781		if (ah->txqs[qnum].qnum < AR5K_TX_QUEUE_ID_DATA_MIN ||
782		    ah->txqs[qnum].qnum > AR5K_TX_QUEUE_ID_DATA_MAX)
783			continue;
784
785		ah->txqs[qnum].txq_max = tx;
786		if (ah->txqs[qnum].txq_len >= ah->txqs[qnum].txq_max)
787			ieee80211_stop_queue(hw, ah->txqs[qnum].qnum);
788	}
789
790	return 0;
791}
792
793
794const struct ieee80211_ops ath5k_hw_ops = {
795	.tx			= ath5k_tx,
796	.start			= ath5k_start,
797	.stop			= ath5k_stop,
798	.add_interface		= ath5k_add_interface,
799	/* .change_interface	= not implemented */
800	.remove_interface	= ath5k_remove_interface,
801	.config			= ath5k_config,
802	.bss_info_changed	= ath5k_bss_info_changed,
803	.prepare_multicast	= ath5k_prepare_multicast,
804	.configure_filter	= ath5k_configure_filter,
805	/* .set_tim		= not implemented */
806	.set_key		= ath5k_set_key,
807	/* .update_tkip_key	= not implemented */
808	/* .hw_scan		= not implemented */
809	.sw_scan_start		= ath5k_sw_scan_start,
810	.sw_scan_complete	= ath5k_sw_scan_complete,
811	.get_stats		= ath5k_get_stats,
812	/* .get_tkip_seq	= not implemented */
813	/* .set_frag_threshold	= not implemented */
814	/* .set_rts_threshold	= not implemented */
815	/* .sta_add		= not implemented */
816	/* .sta_remove		= not implemented */
817	/* .sta_notify		= not implemented */
818	.conf_tx		= ath5k_conf_tx,
819	.get_tsf		= ath5k_get_tsf,
820	.set_tsf		= ath5k_set_tsf,
821	.reset_tsf		= ath5k_reset_tsf,
822	/* .tx_last_beacon	= not implemented */
823	/* .ampdu_action	= not needed */
824	.get_survey		= ath5k_get_survey,
825	.set_coverage_class	= ath5k_set_coverage_class,
826	/* .rfkill_poll		= not implemented */
827	/* .flush		= not implemented */
828	/* .channel_switch	= not implemented */
829	/* .napi_poll		= not implemented */
830	.set_antenna		= ath5k_set_antenna,
831	.get_antenna		= ath5k_get_antenna,
832	.set_ringparam		= ath5k_set_ringparam,
833	.get_ringparam		= ath5k_get_ringparam,
834};
835