| /* | 
 |  * 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: | 
 | 			for (queue = AR5K_TX_QUEUE_ID_DATA_MIN; | 
 | 				ah->ah_txq[queue].tqi_type != | 
 | 				AR5K_TX_QUEUE_INACTIVE; queue++) { | 
 |  | 
 | 				if (queue > AR5K_TX_QUEUE_ID_DATA_MAX) | 
 | 					return -EINVAL; | 
 | 			} | 
 | 			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); | 
 |  | 
 | 	tq = &ah->ah_txq[queue]; | 
 |  | 
 | 	/* 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 ieee80211_band band; | 
 | 	struct ieee80211_rate *rate; | 
 | 	u32 ack_tx_time, eifs, eifs_clock, sifs, sifs_clock; | 
 | 	u32 slot_time_clock = ath5k_hw_htoclock(ah, slot_time); | 
 |  | 
 | 	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 == IEEE80211_BAND_5GHZ) | 
 | 		band = IEEE80211_BAND_5GHZ; | 
 | 	else | 
 | 		band = IEEE80211_BAND_2GHZ; | 
 |  | 
 | 	rate = &ah->sbands[band].bitrates[0]; | 
 | 	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; | 
 | } |