mirror of
				git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
				synced 2025-09-04 20:19:47 +08:00 
			
		
		
		
	 2571c081cb
			
		
	
	
		2571c081cb
		
	
	
	
	
		
			
			Pointer tq is initialized with &ah->ah_txq[queue] and then a few lines later is re-assigned the same value, hence this duplicate assignment is redundant and can be removed. Cleans up clang warning: drivers/net/wireless/ath/ath5k/qcu.c:326:25: warning: Value stored to 'tq' during its initialization is never read Signed-off-by: Colin Ian King <colin.king@canonical.com> Signed-off-by: Kalle Valo <kvalo@codeaurora.org>
		
			
				
	
	
		
			730 lines
		
	
	
		
			21 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			730 lines
		
	
	
		
			21 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright (c) 2004-2008 Reyk Floeter <reyk@openbsd.org>
 | |
|  * Copyright (c) 2006-2008 Nick Kossifidis <mickflemm@gmail.com>
 | |
|  *
 | |
|  * Permission to use, copy, modify, and distribute this software for any
 | |
|  * purpose with or without fee is hereby granted, provided that the above
 | |
|  * copyright notice and this permission notice appear in all copies.
 | |
|  *
 | |
|  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 | |
|  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 | |
|  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 | |
|  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 | |
|  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 | |
|  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 | |
|  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| /********************************************\
 | |
| Queue Control Unit, DCF Control Unit Functions
 | |
| \********************************************/
 | |
| 
 | |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 | |
| 
 | |
| #include "ath5k.h"
 | |
| #include "reg.h"
 | |
| #include "debug.h"
 | |
| #include <linux/log2.h>
 | |
| 
 | |
| /**
 | |
|  * DOC: Queue Control Unit (QCU)/DCF Control Unit (DCU) functions
 | |
|  *
 | |
|  * Here we setup parameters for the 12 available TX queues. Note that
 | |
|  * on the various registers we can usually only map the first 10 of them so
 | |
|  * basically we have 10 queues to play with. Each queue has a matching
 | |
|  * QCU that controls when the queue will get triggered and multiple QCUs
 | |
|  * can be mapped to a single DCU that controls the various DFS parameters
 | |
|  * for the various queues. In our setup we have a 1:1 mapping between QCUs
 | |
|  * and DCUs allowing us to have different DFS settings for each queue.
 | |
|  *
 | |
|  * When a frame goes into a TX queue, QCU decides when it'll trigger a
 | |
|  * transmission based on various criteria (such as how many data we have inside
 | |
|  * it's buffer or -if it's a beacon queue- if it's time to fire up the queue
 | |
|  * based on TSF etc), DCU adds backoff, IFSes etc and then a scheduler
 | |
|  * (arbitrator) decides the priority of each QCU based on it's configuration
 | |
|  * (e.g. beacons are always transmitted when they leave DCU bypassing all other
 | |
|  * frames from other queues waiting to be transmitted). After a frame leaves
 | |
|  * the DCU it goes to PCU for further processing and then to PHY for
 | |
|  * the actual transmission.
 | |
|  */
 | |
| 
 | |
| 
 | |
| /******************\
 | |
| * Helper functions *
 | |
| \******************/
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_num_tx_pending() - Get number of pending frames for a  given queue
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  * @queue: One of enum ath5k_tx_queue_id
 | |
|  */
 | |
| u32
 | |
| ath5k_hw_num_tx_pending(struct ath5k_hw *ah, unsigned int queue)
 | |
