mirror of
				https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
				synced 2025-10-31 09:36:25 +00:00 
			
		
		
		
	 230fc4f3b2
			
		
	
	
		230fc4f3b2
		
	
	
	
	
		
			
			Now that we have ftrace, it is not needed any more. Signed-off-by: Bruno Randolf <br1@einfach.org> Acked-by: Nick Kossifidis <mickflemm@gmail.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
		
			
				
	
	
		
			530 lines
		
	
	
		
			15 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			530 lines
		
	
	
		
			15 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, DFS Control Unit Functions
 | |
| \********************************************/
 | |
| 
 | |
| #include "ath5k.h"
 | |
| #include "reg.h"
 | |
| #include "debug.h"
 | |
| #include "base.h"
 | |
| 
 | |
| /*
 | |
|  * Get properties for a transmit queue
 | |
|  */
 | |
| 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;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Set properties for a transmit queue
 | |
|  */
 | |
| int ath5k_hw_set_tx_queueprops(struct ath5k_hw *ah, int queue,
 | |
| 				const struct ath5k_txq_info *queue_info)
 | |
| {
 | |
| 	AR5K_ASSERT_ENTRY(queue, ah->ah_capabilities.cap_queues.q_tx_num);
 | |
| 
 | |
| 	if (ah->ah_txq[queue].tqi_type == AR5K_TX_QUEUE_INACTIVE)
 | |
| 		return -EIO;
 | |
| 
 | |
| 	memcpy(&ah->ah_txq[queue], queue_info, sizeof(struct ath5k_txq_info));
 | |
| 
 | |
| 	/*XXX: Is this supported on 5210 ?*/
 | |
| 	if ((queue_info->tqi_type == AR5K_TX_QUEUE_DATA &&
 | |
| 			((queue_info->tqi_subtype == AR5K_WME_AC_VI) ||
 | |
| 			(queue_info->tqi_subtype == AR5K_WME_AC_VO))) ||
 | |
| 			queue_info->tqi_type == AR5K_TX_QUEUE_UAPSD)
 | |
| 		ah->ah_txq[queue].tqi_flags |= AR5K_TXQ_FLAG_POST_FR_BKOFF_DIS;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Initialize a transmit queue
 | |
|  */
 | |
| 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_version == AR5K_AR5210) {
 | |
| 		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;
 | |
| 		case AR5K_TX_QUEUE_XR_DATA:
 | |
| 			if (ah->ah_version != AR5K_AR5212)
 | |
| 				ATH5K_ERR(ah->ah_sc,
 | |
| 					"XR data queues only supported in"
 | |
| 					" 5212!\n");
 | |
| 			queue = AR5K_TX_QUEUE_ID_XR_DATA;
 | |
| 			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;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Get number of pending frames
 | |
|  * for a specific queue [5211+]
 | |
|  */
 | |
| 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;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Set a transmit queue inactive
 | |
|  */
 | |
| 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);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Set DFS properties for a transmit queue on DCU
 | |
|  */
 | |
| int ath5k_hw_reset_tx_queue(struct ath5k_hw *ah, unsigned int queue)
 | |
| {
 | |
| 	u32 cw_min, cw_max, retry_lg, retry_sh;
 | |
| 	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];
 | |
| 
 | |
| 	if (tq->tqi_type == AR5K_TX_QUEUE_INACTIVE)
 | |
| 		return 0;
 | |
| 
 | |
