Commit | Line | Data |
---|---|---|
b481de9c ZY |
1 | /****************************************************************************** |
2 | * | |
901069c7 | 3 | * Copyright(c) 2003 - 2011 Intel Corporation. All rights reserved. |
b481de9c ZY |
4 | * |
5 | * Portions of this file are derived from the ipw3945 project, as well | |
6 | * as portions of the ieee80211 subsystem header files. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify it | |
9 | * under the terms of version 2 of the GNU General Public License as | |
10 | * published by the Free Software Foundation. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
13 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
14 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
15 | * more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License along with | |
18 | * this program; if not, write to the Free Software Foundation, Inc., | |
19 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA | |
20 | * | |
21 | * The full GNU General Public License is included in this distribution in the | |
22 | * file called LICENSE. | |
23 | * | |
24 | * Contact Information: | |
759ef89f | 25 | * Intel Linux Wireless <ilw@linux.intel.com> |
b481de9c ZY |
26 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
27 | * | |
28 | *****************************************************************************/ | |
29 | ||
30 | #ifndef __iwl_helpers_h__ | |
31 | #define __iwl_helpers_h__ | |
32 | ||
33 | #include <linux/ctype.h> | |
a1175124 JB |
34 | #include <net/mac80211.h> |
35 | ||
36 | #include "iwl-io.h" | |
b481de9c | 37 | |
da1bc453 TW |
38 | #define IWL_MASK(lo, hi) ((1 << (hi)) | ((1 << (hi)) - (1 << (lo)))) |
39 | ||
b481de9c | 40 | |
b481de9c ZY |
41 | static inline struct ieee80211_conf *ieee80211_get_hw_conf( |
42 | struct ieee80211_hw *hw) | |
43 | { | |
44 | return &hw->conf; | |
45 | } | |
46 | ||
c54b679d TW |
47 | /** |
48 | * iwl_queue_inc_wrap - increment queue index, wrap back to beginning | |
49 | * @index -- current index | |
50 | * @n_bd -- total number of entries in queue (must be power of 2) | |
51 | */ | |
52 | static inline int iwl_queue_inc_wrap(int index, int n_bd) | |
53 | { | |
54 | return ++index & (n_bd - 1); | |
55 | } | |
56 | ||
57 | /** | |
58 | * iwl_queue_dec_wrap - decrement queue index, wrap back to end | |
59 | * @index -- current index | |
60 | * @n_bd -- total number of entries in queue (must be power of 2) | |
61 | */ | |
62 | static inline int iwl_queue_dec_wrap(int index, int n_bd) | |
63 | { | |
64 | return --index & (n_bd - 1); | |
65 | } | |
66 | ||
e4e72fb4 JB |
67 | /* |
68 | * we have 8 bits used like this: | |
69 | * | |
70 | * 7 6 5 4 3 2 1 0 | |
71 | * | | | | | | | | | |
72 | * | | | | | | +-+-------- AC queue (0-3) | |
73 | * | | | | | | | |
ea9b307f | 74 | * | +-+-+-+-+------------ HW queue ID |
e4e72fb4 | 75 | * | |
ea9b307f | 76 | * +---------------------- unused |
e4e72fb4 | 77 | */ |
ea9b307f | 78 | static inline void iwl_set_swq_id(struct iwl_tx_queue *txq, u8 ac, u8 hwq) |
e4e72fb4 JB |
79 | { |
80 | BUG_ON(ac > 3); /* only have 2 bits */ | |
ea9b307f | 81 | BUG_ON(hwq > 31); /* only use 5 bits */ |
e4e72fb4 | 82 | |
ea9b307f | 83 | txq->swq_id = (hwq << 2) | ac; |
e4e72fb4 JB |
84 | } |
85 | ||
549a04e0 JB |
86 | static inline void iwl_wake_queue(struct iwl_priv *priv, |
87 | struct iwl_tx_queue *txq) | |
e4e72fb4 | 88 | { |
549a04e0 | 89 | u8 queue = txq->swq_id; |
ea9b307f JB |
90 | u8 ac = queue & 3; |
91 | u8 hwq = (queue >> 2) & 0x1f; | |
e4e72fb4 | 92 | |
a0eaad71 EG |
93 | if (unlikely(!priv->mac80211_registered)) |
94 | return; | |
95 | ||
e4e72fb4 JB |
96 | if (test_and_clear_bit(hwq, priv->queue_stopped)) |
97 | if (atomic_dec_return(&priv->queue_stop_count[ac]) <= 0) | |
98 | ieee80211_wake_queue(priv->hw, ac); | |
99 | } | |
100 | ||
549a04e0 JB |
101 | static inline void iwl_stop_queue(struct iwl_priv *priv, |
102 | struct iwl_tx_queue *txq) | |
e4e72fb4 | 103 | { |
549a04e0 | 104 | u8 queue = txq->swq_id; |
ea9b307f JB |
105 | u8 ac = queue & 3; |
106 | u8 hwq = (queue >> 2) & 0x1f; | |
e4e72fb4 | 107 | |
a0eaad71 EG |
108 | if (unlikely(!priv->mac80211_registered)) |
109 | return; | |
110 | ||
e4e72fb4 JB |
111 | if (!test_and_set_bit(hwq, priv->queue_stopped)) |
112 | if (atomic_inc_return(&priv->queue_stop_count[ac]) > 0) | |
113 | ieee80211_stop_queue(priv->hw, ac); | |
114 | } | |
115 | ||
68b99311 GT |
116 | static inline void iwl_wake_any_queue(struct iwl_priv *priv, |
117 | struct iwl_rxon_context *ctx) | |
118 | { | |
119 | u8 ac; | |
120 | ||
121 | for (ac = 0; ac < AC_NUM; ac++) { | |
122 | IWL_DEBUG_INFO(priv, "Queue Status: Q[%d] %s\n", | |
123 | ac, (atomic_read(&priv->queue_stop_count[ac]) > 0) | |
124 | ? "stopped" : "awake"); | |
125 | iwl_wake_queue(priv, &priv->txq[ctx->ac_to_queue[ac]]); | |
126 | } | |
127 | } | |
128 | ||
47751b0f KV |
129 | #ifdef ieee80211_stop_queue |
130 | #undef ieee80211_stop_queue | |
131 | #endif | |
132 | ||
e4e72fb4 | 133 | #define ieee80211_stop_queue DO_NOT_USE_ieee80211_stop_queue |
47751b0f KV |
134 | |
135 | #ifdef ieee80211_wake_queue | |
136 | #undef ieee80211_wake_queue | |
137 | #endif | |
138 | ||
e4e72fb4 JB |
139 | #define ieee80211_wake_queue DO_NOT_USE_ieee80211_wake_queue |
140 | ||
554d1d02 SG |
141 | static inline void iwl_enable_rfkill_int(struct iwl_priv *priv) |
142 | { | |
143 | IWL_DEBUG_ISR(priv, "Enabling rfkill interrupt\n"); | |
144 | iwl_write32(priv, CSR_INT_MASK, CSR_INT_BIT_RF_KILL); | |
145 | } | |
146 | ||
a0ee74cf WYG |
147 | /** |
148 | * iwl_beacon_time_mask_low - mask of lower 32 bit of beacon time | |
149 | * @priv -- pointer to iwl_priv data structure | |
150 | * @tsf_bits -- number of bits need to shift for masking) | |
151 | */ | |
152 | static inline u32 iwl_beacon_time_mask_low(struct iwl_priv *priv, | |
153 | u16 tsf_bits) | |
154 | { | |
155 | return (1 << tsf_bits) - 1; | |
156 | } | |
157 | ||
158 | /** | |
159 | * iwl_beacon_time_mask_high - mask of higher 32 bit of beacon time | |
160 | * @priv -- pointer to iwl_priv data structure | |
161 | * @tsf_bits -- number of bits need to shift for masking) | |
162 | */ | |
163 | static inline u32 iwl_beacon_time_mask_high(struct iwl_priv *priv, | |
164 | u16 tsf_bits) | |
165 | { | |
166 | return ((1 << (32 - tsf_bits)) - 1) << tsf_bits; | |
167 | } | |
168 | ||
b481de9c | 169 | #endif /* __iwl_helpers_h__ */ |