| {
 | |
| 	u32 pending;
 | |
| 	AR5K_ASSERT_ENTRY(queue, ah->ah_capabilities.cap_queues.q_tx_num);
 | |
| 
 | |
| 	/* Return if queue is declared inactive */
 | |
| 	if (ah->ah_txq[queue].tqi_type == AR5K_TX_QUEUE_INACTIVE)
 | |
| 		return false;
 | |
| 
 | |
| 	/* XXX: How about AR5K_CFG_TXCNT ? */
 | |
| 	if (ah->ah_version == AR5K_AR5210)
 | |
| 		return false;
 | |
| 
 | |
| 	pending = ath5k_hw_reg_read(ah, AR5K_QUEUE_STATUS(queue));
 | |
| 	pending &= AR5K_QCU_STS_FRMPENDCNT;
 | |
| 
 | |
| 	/* It's possible to have no frames pending even if TXE
 | |
| 	 * is set. To indicate that q has not stopped return
 | |
| 	 * true */
 | |
| 	if (!pending && AR5K_REG_READ_Q(ah, AR5K_QCU_TXE, queue))
 | |
| 		return true;
 | |
| 
 | |
| 	return pending;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_release_tx_queue() - Set a transmit queue inactive
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  * @queue: One of enum ath5k_tx_queue_id
 | |
|  */
 | |
| void
 | |
| ath5k_hw_release_tx_queue(struct ath5k_hw *ah, unsigned int queue)
 | |
| {
 | |
| 	if (WARN_ON(queue >= ah->ah_capabilities.cap_queues.q_tx_num))
 | |
| 		return;
 | |
| 
 | |
| 	/* This queue will be skipped in further operations */
 | |
| 	ah->ah_txq[queue].tqi_type = AR5K_TX_QUEUE_INACTIVE;
 | |
| 	/*For SIMR setup*/
 | |
| 	AR5K_Q_DISABLE_BITS(ah->ah_txq_status, queue);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * ath5k_cw_validate() - Make sure the given cw is valid
 | |
|  * @cw_req: The contention window value to check
 | |
|  *
 | |
|  * Make sure cw is a power of 2 minus 1 and smaller than 1024
 | |
|  */
 | |
| static u16
 | |
| ath5k_cw_validate(u16 cw_req)
 | |
| {
 | |
| 	cw_req = min(cw_req, (u16)1023);
 | |
| 
 | |
| 	/* Check if cw_req + 1 a power of 2 */
 | |
| 	if (is_power_of_2(cw_req + 1))
 | |
| 		return cw_req;
 | |
| 
 | |
| 	/* Check if cw_req is a power of 2 */
 | |
| 	if (is_power_of_2(cw_req))
 | |
| 		return cw_req - 1;
 | |
| 
 | |
| 	/* If none of the above is correct
 | |
| 	 * find the closest power of 2 */
 | |
| 	cw_req = (u16) roundup_pow_of_two(cw_req) - 1;
 | |
| 
 | |
| 	return cw_req;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_get_tx_queueprops() - Get properties for a transmit queue
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  * @queue: One of enum ath5k_tx_queue_id
 | |
|  * @queue_info: The &struct ath5k_txq_info to fill
 | |
|  */
 | |
| int
 | |
| ath5k_hw_get_tx_queueprops(struct ath5k_hw *ah, int queue,
 | |
| 		struct ath5k_txq_info *queue_info)
 | |
| {
 | |
| 	memcpy(queue_info, &ah->ah_txq[queue], sizeof(struct ath5k_txq_info));
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_set_tx_queueprops() - Set properties for a transmit queue
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  * @queue: One of enum ath5k_tx_queue_id
 | |
|  * @qinfo: The &struct ath5k_txq_info to use
 | |
|  *
 | |
|  * Returns 0 on success or -EIO if queue is inactive
 | |
|  */
 | |
| int
 | |
| ath5k_hw_set_tx_queueprops(struct ath5k_hw *ah, int queue,
 | |
| 				const struct ath5k_txq_info *qinfo)
 | |
| {
 | |
| 	struct ath5k_txq_info *qi;
 | |
| 
 | |
| 	AR5K_ASSERT_ENTRY(queue, ah->ah_capabilities.cap_queues.q_tx_num);
 | |
| 
 | |
| 	qi = &ah->ah_txq[queue];
 | |
| 
 | |
| 	if (qi->tqi_type == AR5K_TX_QUEUE_INACTIVE)
 | |
| 		return -EIO;
 | |
| 
 | |
| 	/* copy and validate values */
 | |
| 	qi->tqi_type = qinfo->tqi_type;
 | |
| 	qi->tqi_subtype = qinfo->tqi_subtype;
 | |
| 	qi->tqi_flags = qinfo->tqi_flags;
 | |
| 	/*
 | |
| 	 * According to the docs: Although the AIFS field is 8 bit wide,
 | |
| 	 * the maximum supported value is 0xFC. Setting it higher than that
 | |
| 	 * will cause the DCU to hang.
 | |
| 	 */
 | |
| 	qi->tqi_aifs = min(qinfo->tqi_aifs, (u8)0xFC);
 | |
| 	qi->tqi_cw_min = ath5k_cw_validate(qinfo->tqi_cw_min);
 | |
| 	qi->tqi_cw_max = ath5k_cw_validate(qinfo->tqi_cw_max);
 | |
| 	qi->tqi_cbr_period = qinfo->tqi_cbr_period;
 | |
| 	qi->tqi_cbr_overflow_limit = qinfo->tqi_cbr_overflow_limit;
 | |
| 	qi->tqi_burst_time = qinfo->tqi_burst_time;
 | |
| 	qi->tqi_ready_time = qinfo->tqi_ready_time;
 | |
| 
 | |
| 	/*XXX: Is this supported on 5210 ?*/
 | |
| 	/*XXX: Is this correct for AR5K_WME_AC_VI,VO ???*/
 | |
| 	if ((qinfo->tqi_type == AR5K_TX_QUEUE_DATA &&
 | |
| 		((qinfo->tqi_subtype == AR5K_WME_AC_VI) ||
 | |
| 		 (qinfo->tqi_subtype == AR5K_WME_AC_VO))) ||
 | |
| 	     qinfo->tqi_type == AR5K_TX_QUEUE_UAPSD)
 | |
| 		qi->tqi_flags |= AR5K_TXQ_FLAG_POST_FR_BKOFF_DIS;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_setup_tx_queue() - Initialize a transmit queue
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  * @queue_type: One of enum ath5k_tx_queue
 | |
|  * @queue_info: The &struct ath5k_txq_info to use
 | |
|  *
 | |
|  * Returns 0 on success, -EINVAL on invalid arguments
 | |
|  */
 | |
| int
 | |
| ath5k_hw_setup_tx_queue(struct ath5k_hw *ah, enum ath5k_tx_queue queue_type,
 | |
| 		struct ath5k_txq_info *queue_info)
 | |
| {
 | |
| 	unsigned int queue;
 | |
| 	int ret;
 | |
| 
 | |
| 	/*
 | |
| 	 * Get queue by type
 | |
| 	 */
 | |
| 	/* 5210 only has 2 queues */
 | |
| 	if (ah->ah_capabilities.cap_queues.q_tx_num == 2) {
 | |
| 		switch (queue_type) {
 | |
| 		case AR5K_TX_QUEUE_DATA:
 | |
| 			queue = AR5K_TX_QUEUE_ID_NOQCU_DATA;
 | |
| 			break;
 | |
| 		case AR5K_TX_QUEUE_BEACON:
 | |
| 		case AR5K_TX_QUEUE_CAB:
 | |
| 			queue = AR5K_TX_QUEUE_ID_NOQCU_BEACON;
 | |
| 			break;
 | |
| 		default:
 | |
| 			return -EINVAL;
 | |
| 		}
 | |
| 	} else {
 | |
| 		switch (queue_type) {
 | |
| 		case AR5K_TX_QUEUE_DATA:
 | |
| 			queue = queue_info->tqi_subtype;
 | |
| 			break;
 | |
| 		case AR5K_TX_QUEUE_UAPSD:
 | |
| 			queue = AR5K_TX_QUEUE_ID_UAPSD;
 | |
| 			break;
 | |
| 		case AR5K_TX_QUEUE_BEACON:
 | |
| 			queue = AR5K_TX_QUEUE_ID_BEACON;
 | |
| 			break;
 | |
| 		case AR5K_TX_QUEUE_CAB:
 | |
| 			queue = AR5K_TX_QUEUE_ID_CAB;
 | |
| 			break;
 | |
| 		default:
 | |
| 			return -EINVAL;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Setup internal queue structure
 | |
| 	 */
 | |
| 	memset(&ah->ah_txq[queue], 0, sizeof(struct ath5k_txq_info));
 | |
| 	ah->ah_txq[queue].tqi_type = queue_type;
 | |
| 
 | |
| 	if (queue_info != NULL) {
 | |
| 		queue_info->tqi_type = queue_type;
 | |
| 		ret = ath5k_hw_set_tx_queueprops(ah, queue, queue_info);
 | |
| 		if (ret)
 | |
| 			return ret;
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * We use ah_txq_status to hold a temp value for
 | |
| 	 * the Secondary interrupt mask registers on 5211+
 | |
| 	 * check out ath5k_hw_reset_tx_queue
 | |
| 	 */
 | |
| 	AR5K_Q_ENABLE_BITS(ah->ah_txq_status, queue);
 | |
| 
 | |
| 	return queue;
 | |
| }
 | |
| 
 | |
| 
 | |
| /*******************************\
 | |
| * Single QCU/DCU initialization *
 | |
| \*******************************/
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_set_tx_retry_limits() - Set tx retry limits on DCU
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  * @queue: One of enum ath5k_tx_queue_id
 | |
|  *
 | |
|  * This function is used when initializing a queue, to set
 | |
|  * retry limits based on ah->ah_retry_* and the chipset used.
 | |
|  */
 | |
| void
 | |
| ath5k_hw_set_tx_retry_limits(struct ath5k_hw *ah,
 | |
| 				  unsigned int queue)
 | |
| {
 | |
| 	/* Single data queue on AR5210 */
 | |
| 	if (ah->ah_version == AR5K_AR5210) {
 | |
| 		struct ath5k_txq_info *tq = &ah->ah_txq[queue];
 | |
| 
 | |
| 		if (queue > 0)
 | |
| 			return;
 | |
| 
 | |
| 		ath5k_hw_reg_write(ah,
 | |
| 			(tq->tqi_cw_min << AR5K_NODCU_RETRY_LMT_CW_MIN_S)
 | |
| 			| AR5K_REG_SM(ah->ah_retry_long,
 | |
| 				      AR5K_NODCU_RETRY_LMT_SLG_RETRY)
 | |
| 			| AR5K_REG_SM(ah->ah_retry_short,
 | |
| 				      AR5K_NODCU_RETRY_LMT_SSH_RETRY)
 | |
| 			| AR5K_REG_SM(ah->ah_retry_long,
 | |
| 				      AR5K_NODCU_RETRY_LMT_LG_RETRY)
 | |
| 			| AR5K_REG_SM(ah->ah_retry_short,
 | |
| 				      AR5K_NODCU_RETRY_LMT_SH_RETRY),
 | |
| 			AR5K_NODCU_RETRY_LMT);
 | |
| 	/* DCU on AR5211+ */
 | |
| 	} else {
 | |
| 		ath5k_hw_reg_write(ah,
 | |
| 			AR5K_REG_SM(ah->ah_retry_long,
 | |
| 				    AR5K_DCU_RETRY_LMT_RTS)
 | |
| 			| AR5K_REG_SM(ah->ah_retry_long,
 | |
| 				      AR5K_DCU_RETRY_LMT_STA_RTS)
 | |
| 			| AR5K_REG_SM(max(ah->ah_retry_long, ah->ah_retry_short),
 | |
| 				      AR5K_DCU_RETRY_LMT_STA_DATA),
 | |
| 			AR5K_QUEUE_DFS_RETRY_LIMIT(queue));
 | |
| 	}
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_reset_tx_queue() - Initialize a single hw queue
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  * @queue: One of enum ath5k_tx_queue_id
 | |
|  *
 | |
|  * Set DCF properties for the given transmit queue on DCU
 | |
|  * and configures all queue-specific parameters.
 | |
|  */
 | |
| int
 | |
| ath5k_hw_reset_tx_queue(struct ath5k_hw *ah, unsigned int queue)
 | |
| {
 | |
| 	struct ath5k_txq_info *tq = &ah->ah_txq[queue];
 | |
| 
 | |
| 	AR5K_ASSERT_ENTRY(queue, ah->ah_capabilities.cap_queues.q_tx_num);
 | |
| 
 | |
| 	/* Skip if queue inactive or if we are on AR5210
 | |
| 	 * that doesn't have QCU/DCU */
 | |
| 	if ((ah->ah_version == AR5K_AR5210) ||
 | |
| 	(tq->tqi_type == AR5K_TX_QUEUE_INACTIVE))
 | |
| 		return 0;
 | |
| 
 | |
| 	/*
 | |
| 	 * Set contention window (cw_min/cw_max)
 | |
| 	 * and arbitrated interframe space (aifs)...
 | |
| 	 */
 | |
| 	ath5k_hw_reg_write(ah,
 | |
| 		AR5K_REG_SM(tq->tqi_cw_min, AR5K_DCU_LCL_IFS_CW_MIN) |
 | |
| 		AR5K_REG_SM(tq->tqi_cw_max, AR5K_DCU_LCL_IFS_CW_MAX) |
 | |
| 		AR5K_REG_SM(tq->tqi_aifs, AR5K_DCU_LCL_IFS_AIFS),
 | |
| 		AR5K_QUEUE_DFS_LOCAL_IFS(queue));
 | |
| 
 | |
| 	/*
 | |
| 	 * Set tx retry limits for this queue
 | |
| 	 */
 | |
| 	ath5k_hw_set_tx_retry_limits(ah, queue);
 | |
| 
 | |
| 
 | |
| 	/*
 | |
| 	 * Set misc registers
 | |
| 	 */
 | |
| 
 | |
| 	/* Enable DCU to wait for next fragment from QCU */
 | |
| 	AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_DFS_MISC(queue),
 | |
| 				AR5K_DCU_MISC_FRAG_WAIT);
 | |
| 
 | |
| 	/* On Maui and Spirit use the global seqnum on DCU */
 | |
| 	if (ah->ah_mac_version < AR5K_SREV_AR5211)
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_DFS_MISC(queue),
 | |
| 					AR5K_DCU_MISC_SEQNUM_CTL);
 | |
| 
 | |
| 	/* Constant bit rate period */
 | |
| 	if (tq->tqi_cbr_period) {
 | |
| 		ath5k_hw_reg_write(ah, AR5K_REG_SM(tq->tqi_cbr_period,
 | |
| 					AR5K_QCU_CBRCFG_INTVAL) |
 | |
| 					AR5K_REG_SM(tq->tqi_cbr_overflow_limit,
 | |
| 					AR5K_QCU_CBRCFG_ORN_THRES),
 | |
| 					AR5K_QUEUE_CBRCFG(queue));
 | |
| 
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
 | |
| 					AR5K_QCU_MISC_FRSHED_CBR);
 | |
| 
 | |
| 		if (tq->tqi_cbr_overflow_limit)
 | |
| 			AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
 | |
| 					AR5K_QCU_MISC_CBR_THRES_ENABLE);
 | |
| 	}
 | |
| 
 | |
| 	/* Ready time interval */
 | |
| 	if (tq->tqi_ready_time && (tq->tqi_type != AR5K_TX_QUEUE_CAB))
 | |
| 		ath5k_hw_reg_write(ah, AR5K_REG_SM(tq->tqi_ready_time,
 | |
| 					AR5K_QCU_RDYTIMECFG_INTVAL) |
 | |
| 					AR5K_QCU_RDYTIMECFG_ENABLE,
 | |
| 					AR5K_QUEUE_RDYTIMECFG(queue));
 | |
| 
 | |
| 	if (tq->tqi_burst_time) {
 | |
| 		ath5k_hw_reg_write(ah, AR5K_REG_SM(tq->tqi_burst_time,
 | |
| 					AR5K_DCU_CHAN_TIME_DUR) |
 | |
| 					AR5K_DCU_CHAN_TIME_ENABLE,
 | |
| 					AR5K_QUEUE_DFS_CHANNEL_TIME(queue));
 | |
| 
 | |
| 		if (tq->tqi_flags & AR5K_TXQ_FLAG_RDYTIME_EXP_POLICY_ENABLE)
 | |
| 			AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
 | |
| 					AR5K_QCU_MISC_RDY_VEOL_POLICY);
 | |
| 	}
 | |
| 
 | |
| 	/* Enable/disable Post frame backoff */
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_BACKOFF_DISABLE)
 | |
| 		ath5k_hw_reg_write(ah, AR5K_DCU_MISC_POST_FR_BKOFF_DIS,
 | |
| 					AR5K_QUEUE_DFS_MISC(queue));
 | |
| 
 | |
| 	/* Enable/disable fragmentation burst backoff */
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_FRAG_BURST_BACKOFF_ENABLE)
 | |
| 		ath5k_hw_reg_write(ah, AR5K_DCU_MISC_BACKOFF_FRAG,
 | |
| 					AR5K_QUEUE_DFS_MISC(queue));
 | |
| 
 | |
| 	/*
 | |
| 	 * Set registers by queue type
 | |
| 	 */
 | |
| 	switch (tq->tqi_type) {
 | |
| 	case AR5K_TX_QUEUE_BEACON:
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
 | |
| 				AR5K_QCU_MISC_FRSHED_DBA_GT |
 | |
| 				AR5K_QCU_MISC_CBREXP_BCN_DIS |
 | |
| 				AR5K_QCU_MISC_BCN_ENABLE);
 | |
| 
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_DFS_MISC(queue),
 | |
| 				(AR5K_DCU_MISC_ARBLOCK_CTL_GLOBAL <<
 | |
| 				AR5K_DCU_MISC_ARBLOCK_CTL_S) |
 | |
| 				AR5K_DCU_MISC_ARBLOCK_IGNORE |
 | |
| 				AR5K_DCU_MISC_POST_FR_BKOFF_DIS |
 | |
| 				AR5K_DCU_MISC_BCN_ENABLE);
 | |
| 		break;
 | |
| 
 | |
| 	case AR5K_TX_QUEUE_CAB:
 | |
| 		/* XXX: use BCN_SENT_GT, if we can figure out how */
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
 | |
| 					AR5K_QCU_MISC_FRSHED_DBA_GT |
 | |
| 					AR5K_QCU_MISC_CBREXP_DIS |
 | |
| 					AR5K_QCU_MISC_CBREXP_BCN_DIS);
 | |
| 
 | |
| 		ath5k_hw_reg_write(ah, ((tq->tqi_ready_time -
 | |
| 					(AR5K_TUNE_SW_BEACON_RESP -
 | |
| 					AR5K_TUNE_DMA_BEACON_RESP) -
 | |
| 				AR5K_TUNE_ADDITIONAL_SWBA_BACKOFF) * 1024) |
 | |
| 					AR5K_QCU_RDYTIMECFG_ENABLE,
 | |
| 					AR5K_QUEUE_RDYTIMECFG(queue));
 | |
| 
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_DFS_MISC(queue),
 | |
| 					(AR5K_DCU_MISC_ARBLOCK_CTL_GLOBAL <<
 | |
| 					AR5K_DCU_MISC_ARBLOCK_CTL_S));
 | |
