xref: /openbmc/linux/drivers/net/wireless/ath/ath5k/qcu.c (revision 089a49b6)
1 /*
2  * Copyright (c) 2004-2008 Reyk Floeter <reyk@openbsd.org>
3  * Copyright (c) 2006-2008 Nick Kossifidis <mickflemm@gmail.com>
4  *
5  * Permission to use, copy, modify, and distribute this software for any
6  * purpose with or without fee is hereby granted, provided that the above
7  * copyright notice and this permission notice appear in all copies.
8  *
9  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16  *
17  */
18 
19 /********************************************\
20 Queue Control Unit, DCF Control Unit Functions
21 \********************************************/
22 
23 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
24 
25 #include "ath5k.h"
26 #include "reg.h"
27 #include "debug.h"
28 #include <linux/log2.h>
29 
30 /**
31  * DOC: Queue Control Unit (QCU)/DCF Control Unit (DCU) functions
32  *
33  * Here we setup parameters for the 12 available TX queues. Note that
34  * on the various registers we can usually only map the first 10 of them so
35  * basically we have 10 queues to play with. Each queue has a matching
36  * QCU that controls when the queue will get triggered and multiple QCUs
37  * can be mapped to a single DCU that controls the various DFS parameters
38  * for the various queues. In our setup we have a 1:1 mapping between QCUs
39  * and DCUs allowing us to have different DFS settings for each queue.
40  *
41  * When a frame goes into a TX queue, QCU decides when it'll trigger a
42  * transmission based on various criteria (such as how many data we have inside
43  * it's buffer or -if it's a beacon queue- if it's time to fire up the queue
44  * based on TSF etc), DCU adds backoff, IFSes etc and then a scheduler
45  * (arbitrator) decides the priority of each QCU based on it's configuration
46  * (e.g. beacons are always transmitted when they leave DCU bypassing all other
47  * frames from other queues waiting to be transmitted). After a frame leaves
48  * the DCU it goes to PCU for further processing and then to PHY for
49  * the actual transmission.
50  */
51 
52 
53 /******************\
54 * Helper functions *
55 \******************/
56 
57 /**
58  * ath5k_hw_num_tx_pending() - Get number of pending frames for a  given queue
59  * @ah: The &struct ath5k_hw
60  * @queue: One of enum ath5k_tx_queue_id
61  */
62 u32
63 ath5k_hw_num_tx_pending(struct ath5k_hw *ah, unsigned int queue)
64 {
65 	u32 pending;
66 	AR5K_ASSERT_ENTRY(queue, ah->ah_capabilities.cap_queues.q_tx_num);
67 
68 	/* Return if queue is declared inactive */
69 	if (ah->ah_txq[queue].tqi_type == AR5K_TX_QUEUE_INACTIVE)
70 		return false;
71 
72 	/* XXX: How about AR5K_CFG_TXCNT ? */
73 	if (ah->ah_version == AR5K_AR5210)
74 		return false;
75 
76 	pending = ath5k_hw_reg_read(ah, AR5K_QUEUE_STATUS(queue));
77 	pending &= AR5K_QCU_STS_FRMPENDCNT;
78 
79 	/* It's possible to have no frames pending even if TXE
80 	 * is set. To indicate that q has not stopped return
81 	 * true */
82 	if (!pending && AR5K_REG_READ_Q(ah, AR5K_QCU_TXE, queue))
83 		return true;
84 
85 	return pending;
86 }
87 
88 /**
89  * ath5k_hw_release_tx_queue() - Set a transmit queue inactive
90  * @ah: The &struct ath5k_hw
91  * @queue: One of enum ath5k_tx_queue_id
92  */
93 void
94 ath5k_hw_release_tx_queue(struct ath5k_hw *ah, unsigned int queue)
95 {
96 	if (WARN_ON(queue >= ah->ah_capabilities.cap_queues.q_tx_num))
97 		return;
98 
99 	/* This queue will be skipped in further operations */
100 	ah->ah_txq[queue].tqi_type = AR5K_TX_QUEUE_INACTIVE;
101 	/*For SIMR setup*/
102 	AR5K_Q_DISABLE_BITS(ah->ah_txq_status, queue);
103 }
104 
105 /**
106  * ath5k_cw_validate() - Make sure the given cw is valid
107  * @cw_req: The contention window value to check
108  *
109  * Make sure cw is a power of 2 minus 1 and smaller than 1024
110  */
111 static u16
112 ath5k_cw_validate(u16 cw_req)
113 {
114 	cw_req = min(cw_req, (u16)1023);
115 
116 	/* Check if cw_req + 1 a power of 2 */
117 	if (is_power_of_2(cw_req + 1))
118 		return cw_req;
119 
120 	/* Check if cw_req is a power of 2 */
121 	if (is_power_of_2(cw_req))
122 		return cw_req - 1;
123 
124 	/* If none of the above is correct
125 	 * find the closest power of 2 */
126 	cw_req = (u16) roundup_pow_of_two(cw_req) - 1;
127 
128 	return cw_req;
129 }
130 
131 /**
132  * ath5k_hw_get_tx_queueprops() - Get properties for a transmit queue
133  * @ah: The &struct ath5k_hw
134  * @queue: One of enum ath5k_tx_queue_id
135  * @queue_info: The &struct ath5k_txq_info to fill
136  */
137 int
138 ath5k_hw_get_tx_queueprops(struct ath5k_hw *ah, int queue,
139 		struct ath5k_txq_info *queue_info)
140 {
141 	memcpy(queue_info, &ah->ah_txq[queue], sizeof(struct ath5k_txq_info));
142 	return 0;
143 }
144 
145 /**
146  * ath5k_hw_set_tx_queueprops() - Set properties for a transmit queue
147  * @ah: The &struct ath5k_hw
148  * @queue: One of enum ath5k_tx_queue_id
149  * @qinfo: The &struct ath5k_txq_info to use
150  *
151  * Returns 0 on success or -EIO if queue is inactive
152  */
153 int
154 ath5k_hw_set_tx_queueprops(struct ath5k_hw *ah, int queue,
155 				const struct ath5k_txq_info *qinfo)
156 {
157 	struct ath5k_txq_info *qi;
158 
159 	AR5K_ASSERT_ENTRY(queue, ah->ah_capabilities.cap_queues.q_tx_num);
160 
161 	qi = &ah->ah_txq[queue];
162 
163 	if (qi->tqi_type == AR5K_TX_QUEUE_INACTIVE)
164 		return -EIO;
165 
166 	/* copy and validate values */
167 	qi->tqi_type = qinfo->tqi_type;
168 	qi->tqi_subtype = qinfo->tqi_subtype;
169 	qi->tqi_flags = qinfo->tqi_flags;
170 	/*
171 	 * According to the docs: Although the AIFS field is 8 bit wide,
172 	 * the maximum supported value is 0xFC. Setting it higher than that
173 	 * will cause the DCU to hang.
174 	 */
175 	qi->tqi_aifs = min(qinfo->tqi_aifs, (u8)0xFC);
176 	qi->tqi_cw_min = ath5k_cw_validate(qinfo->tqi_cw_min);
177 	qi->tqi_cw_max = ath5k_cw_validate(qinfo->tqi_cw_max);
178 	qi->tqi_cbr_period = qinfo->tqi_cbr_period;
179 	qi->tqi_cbr_overflow_limit = qinfo->tqi_cbr_overflow_limit;
180 	qi->tqi_burst_time = qinfo->tqi_burst_time;
181 	qi->tqi_ready_time = qinfo->tqi_ready_time;
182 
183 	/*XXX: Is this supported on 5210 ?*/
184 	/*XXX: Is this correct for AR5K_WME_AC_VI,VO ???*/
185 	if ((qinfo->tqi_type == AR5K_TX_QUEUE_DATA &&
186 		((qinfo->tqi_subtype == AR5K_WME_AC_VI) ||
187 		 (qinfo->tqi_subtype == AR5K_WME_AC_VO))) ||
188 	     qinfo->tqi_type == AR5K_TX_QUEUE_UAPSD)
189 		qi->tqi_flags |= AR5K_TXQ_FLAG_POST_FR_BKOFF_DIS;
190 
191 	return 0;
192 }
193 
194 /**
195  * ath5k_hw_setup_tx_queue() - Initialize a transmit queue
196  * @ah: The &struct ath5k_hw
197  * @queue_type: One of enum ath5k_tx_queue
198  * @queue_info: The &struct ath5k_txq_info to use
199  *
200  * Returns 0 on success, -EINVAL on invalid arguments
201  */
202 int
203 ath5k_hw_setup_tx_queue(struct ath5k_hw *ah, enum ath5k_tx_queue queue_type,
204 		struct ath5k_txq_info *queue_info)
205 {
206 	unsigned int queue;
207 	int ret;
208 
209 	/*
210 	 * Get queue by type
211 	 */
212 	/* 5210 only has 2 queues */
213 	if (ah->ah_capabilities.cap_queues.q_tx_num == 2) {
214 		switch (queue_type) {
215 		case AR5K_TX_QUEUE_DATA:
216 			queue = AR5K_TX_QUEUE_ID_NOQCU_DATA;
217 			break;
218 		case AR5K_TX_QUEUE_BEACON:
219 		case AR5K_TX_QUEUE_CAB:
220 			queue = AR5K_TX_QUEUE_ID_NOQCU_BEACON;
221 			break;
222 		default:
223 			return -EINVAL;
224 		}
225 	} else {
226 		switch (queue_type) {
227 		case AR5K_TX_QUEUE_DATA:
228 			for (queue = AR5K_TX_QUEUE_ID_DATA_MIN;
229 				ah->ah_txq[queue].tqi_type !=
230 				AR5K_TX_QUEUE_INACTIVE; queue++) {
231 
232 				if (queue > AR5K_TX_QUEUE_ID_DATA_MAX)
233 					return -EINVAL;
234 			}
235 			break;
236 		case AR5K_TX_QUEUE_UAPSD:
237 			queue = AR5K_TX_QUEUE_ID_UAPSD;
238 			break;
239 		case AR5K_TX_QUEUE_BEACON:
240 			queue = AR5K_TX_QUEUE_ID_BEACON;
241 			break;
242 		case AR5K_TX_QUEUE_CAB:
243 			queue = AR5K_TX_QUEUE_ID_CAB;
244 			break;
245 		default:
246 			return -EINVAL;
247 		}
248 	}
249 
250 	/*
251 	 * Setup internal queue structure
252 	 */
253 	memset(&ah->ah_txq[queue], 0, sizeof(struct ath5k_txq_info));
254 	ah->ah_txq[queue].tqi_type = queue_type;
255 
256 	if (queue_info != NULL) {
257 		queue_info->tqi_type = queue_type;
258 		ret = ath5k_hw_set_tx_queueprops(ah, queue, queue_info);
259 		if (ret)
260 			return ret;
261 	}
262 
263 	/*
264 	 * We use ah_txq_status to hold a temp value for
265 	 * the Secondary interrupt mask registers on 5211+
266 	 * check out ath5k_hw_reset_tx_queue
267 	 */
268 	AR5K_Q_ENABLE_BITS(ah->ah_txq_status, queue);
269 
270 	return queue;
271 }
272 
273 
274 /*******************************\
275 * Single QCU/DCU initialization *
276 \*******************************/
277 
278 /**
279  * ath5k_hw_set_tx_retry_limits() - Set tx retry limits on DCU
280  * @ah: The &struct ath5k_hw
281  * @queue: One of enum ath5k_tx_queue_id
282  *
283  * This function is used when initializing a queue, to set
284  * retry limits based on ah->ah_retry_* and the chipset used.
285  */
286 void
287 ath5k_hw_set_tx_retry_limits(struct ath5k_hw *ah,
288 				  unsigned int queue)
289 {
290 	/* Single data queue on AR5210 */
291 	if (ah->ah_version == AR5K_AR5210) {
292 		struct ath5k_txq_info *tq = &ah->ah_txq[queue];
293 
294 		if (queue > 0)
295 			return;
296 
297 		ath5k_hw_reg_write(ah,
298 			(tq->tqi_cw_min << AR5K_NODCU_RETRY_LMT_CW_MIN_S)
299 			| AR5K_REG_SM(ah->ah_retry_long,
300 				      AR5K_NODCU_RETRY_LMT_SLG_RETRY)
301 			| AR5K_REG_SM(ah->ah_retry_short,
302 				      AR5K_NODCU_RETRY_LMT_SSH_RETRY)
303 			| AR5K_REG_SM(ah->ah_retry_long,
304 				      AR5K_NODCU_RETRY_LMT_LG_RETRY)
305 			| AR5K_REG_SM(ah->ah_retry_short,
306 				      AR5K_NODCU_RETRY_LMT_SH_RETRY),
307 			AR5K_NODCU_RETRY_LMT);
308 	/* DCU on AR5211+ */
309 	} else {
310 		ath5k_hw_reg_write(ah,
311 			AR5K_REG_SM(ah->ah_retry_long,
312 				    AR5K_DCU_RETRY_LMT_RTS)
313 			| AR5K_REG_SM(ah->ah_retry_long,
314 				      AR5K_DCU_RETRY_LMT_STA_RTS)
315 			| AR5K_REG_SM(max(ah->ah_retry_long, ah->ah_retry_short),
316 				      AR5K_DCU_RETRY_LMT_STA_DATA),
317 			AR5K_QUEUE_DFS_RETRY_LIMIT(queue));
318 	}
319 }
320 
321 /**
322  * ath5k_hw_reset_tx_queue() - Initialize a single hw queue
323  * @ah: The &struct ath5k_hw
324  * @queue: One of enum ath5k_tx_queue_id
325  *
326  * Set DCF properties for the given transmit queue on DCU
327  * and configures all queue-specific parameters.
328  */
329 int
330 ath5k_hw_reset_tx_queue(struct ath5k_hw *ah, unsigned int queue)
331 {
332 	struct ath5k_txq_info *tq = &ah->ah_txq[queue];
333 
334 	AR5K_ASSERT_ENTRY(queue, ah->ah_capabilities.cap_queues.q_tx_num);
335 
336 	tq = &ah->ah_txq[queue];
337 
338 	/* Skip if queue inactive or if we are on AR5210
339 	 * that doesn't have QCU/DCU */
340 	if ((ah->ah_version == AR5K_AR5210) ||
341 	(tq->tqi_type == AR5K_TX_QUEUE_INACTIVE))
342 		return 0;
343 
344 	/*
345 	 * Set contention window (cw_min/cw_max)
346 	 * and arbitrated interframe space (aifs)...
347 	 */
348 	ath5k_hw_reg_write(ah,
349 		AR5K_REG_SM(tq->tqi_cw_min, AR5K_DCU_LCL_IFS_CW_MIN) |
350 		AR5K_REG_SM(tq->tqi_cw_max, AR5K_DCU_LCL_IFS_CW_MAX) |
351 		AR5K_REG_SM(tq->tqi_aifs, AR5K_DCU_LCL_IFS_AIFS),
352 		AR5K_QUEUE_DFS_LOCAL_IFS(queue));
353 
354 	/*
355 	 * Set tx retry limits for this queue
356 	 */
357 	ath5k_hw_set_tx_retry_limits(ah, queue);
358 
359 
360 	/*
361 	 * Set misc registers
362 	 */
363 
364 	/* Enable DCU to wait for next fragment from QCU */
365 	AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_DFS_MISC(queue),
366 				AR5K_DCU_MISC_FRAG_WAIT);
367 
368 	/* On Maui and Spirit use the global seqnum on DCU */
369 	if (ah->ah_mac_version < AR5K_SREV_AR5211)
370 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_DFS_MISC(queue),
371 					AR5K_DCU_MISC_SEQNUM_CTL);
372 
373 	/* Constant bit rate period */
374 	if (tq->tqi_cbr_period) {
375 		ath5k_hw_reg_write(ah, AR5K_REG_SM(tq->tqi_cbr_period,
376 					AR5K_QCU_CBRCFG_INTVAL) |
377 					AR5K_REG_SM(tq->tqi_cbr_overflow_limit,
378 					AR5K_QCU_CBRCFG_ORN_THRES),
379 					AR5K_QUEUE_CBRCFG(queue));
380 
381 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
382 					AR5K_QCU_MISC_FRSHED_CBR);
383 
384 		if (tq->tqi_cbr_overflow_limit)
385 			AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
386 					AR5K_QCU_MISC_CBR_THRES_ENABLE);
387 	}
388 
389 	/* Ready time interval */
390 	if (tq->tqi_ready_time && (tq->tqi_type != AR5K_TX_QUEUE_CAB))
391 		ath5k_hw_reg_write(ah, AR5K_REG_SM(tq->tqi_ready_time,
392 					AR5K_QCU_RDYTIMECFG_INTVAL) |
393 					AR5K_QCU_RDYTIMECFG_ENABLE,
394 					AR5K_QUEUE_RDYTIMECFG(queue));
395 
396 	if (tq->tqi_burst_time) {
397 		ath5k_hw_reg_write(ah, AR5K_REG_SM(tq->tqi_burst_time,
398 					AR5K_DCU_CHAN_TIME_DUR) |
399 					AR5K_DCU_CHAN_TIME_ENABLE,
400 					AR5K_QUEUE_DFS_CHANNEL_TIME(queue));
401 
402 		if (tq->tqi_flags & AR5K_TXQ_FLAG_RDYTIME_EXP_POLICY_ENABLE)
403 			AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
404 					AR5K_QCU_MISC_RDY_VEOL_POLICY);
405 	}
406 
407 	/* Enable/disable Post frame backoff */
408 	if (tq->tqi_flags & AR5K_TXQ_FLAG_BACKOFF_DISABLE)
409 		ath5k_hw_reg_write(ah, AR5K_DCU_MISC_POST_FR_BKOFF_DIS,
410 					AR5K_QUEUE_DFS_MISC(queue));
411 
412 	/* Enable/disable fragmentation burst backoff */
413 	if (tq->tqi_flags & AR5K_TXQ_FLAG_FRAG_BURST_BACKOFF_ENABLE)
414 		ath5k_hw_reg_write(ah, AR5K_DCU_MISC_BACKOFF_FRAG,
415 					AR5K_QUEUE_DFS_MISC(queue));
416 
417 	/*
418 	 * Set registers by queue type
419 	 */
420 	switch (tq->tqi_type) {
421 	case AR5K_TX_QUEUE_BEACON:
422 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
423 				AR5K_QCU_MISC_FRSHED_DBA_GT |
424 				AR5K_QCU_MISC_CBREXP_BCN_DIS |
425 				AR5K_QCU_MISC_BCN_ENABLE);
426 
427 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_DFS_MISC(queue),
428 				(AR5K_DCU_MISC_ARBLOCK_CTL_GLOBAL <<
429 				AR5K_DCU_MISC_ARBLOCK_CTL_S) |
430 				AR5K_DCU_MISC_ARBLOCK_IGNORE |
431 				AR5K_DCU_MISC_POST_FR_BKOFF_DIS |
432 				AR5K_DCU_MISC_BCN_ENABLE);
433 		break;
434 
435 	case AR5K_TX_QUEUE_CAB:
436 		/* XXX: use BCN_SENT_GT, if we can figure out how */
437 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
438 					AR5K_QCU_MISC_FRSHED_DBA_GT |
439 					AR5K_QCU_MISC_CBREXP_DIS |
440 					AR5K_QCU_MISC_CBREXP_BCN_DIS);
441 
442 		ath5k_hw_reg_write(ah, ((tq->tqi_ready_time -
443 					(AR5K_TUNE_SW_BEACON_RESP -
444 					AR5K_TUNE_DMA_BEACON_RESP) -
445 				AR5K_TUNE_ADDITIONAL_SWBA_BACKOFF) * 1024) |
446 					AR5K_QCU_RDYTIMECFG_ENABLE,
447 					AR5K_QUEUE_RDYTIMECFG(queue));
448 
449 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_DFS_MISC(queue),
450 					(AR5K_DCU_MISC_ARBLOCK_CTL_GLOBAL <<
451 					AR5K_DCU_MISC_ARBLOCK_CTL_S));
452 		break;
453 
454 	case AR5K_TX_QUEUE_UAPSD:
455 		AR5K_REG_ENABLE_BITS(ah, AR5K_QUEUE_MISC(queue),
456 					AR5K_QCU_MISC_CBREXP_DIS);
457 		break;
458 
459 	case AR5K_TX_QUEUE_DATA:
460 	default:
461 			break;
462 	}
463 
464 	/* TODO: Handle frame compression */
465 
466 	/*
467 	 * Enable interrupts for this tx queue
468 	 * in the secondary interrupt mask registers
469 	 */
470 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXOKINT_ENABLE)
471 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txok, queue);
472 
473 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXERRINT_ENABLE)
474 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txerr, queue);
475 
476 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXURNINT_ENABLE)
477 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txurn, queue);
478 
479 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXDESCINT_ENABLE)
480 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txdesc, queue);
481 
482 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXEOLINT_ENABLE)
483 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_txeol, queue);
484 
485 	if (tq->tqi_flags & AR5K_TXQ_FLAG_CBRORNINT_ENABLE)
486 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_cbrorn, queue);
487 
488 	if (tq->tqi_flags & AR5K_TXQ_FLAG_CBRURNINT_ENABLE)
489 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_cbrurn, queue);
490 
491 	if (tq->tqi_flags & AR5K_TXQ_FLAG_QTRIGINT_ENABLE)
492 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_qtrig, queue);
493 
494 	if (tq->tqi_flags & AR5K_TXQ_FLAG_TXNOFRMINT_ENABLE)
495 		AR5K_Q_ENABLE_BITS(ah->ah_txq_imr_nofrm, queue);
496 
497 	/* Update secondary interrupt mask registers */
498 
499 	/* Filter out inactive queues */
500 	ah->ah_txq_imr_txok &= ah->ah_txq_status;
501 	ah->ah_txq_imr_txerr &= ah->ah_txq_status;
502 	ah->ah_txq_imr_txurn &= ah->ah_txq_status;
503 	ah->ah_txq_imr_txdesc &= ah->ah_txq_status;
504 	ah->ah_txq_imr_txeol &= ah->ah_txq_status;
505 	ah->ah_txq_imr_cbrorn &= ah->ah_txq_status;
506 	ah->ah_txq_imr_cbrurn &= ah->ah_txq_status;
507 	ah->ah_txq_imr_qtrig &= ah->ah_txq_status;
508 	ah->ah_txq_imr_nofrm &= ah->ah_txq_status;
509 
510 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_txok,
511 					AR5K_SIMR0_QCU_TXOK) |
512 					AR5K_REG_SM(ah->ah_txq_imr_txdesc,
513 					AR5K_SIMR0_QCU_TXDESC),
514 					AR5K_SIMR0);
515 
516 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_txerr,
517 					AR5K_SIMR1_QCU_TXERR) |
518 					AR5K_REG_SM(ah->ah_txq_imr_txeol,
519 					AR5K_SIMR1_QCU_TXEOL),
520 					AR5K_SIMR1);
521 
522 	/* Update SIMR2 but don't overwrite rest simr2 settings */
523 	AR5K_REG_DISABLE_BITS(ah, AR5K_SIMR2, AR5K_SIMR2_QCU_TXURN);
524 	AR5K_REG_ENABLE_BITS(ah, AR5K_SIMR2,
525 				AR5K_REG_SM(ah->ah_txq_imr_txurn,
526 				AR5K_SIMR2_QCU_TXURN));
527 
528 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_cbrorn,
529 				AR5K_SIMR3_QCBRORN) |
530 				AR5K_REG_SM(ah->ah_txq_imr_cbrurn,
531 				AR5K_SIMR3_QCBRURN),
532 				AR5K_SIMR3);
533 
534 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_qtrig,
535 				AR5K_SIMR4_QTRIG), AR5K_SIMR4);
536 
537 	/* Set TXNOFRM_QCU for the queues with TXNOFRM enabled */
538 	ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txq_imr_nofrm,
539 				AR5K_TXNOFRM_QCU), AR5K_TXNOFRM);
540 
541 	/* No queue has TXNOFRM enabled, disable the interrupt
542 	 * by setting AR5K_TXNOFRM to zero */
543 	if (ah->ah_txq_imr_nofrm == 0)
544 		ath5k_hw_reg_write(ah, 0, AR5K_TXNOFRM);
545 
546 	/* Set QCU mask for this DCU to save power */
547 	AR5K_REG_WRITE_Q(ah, AR5K_QUEUE_QCUMASK(queue), queue);
548 
549 	return 0;
550 }
551 
552 
553 /**************************\
554 * Global QCU/DCU functions *
555 \**************************/
556 
557 /**
558  * ath5k_hw_set_ifs_intervals()  - Set global inter-frame spaces on DCU
559  * @ah: The &struct ath5k_hw
560  * @slot_time: Slot time in us
561  *
562  * Sets the global IFS intervals on DCU (also works on AR5210) for
563  * the given slot time and the current bwmode.
564  */
565 int ath5k_hw_set_ifs_intervals(struct ath5k_hw *ah, unsigned int slot_time)
566 {
567 	struct ieee80211_channel *channel = ah->ah_current_channel;
568 	enum ieee80211_band band;
569 	struct ieee80211_supported_band *sband;
570 	struct ieee80211_rate *rate;
571 	u32 ack_tx_time, eifs, eifs_clock, sifs, sifs_clock;
572 	u32 slot_time_clock = ath5k_hw_htoclock(ah, slot_time);
573 	u32 rate_flags, i;
574 
575 	if (slot_time < 6 || slot_time_clock > AR5K_SLOT_TIME_MAX)
576 		return -EINVAL;
577 
578 	sifs = ath5k_hw_get_default_sifs(ah);
579 	sifs_clock = ath5k_hw_htoclock(ah, sifs - 2);
580 
581 	/* EIFS
582 	 * Txtime of ack at lowest rate + SIFS + DIFS
583 	 * (DIFS = SIFS + 2 * Slot time)
584 	 *
585 	 * Note: HAL has some predefined values for EIFS
586 	 * Turbo:   (37 + 2 * 6)
587 	 * Default: (74 + 2 * 9)
588 	 * Half:    (149 + 2 * 13)
589 	 * Quarter: (298 + 2 * 21)
590 	 *
591 	 * (74 + 2 * 6) for AR5210 default and turbo !
592 	 *
593 	 * According to the formula we have
594 	 * ack_tx_time = 25 for turbo and
595 	 * ack_tx_time = 42.5 * clock multiplier
596 	 * for default/half/quarter.
597 	 *
598 	 * This can't be right, 42 is what we would get
599 	 * from ath5k_hw_get_frame_dur_for_bwmode or
600 	 * ieee80211_generic_frame_duration for zero frame
601 	 * length and without SIFS !
602 	 *
603 	 * Also we have different lowest rate for 802.11a
604 	 */
605 	if (channel->band == IEEE80211_BAND_5GHZ)
606 		band = IEEE80211_BAND_5GHZ;
607 	else
608 		band = IEEE80211_BAND_2GHZ;
609 
610 	switch (ah->ah_bwmode) {
611 	case AR5K_BWMODE_5MHZ:
612 		rate_flags = IEEE80211_RATE_SUPPORTS_5MHZ;
613 		break;
614 	case AR5K_BWMODE_10MHZ:
615 		rate_flags = IEEE80211_RATE_SUPPORTS_10MHZ;
616 		break;
617 	default:
618 		rate_flags = 0;
619 		break;
620 	}
621 	sband = &ah->sbands[band];
622 	rate = NULL;
623 	for (i = 0; i < sband->n_bitrates; i++) {
624 		if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
625 			continue;
626 		rate = &sband->bitrates[i];
627 		break;
628 	}
629 	if (WARN_ON(!rate))
630 		return -EINVAL;
631 
632 	ack_tx_time = ath5k_hw_get_frame_duration(ah, band, 10, rate, false);
633 
634 	/* ack_tx_time includes an SIFS already */
635 	eifs = ack_tx_time + sifs + 2 * slot_time;
636 	eifs_clock = ath5k_hw_htoclock(ah, eifs);
637 
638 	/* Set IFS settings on AR5210 */
639 	if (ah->ah_version == AR5K_AR5210) {
640 		u32 pifs, pifs_clock, difs, difs_clock;
641 
642 		/* Set slot time */
643 		ath5k_hw_reg_write(ah, slot_time_clock, AR5K_SLOT_TIME);
644 
645 		/* Set EIFS */
646 		eifs_clock = AR5K_REG_SM(eifs_clock, AR5K_IFS1_EIFS);
647 
648 		/* PIFS = Slot time + SIFS */
649 		pifs = slot_time + sifs;
650 		pifs_clock = ath5k_hw_htoclock(ah, pifs);
651 		pifs_clock = AR5K_REG_SM(pifs_clock, AR5K_IFS1_PIFS);
652 
653 		/* DIFS = SIFS + 2 * Slot time */
654 		difs = sifs + 2 * slot_time;
655 		difs_clock = ath5k_hw_htoclock(ah, difs);
656 
657 		/* Set SIFS/DIFS */
658 		ath5k_hw_reg_write(ah, (difs_clock <<
659 				AR5K_IFS0_DIFS_S) | sifs_clock,
660 				AR5K_IFS0);
661 
662 		/* Set PIFS/EIFS and preserve AR5K_INIT_CARR_SENSE_EN */
663 		ath5k_hw_reg_write(ah, pifs_clock | eifs_clock |
664 				(AR5K_INIT_CARR_SENSE_EN << AR5K_IFS1_CS_EN_S),
665 				AR5K_IFS1);
666 
667 		return 0;
668 	}
669 
670 	/* Set IFS slot time */
671 	ath5k_hw_reg_write(ah, slot_time_clock, AR5K_DCU_GBL_IFS_SLOT);
672 
673 	/* Set EIFS interval */
674 	ath5k_hw_reg_write(ah, eifs_clock, AR5K_DCU_GBL_IFS_EIFS);
675 
676 	/* Set SIFS interval in usecs */
677 	AR5K_REG_WRITE_BITS(ah, AR5K_DCU_GBL_IFS_MISC,
678 				AR5K_DCU_GBL_IFS_MISC_SIFS_DUR_USEC,
679 				sifs);
680 
681 	/* Set SIFS interval in clock cycles */
682 	ath5k_hw_reg_write(ah, sifs_clock, AR5K_DCU_GBL_IFS_SIFS);
683 
684 	return 0;
685 }
686 
687 
688 /**
689  * ath5k_hw_init_queues() - Initialize tx queues
690  * @ah: The &struct ath5k_hw
691  *
692  * Initializes all tx queues based on information on
693  * ah->ah_txq* set by the driver
694  */
695 int
696 ath5k_hw_init_queues(struct ath5k_hw *ah)
697 {
698 	int i, ret;
699 
700 	/* TODO: HW Compression support for data queues */
701 	/* TODO: Burst prefetch for data queues */
702 
703 	/*
704 	 * Reset queues and start beacon timers at the end of the reset routine
705 	 * This also sets QCU mask on each DCU for 1:1 qcu to dcu mapping
706 	 * Note: If we want we can assign multiple qcus on one dcu.
707 	 */
708 	if (ah->ah_version != AR5K_AR5210)
709 		for (i = 0; i < ah->ah_capabilities.cap_queues.q_tx_num; i++) {
710 			ret = ath5k_hw_reset_tx_queue(ah, i);
711 			if (ret) {
712 				ATH5K_ERR(ah,
713 					"failed to reset TX queue #%d\n", i);
714 				return ret;
715 			}
716 		}
717 	else
718 		/* No QCU/DCU on AR5210, just set tx
719 		 * retry limits. We set IFS parameters
720 		 * on ath5k_hw_set_ifs_intervals */
721 		ath5k_hw_set_tx_retry_limits(ah, 0);
722 
723 	/* Set the turbo flag when operating on 40MHz */
724 	if (ah->ah_bwmode == AR5K_BWMODE_40MHZ)
725 		AR5K_REG_ENABLE_BITS(ah, AR5K_DCU_GBL_IFS_MISC,
726 				AR5K_DCU_GBL_IFS_MISC_TURBO_MODE);
727 
728 	/* If we didn't set IFS timings through
729 	 * ath5k_hw_set_coverage_class make sure
730 	 * we set them here */
731 	if (!ah->ah_coverage_class) {
732 		unsigned int slot_time = ath5k_hw_get_default_slottime(ah);
733 		ath5k_hw_set_ifs_intervals(ah, slot_time);
734 	}
735 
736 	return 0;
737 }
738