| 	if (ah->ah_version == AR5K_AR5210) {
 | |
| 		/* Only handle data queues, others will be ignored */
 | |
| 		if (tq->tqi_type != AR5K_TX_QUEUE_DATA)
 | |
| 			return 0;
 | |
| 
 | |
| 		/* Set Slot time */
 | |
| 		ath5k_hw_reg_write(ah, ah->ah_turbo ?
 | |
| 			AR5K_INIT_SLOT_TIME_TURBO : AR5K_INIT_SLOT_TIME,
 | |
| 			AR5K_SLOT_TIME);
 | |
| 		/* Set ACK_CTS timeout */
 | |
| 		ath5k_hw_reg_write(ah, ah->ah_turbo ?
 | |
| 			AR5K_INIT_ACK_CTS_TIMEOUT_TURBO :
 | |
| 			AR5K_INIT_ACK_CTS_TIMEOUT, AR5K_SLOT_TIME);
 | |
| 		/* Set Transmit Latency */
 | |
| 		ath5k_hw_reg_write(ah, ah->ah_turbo ?
 | |
| 			AR5K_INIT_TRANSMIT_LATENCY_TURBO :
 | |
| 			AR5K_INIT_TRANSMIT_LATENCY, AR5K_USEC_5210);
 | |
| 
 | |
| 		/* Set IFS0 */
 | |
| 		if (ah->ah_turbo) {
 | |
| 			 ath5k_hw_reg_write(ah, ((AR5K_INIT_SIFS_TURBO +
 | |
| 				(ah->ah_aifs + tq->tqi_aifs) *
 | |
| 				AR5K_INIT_SLOT_TIME_TURBO) <<
 | |
| 				AR5K_IFS0_DIFS_S) | AR5K_INIT_SIFS_TURBO,
 | |
| 				AR5K_IFS0);
 | |
| 		} else {
 | |
| 			ath5k_hw_reg_write(ah, ((AR5K_INIT_SIFS +
 | |
| 				(ah->ah_aifs + tq->tqi_aifs) *
 | |
| 				AR5K_INIT_SLOT_TIME) << AR5K_IFS0_DIFS_S) |
 | |
| 				AR5K_INIT_SIFS, AR5K_IFS0);
 | |
| 		}
 | |
| 
 | |
| 		/* Set IFS1 */
 | |
| 		ath5k_hw_reg_write(ah, ah->ah_turbo ?
 | |
| 			AR5K_INIT_PROTO_TIME_CNTRL_TURBO :
 | |
| 			AR5K_INIT_PROTO_TIME_CNTRL, AR5K_IFS1);
 | |
| 		/* Set AR5K_PHY_SETTLING */
 | |
| 		ath5k_hw_reg_write(ah, ah->ah_turbo ?
 | |
| 			(ath5k_hw_reg_read(ah, AR5K_PHY_SETTLING) & ~0x7F)
 | |
| 			| 0x38 :
 | |
| 			(ath5k_hw_reg_read(ah, AR5K_PHY_SETTLING) & ~0x7F)
 | |
| 			| 0x1C,
 | |
| 			AR5K_PHY_SETTLING);
 | |
| 		/* Set Frame Control Register */
 | |
| 		ath5k_hw_reg_write(ah, ah->ah_turbo ?
 | |
| 			(AR5K_PHY_FRAME_CTL_INI | AR5K_PHY_TURBO_MODE |
 | |
| 			AR5K_PHY_TURBO_SHORT | 0x2020) :
 | |
| 			(AR5K_PHY_FRAME_CTL_INI | 0x1020),
 | |
| 			AR5K_PHY_FRAME_CTL_5210);
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Calculate cwmin/max by channel mode
 | |
| 	 */
 | |
| 	cw_min = ah->ah_cw_min = AR5K_TUNE_CWMIN;
 | |
| 	cw_max = ah->ah_cw_max = AR5K_TUNE_CWMAX;
 | |
| 	ah->ah_aifs = AR5K_TUNE_AIFS;
 | |
| 	/*XR is only supported on 5212*/
 | |
| 	if (IS_CHAN_XR(ah->ah_current_channel) &&
 | |
| 			ah->ah_version == AR5K_AR5212) {
 | |
| 		cw_min = ah->ah_cw_min = AR5K_TUNE_CWMIN_XR;
 | |
| 		cw_max = ah->ah_cw_max = AR5K_TUNE_CWMAX_XR;
 | |
| 		ah->ah_aifs = AR5K_TUNE_AIFS_XR;
 | |
| 	/*B mode is not supported on 5210*/
 | |
| 	} else if (IS_CHAN_B(ah->ah_current_channel) &&
 | |
| 			ah->ah_version != AR5K_AR5210) {
 | |
| 		cw_min = ah->ah_cw_min = AR5K_TUNE_CWMIN_11B;
 | |
| 		cw_max = ah->ah_cw_max = AR5K_TUNE_CWMAX_11B;
 | |
| 		ah->ah_aifs = AR5K_TUNE_AIFS_11B;
 | |
| 	}
 | |
| 
 | |
| 	cw_min = 1;
 | |
| 	while (cw_min < ah->ah_cw_min)
 | |
| 		cw_min = (cw_min << 1) | 1;
 | |
| 
 | |
| 	cw_min = tq->tqi_cw_min < 0 ? (cw_min >> (-tq->tqi_cw_min)) :
 | |
| 		((cw_min << tq->tqi_cw_min) + (1 << tq->tqi_cw_min) - 1);
 | |
| 	cw_max = tq->tqi_cw_max < 0 ? (cw_max >> (-tq->tqi_cw_max)) :
 | |
| 		((cw_max << tq->tqi_cw_max) + (1 << tq->tqi_cw_max) - 1);
 | |
| 
 | |
| 	/*
 | |
| 	 * Calculate and set retry limits
 | |
| 	 */
 | |
| 	if (ah->ah_software_retry) {
 | |
| 		/* XXX Need to test this */
 | |
| 		retry_lg = ah->ah_limit_tx_retries;
 | |
| 		retry_sh = retry_lg = retry_lg > AR5K_DCU_RETRY_LMT_SH_RETRY ?
 | |
| 			AR5K_DCU_RETRY_LMT_SH_RETRY : retry_lg;
 | |
| 	} else {
 | |
| 		retry_lg = AR5K_INIT_LG_RETRY;
 | |
| 		retry_sh = AR5K_INIT_SH_RETRY;
 | |
| 	}
 | |
| 
 | |
| 	/*No QCU/DCU [5210]*/
 | |
| 	if (ah->ah_version == AR5K_AR5210) {
 | |
| 		ath5k_hw_reg_write(ah,
 | |
| 			(cw_min << AR5K_NODCU_RETRY_LMT_CW_MIN_S)
 | |
| 			| AR5K_REG_SM(AR5K_INIT_SLG_RETRY,
 | |
| 				AR5K_NODCU_RETRY_LMT_SLG_RETRY)
 | |
| 			| AR5K_REG_SM(AR5K_INIT_SSH_RETRY,
 | |
| 				AR5K_NODCU_RETRY_LMT_SSH_RETRY)
 | |
| 			| AR5K_REG_SM(retry_lg, AR5K_NODCU_RETRY_LMT_LG_RETRY)
 | |
| 			| AR5K_REG_SM(retry_sh, AR5K_NODCU_RETRY_LMT_SH_RETRY),
 | |
| 			AR5K_NODCU_RETRY_LMT);
 | |
| 	} else {
 | |
| 		/*QCU/DCU [5211+]*/
 | |
| 		ath5k_hw_reg_write(ah,
 | |
| 			AR5K_REG_SM(AR5K_INIT_SLG_RETRY,
 | |
| 				AR5K_DCU_RETRY_LMT_SLG_RETRY) |
 | |
| 			AR5K_REG_SM(AR5K_INIT_SSH_RETRY,
 | |
| 				AR5K_DCU_RETRY_LMT_SSH_RETRY) |
 | |
| 			AR5K_REG_SM(retry_lg, AR5K_DCU_RETRY_LMT_LG_RETRY) |
 | |
| 			AR5K_REG_SM(retry_sh, AR5K_DCU_RETRY_LMT_SH_RETRY),
 | |
| 			AR5K_QUEUE_DFS_RETRY_LIMIT(queue));
 | |
| 
 | |
| 	/*===Rest is also for QCU/DCU only [5211+]===*/
 | |
| 
 | |
| 		/*
 | |
| 		 * Set initial content window (cw_min/cw_max)
 | |
| 		 * and arbitrated interframe space (aifs)...
 | |
| 		 */
 | |
| 		ath5k_hw_reg_write(ah,
 | |
| 			AR5K_REG_SM(cw_min, AR5K_DCU_LCL_IFS_CW_MIN) |
 | |
| 			AR5K_REG_SM(cw_max, AR5K_DCU_LCL_IFS_CW_MAX) |
 | |
| 			AR5K_REG_SM(ah->ah_aifs + tq->tqi_aifs,
 | |
| 				AR5K_DCU_LCL_IFS_AIFS),
 | |
| 			AR5K_QUEUE_DFS_LOCAL_IFS(queue));
 | |
| 
 | |
| 		/*
 | |
| 		 * Set misc registers
 | |
| 		 */
 | |
| 		/* Enable DCU early termination for this queue */
 | |
| 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
 | |
| 					AR5K_QCU_MISC_DCU_EARLY);
 | |
| 
 | |
| 		/* 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);
 | |
| 
 | |
| 		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);
 | |
| 		}
 | |
| 
 | |
| 		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);
 | |
| 		}
 | |
| 
 | |
| 		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));
 | |
| 
 | |
| 		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;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Set slot time on DCU
 | |
|  */
 | |
| int ath5k_hw_set_slot_time(struct ath5k_hw *ah, unsigned int slot_time)
 | |
| {
 | |
| 	u32 slot_time_clock = ath5k_hw_htoclock(ah, slot_time);
 | |
| 
 | |
| 	if (slot_time < 6 || slot_time_clock > AR5K_SLOT_TIME_MAX)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (ah->ah_version == AR5K_AR5210)
 | |
| 		ath5k_hw_reg_write(ah, slot_time_clock, AR5K_SLOT_TIME);
 | |
| 	else
 | |
| 		ath5k_hw_reg_write(ah, slot_time_clock, AR5K_DCU_GBL_IFS_SLOT);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 |