| 		break;
 | |
| 
 | |
| 	case AR5K_TX_QUEUE_UAPSD:
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
 | |
| 					AR5K_QCU_MISC_CBREXP_DIS);
 | |
| 		break;
 | |
| 
 | |
| 	case AR5K_TX_QUEUE_DATA:
 | |
| 	default:
 | |
| 			break;
 | |
| 	}
 | |
| 
 | |
| 	/* TODO: Handle frame compression */
 | |
| 
 | |
| 	/*
 | |
| 	 * Enable interrupts for this tx queue
 | |
| 	 * in the secondary interrupt mask registers
 | |
| 	 */
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXOKINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txok, queue);
 | |
| 
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXERRINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txerr, queue);
 | |
| 
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXURNINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txurn, queue);
 | |
| 
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXDESCINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txdesc, queue);
 | |
| 
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXEOLINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txeol, queue);
 | |
| 
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_CBRORNINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_cbrorn, queue);
 | |
| 
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_CBRURNINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_cbrurn, queue);
 | |
| 
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_QTRIGINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_qtrig, queue);
 | |
| 
 | |
| 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXNOFRMINT_ENABLE)
 | |
| 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_nofrm, queue);
 | |
| 
 | |
| 	/* Update secondary interrupt mask registers */
 | |
| 
 | |
| 	/* Filter out inactive queues */
 | |
| 	ah->ah_txq_imr_txok &= ah->ah_txq_status;
 | |
| 	ah->ah_txq_imr_txerr &= ah->ah_txq_status;
 | |
| 	ah->ah_txq_imr_txurn &= ah->ah_txq_status;
 | |
| 	ah->ah_txq_imr_txdesc &= ah->ah_txq_status;
 | |
| 	ah->ah_txq_imr_txeol &= ah->ah_txq_status;
 | |
| 	ah->ah_txq_imr_cbrorn &= ah->ah_txq_status;
 | |
| 	ah->ah_txq_imr_cbrurn &= ah->ah_txq_status;
 | |
| 	ah->ah_txq_imr_qtrig &= ah->ah_txq_status;
 | |
| 	ah->ah_txq_imr_nofrm &= ah->ah_txq_status;
 | |
| 
 | |
| 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_txok,
 | |
| 					AR5K_SIMR0_QCU_TXOK) |
 | |
| 					AR5K_REG_SM(ah->ah_txq_imr_txdesc,
 | |
| 					AR5K_SIMR0_QCU_TXDESC),
 | |
| 					AR5K_SIMR0);
 | |
| 
 | |
| 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_txerr,
 | |
| 					AR5K_SIMR1_QCU_TXERR) |
 | |
| 					AR5K_REG_SM(ah->ah_txq_imr_txeol,
 | |
| 					AR5K_SIMR1_QCU_TXEOL),
 | |
| 					AR5K_SIMR1);
 | |
| 
 | |
| 	/* Update SIMR2 but don't overwrite rest simr2 settings */
 | |
| 	AR5K_REG_DISABLE_BITS(ah, AR5K_SIMR2, AR5K_SIMR2_QCU_TXURN);
 | |
| 	AR5K_REG_ENABLE_BITS(ah, AR5K_SIMR2,
 | |
| 				AR5K_REG_SM(ah->ah_txq_imr_txurn,
 | |
| 				AR5K_SIMR2_QCU_TXURN));
 | |
| 
 | |
| 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_cbrorn,
 | |
| 				AR5K_SIMR3_QCBRORN) |
 | |
| 				AR5K_REG_SM(ah->ah_txq_imr_cbrurn,
 | |
| 				AR5K_SIMR3_QCBRURN),
 | |
| 				AR5K_SIMR3);
 | |
| 
 | |
| 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_qtrig,
 | |
| 				AR5K_SIMR4_QTRIG), AR5K_SIMR4);
 | |
| 
 | |
| 	/* Set TXNOFRM_QCU for the queues with TXNOFRM enabled */
 | |
| 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_nofrm,
 | |
| 				AR5K_TXNOFRM_QCU), AR5K_TXNOFRM);
 | |
| 
 | |
| 	/* No queue has TXNOFRM enabled, disable the interrupt
 | |
| 	 * by setting AR5K_TXNOFRM to zero */
 | |
| 	if (ah->ah_txq_imr_nofrm == 0)
 | |
| 		ath5k_hw_reg_write(ah, 0, AR5K_TXNOFRM);
 | |
| 
 | |
| 	/* Set QCU mask for this DCU to save power */
 | |
| 	AR5K_REG_WRITE_Q(ah, AR5K_QUEUE_QCUMASK(queue), queue);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| 
 | |
| /**************************\
 | |
| * Global QCU/DCU functions *
 | |
| \**************************/
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_set_ifs_intervals()  - Set global inter-frame spaces on DCU
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  * @slot_time: Slot time in us
 | |
|  *
 | |
|  * Sets the global IFS intervals on DCU (also works on AR5210) for
 | |
|  * the given slot time and the current bwmode.
 | |
|  */
 | |
| int ath5k_hw_set_ifs_intervals(struct ath5k_hw *ah, unsigned int slot_time)
 | |
| {
 | |
| 	struct ieee80211_channel *channel = ah->ah_current_channel;
 | |
| 	enum nl80211_band band;
 | |
| 	struct ieee80211_supported_band *sband;
 | |
| 	struct ieee80211_rate *rate;
 | |
| 	u32 ack_tx_time, eifs, eifs_clock, sifs, sifs_clock;
 | |
| 	u32 slot_time_clock = ath5k_hw_htoclock(ah, slot_time);
 | |
| 	u32 rate_flags, i;
 | |
| 
 | |
| 	if (slot_time < 6 || slot_time_clock > AR5K_SLOT_TIME_MAX)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	sifs = ath5k_hw_get_default_sifs(ah);
 | |
| 	sifs_clock = ath5k_hw_htoclock(ah, sifs - 2);
 | |
| 
 | |
| 	/* EIFS
 | |
| 	 * Txtime of ack at lowest rate + SIFS + DIFS
 | |
| 	 * (DIFS = SIFS + 2 * Slot time)
 | |
| 	 *
 | |
| 	 * Note: HAL has some predefined values for EIFS
 | |
| 	 * Turbo:   (37 + 2 * 6)
 | |
| 	 * Default: (74 + 2 * 9)
 | |
| 	 * Half:    (149 + 2 * 13)
 | |
| 	 * Quarter: (298 + 2 * 21)
 | |
| 	 *
 | |
| 	 * (74 + 2 * 6) for AR5210 default and turbo !
 | |
| 	 *
 | |
| 	 * According to the formula we have
 | |
| 	 * ack_tx_time = 25 for turbo and
 | |
| 	 * ack_tx_time = 42.5 * clock multiplier
 | |
| 	 * for default/half/quarter.
 | |
| 	 *
 | |
| 	 * This can't be right, 42 is what we would get
 | |
| 	 * from ath5k_hw_get_frame_dur_for_bwmode or
 | |
| 	 * ieee80211_generic_frame_duration for zero frame
 | |
| 	 * length and without SIFS !
 | |
| 	 *
 | |
| 	 * Also we have different lowest rate for 802.11a
 | |
| 	 */
 | |
| 	if (channel->band == NL80211_BAND_5GHZ)
 | |
| 		band = NL80211_BAND_5GHZ;
 | |
| 	else
 | |
| 		band = NL80211_BAND_2GHZ;
 | |
| 
 | |
| 	switch (ah->ah_bwmode) {
 | |
| 	case AR5K_BWMODE_5MHZ:
 | |
| 		rate_flags = IEEE80211_RATE_SUPPORTS_5MHZ;
 | |
| 		break;
 | |
| 	case AR5K_BWMODE_10MHZ:
 | |
| 		rate_flags = IEEE80211_RATE_SUPPORTS_10MHZ;
 | |
| 		break;
 | |
| 	default:
 | |
| 		rate_flags = 0;
 | |
| 		break;
 | |
| 	}
 | |
| 	sband = &ah->sbands[band];
 | |
| 	rate = NULL;
 | |
| 	for (i = 0; i < sband->n_bitrates; i++) {
 | |
| 		if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
 | |
| 			continue;
 | |
| 		rate = &sband->bitrates[i];
 | |
| 		break;
 | |
| 	}
 | |
| 	if (WARN_ON(!rate))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	ack_tx_time = ath5k_hw_get_frame_duration(ah, band, 10, rate, false);
 | |
| 
 | |
| 	/* ack_tx_time includes an SIFS already */
 | |
| 	eifs = ack_tx_time + sifs + 2 * slot_time;
 | |
| 	eifs_clock = ath5k_hw_htoclock(ah, eifs);
 | |
| 
 | |
| 	/* Set IFS settings on AR5210 */
 | |
| 	if (ah->ah_version == AR5K_AR5210) {
 | |
| 		u32 pifs, pifs_clock, difs, difs_clock;
 | |
| 
 | |
| 		/* Set slot time */
 | |
| 		ath5k_hw_reg_write(ah, slot_time_clock, AR5K_SLOT_TIME);
 | |
| 
 | |
| 		/* Set EIFS */
 | |
| 		eifs_clock = AR5K_REG_SM(eifs_clock, AR5K_IFS1_EIFS);
 | |
| 
 | |
| 		/* PIFS = Slot time + SIFS */
 | |
| 		pifs = slot_time + sifs;
 | |
| 		pifs_clock = ath5k_hw_htoclock(ah, pifs);
 | |
| 		pifs_clock = AR5K_REG_SM(pifs_clock, AR5K_IFS1_PIFS);
 | |
| 
 | |
| 		/* DIFS = SIFS + 2 * Slot time */
 | |
| 		difs = sifs + 2 * slot_time;
 | |
| 		difs_clock = ath5k_hw_htoclock(ah, difs);
 | |
| 
 | |
| 		/* Set SIFS/DIFS */
 | |
| 		ath5k_hw_reg_write(ah, (difs_clock <<
 | |
| 				AR5K_IFS0_DIFS_S) | sifs_clock,
 | |
| 				AR5K_IFS0);
 | |
| 
 | |
| 		/* Set PIFS/EIFS and preserve AR5K_INIT_CARR_SENSE_EN */
 | |
| 		ath5k_hw_reg_write(ah, pifs_clock | eifs_clock |
 | |
| 				(AR5K_INIT_CARR_SENSE_EN << AR5K_IFS1_CS_EN_S),
 | |
| 				AR5K_IFS1);
 | |
| 
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	/* Set IFS slot time */
 | |
| 	ath5k_hw_reg_write(ah, slot_time_clock, AR5K_DCU_GBL_IFS_SLOT);
 | |
| 
 | |
| 	/* Set EIFS interval */
 | |
| 	ath5k_hw_reg_write(ah, eifs_clock, AR5K_DCU_GBL_IFS_EIFS);
 | |
| 
 | |
| 	/* Set SIFS interval in usecs */
 | |
| 	AR5K_REG_WRITE_BITS(ah, AR5K_DCU_GBL_IFS_MISC,
 | |
| 				AR5K_DCU_GBL_IFS_MISC_SIFS_DUR_USEC,
 | |
| 				sifs);
 | |
| 
 | |
| 	/* Set SIFS interval in clock cycles */
 | |
| 	ath5k_hw_reg_write(ah, sifs_clock, AR5K_DCU_GBL_IFS_SIFS);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| 
 | |
| /**
 | |
|  * ath5k_hw_init_queues() - Initialize tx queues
 | |
|  * @ah: The &struct ath5k_hw
 | |
|  *
 | |
|  * Initializes all tx queues based on information on
 | |
|  * ah->ah_txq* set by the driver
 | |
|  */
 | |
| int
 | |
| ath5k_hw_init_queues(struct ath5k_hw *ah)
 | |
| {
 | |
| 	int i, ret;
 | |
| 
 | |
| 	/* TODO: HW Compression support for data queues */
 | |
| 	/* TODO: Burst prefetch for data queues */
 | |
| 
 | |
| 	/*
 | |
| 	 * Reset queues and start beacon timers at the end of the reset routine
 | |
| 	 * This also sets QCU mask on each DCU for 1:1 qcu to dcu mapping
 | |
| 	 * Note: If we want we can assign multiple qcus on one dcu.
 | |
| 	 */
 | |
| 	if (ah->ah_version != AR5K_AR5210)
 | |
| 		for (i = 0; i < ah->ah_capabilities.cap_queues.q_tx_num; i++) {
 | |
| 			ret = ath5k_hw_reset_tx_queue(ah, i);
 | |
| 			if (ret) {
 | |
| 				ATH5K_ERR(ah,
 | |
| 					"failed to reset TX queue #%d\n", i);
 | |
| 				return ret;
 | |
| 			}
 | |
| 		}
 | |
| 	else
 | |
| 		/* No QCU/DCU on AR5210, just set tx
 | |
| 		 * retry limits. We set IFS parameters
 | |
| 		 * on ath5k_hw_set_ifs_intervals */
 | |
| 		ath5k_hw_set_tx_retry_limits(ah, 0);
 | |
| 
 | |
| 	/* Set the turbo flag when operating on 40MHz */
 | |
| 	if (ah->ah_bwmode == AR5K_BWMODE_40MHZ)
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_DCU_GBL_IFS_MISC,
 | |
| 				AR5K_DCU_GBL_IFS_MISC_TURBO_MODE);
 | |
| 
 | |
| 	/* If we didn't set IFS timings through
 | |
| 	 * ath5k_hw_set_coverage_class make sure
 | |
| 	 * we set them here */
 | |
| 	if (!ah->ah_coverage_class) {
 | |
| 		unsigned int slot_time = ath5k_hw_get_default_slottime(ah);
 | |
| 		ath5k_hw_set_ifs_intervals(ah, slot_time);
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 |