1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28#include <linux/delay.h>
29#include <linux/device.h>
30#include <linux/export.h>
31
32#include "iwl-drv.h"
33#include "iwl-io.h"
34#include "iwl-csr.h"
35#include "iwl-debug.h"
36#include "iwl-prph.h"
37#include "iwl-fh.h"
38
39#define IWL_POLL_INTERVAL 10
40
41int iwl_poll_bit(struct iwl_trans *trans, u32 addr,
42 u32 bits, u32 mask, int timeout)
43{
44 int t = 0;
45
46 do {
47 if ((iwl_read32(trans, addr) & mask) == (bits & mask))
48 return t;
49 udelay(IWL_POLL_INTERVAL);
50 t += IWL_POLL_INTERVAL;
51 } while (t < timeout);
52
53 return -ETIMEDOUT;
54}
55IWL_EXPORT_SYMBOL(iwl_poll_bit);
56
57u32 iwl_read_direct32(struct iwl_trans *trans, u32 reg)
58{
59 u32 value = 0x5a5a5a5a;
60 unsigned long flags;
61 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
62 value = iwl_read32(trans, reg);
63 iwl_trans_release_nic_access(trans, &flags);
64 }
65
66 return value;
67}
68IWL_EXPORT_SYMBOL(iwl_read_direct32);
69
70void iwl_write_direct32(struct iwl_trans *trans, u32 reg, u32 value)
71{
72 unsigned long flags;
73
74 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
75 iwl_write32(trans, reg, value);
76 iwl_trans_release_nic_access(trans, &flags);
77 }
78}
79IWL_EXPORT_SYMBOL(iwl_write_direct32);
80
81int iwl_poll_direct_bit(struct iwl_trans *trans, u32 addr, u32 mask,
82 int timeout)
83{
84 int t = 0;
85
86 do {
87 if ((iwl_read_direct32(trans, addr) & mask) == mask)
88 return t;
89 udelay(IWL_POLL_INTERVAL);
90 t += IWL_POLL_INTERVAL;
91 } while (t < timeout);
92
93 return -ETIMEDOUT;
94}
95IWL_EXPORT_SYMBOL(iwl_poll_direct_bit);
96
97u32 __iwl_read_prph(struct iwl_trans *trans, u32 ofs)
98{
99 u32 val = iwl_trans_read_prph(trans, ofs);
100 trace_iwlwifi_dev_ioread_prph32(trans->dev, ofs, val);
101 return val;
102}
103
104void __iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val)
105{
106 trace_iwlwifi_dev_iowrite_prph32(trans->dev, ofs, val);
107 iwl_trans_write_prph(trans, ofs, val);
108}
109
110u32 iwl_read_prph(struct iwl_trans *trans, u32 ofs)
111{
112 unsigned long flags;
113 u32 val = 0x5a5a5a5a;
114
115 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
116 val = __iwl_read_prph(trans, ofs);
117 iwl_trans_release_nic_access(trans, &flags);
118 }
119 return val;
120}
121IWL_EXPORT_SYMBOL(iwl_read_prph);
122
123void iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val)
124{
125 unsigned long flags;
126
127 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
128 __iwl_write_prph(trans, ofs, val);
129 iwl_trans_release_nic_access(trans, &flags);
130 }
131}
132IWL_EXPORT_SYMBOL(iwl_write_prph);
133
134int iwl_poll_prph_bit(struct iwl_trans *trans, u32 addr,
135 u32 bits, u32 mask, int timeout)
136{
137 int t = 0;
138
139 do {
140 if ((iwl_read_prph(trans, addr) & mask) == (bits & mask))
141 return t;
142 udelay(IWL_POLL_INTERVAL);
143 t += IWL_POLL_INTERVAL;
144 } while (t < timeout);
145
146 return -ETIMEDOUT;
147}
148
149void iwl_set_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask)
150{
151 unsigned long flags;
152
153 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
154 __iwl_write_prph(trans, ofs,
155 __iwl_read_prph(trans, ofs) | mask);
156 iwl_trans_release_nic_access(trans, &flags);
157 }
158}
159IWL_EXPORT_SYMBOL(iwl_set_bits_prph);
160
161void iwl_set_bits_mask_prph(struct iwl_trans *trans, u32 ofs,
162 u32 bits, u32 mask)
163{
164 unsigned long flags;
165
166 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
167 __iwl_write_prph(trans, ofs,
168 (__iwl_read_prph(trans, ofs) & mask) | bits);
169 iwl_trans_release_nic_access(trans, &flags);
170 }
171}
172IWL_EXPORT_SYMBOL(iwl_set_bits_mask_prph);
173
174void iwl_clear_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask)
175{
176 unsigned long flags;
177 u32 val;
178
179 if (iwl_trans_grab_nic_access(trans, false, &flags)) {
180 val = __iwl_read_prph(trans, ofs);
181 __iwl_write_prph(trans, ofs, (val & ~mask));
182 iwl_trans_release_nic_access(trans, &flags);
183 }
184}
185IWL_EXPORT_SYMBOL(iwl_clear_bits_prph);
186
187void iwl_force_nmi(struct iwl_trans *trans)
188{
189
190
191
192
193
194
195 if ((trans->cfg->device_family != IWL_DEVICE_FAMILY_8000) ||
196 (CSR_HW_REV_STEP(trans->hw_rev) == SILICON_A_STEP))
197 iwl_write_prph(trans, DEVICE_SET_NMI_REG, DEVICE_SET_NMI_VAL);
198 else
199 iwl_write_prph(trans, DEVICE_SET_NMI_8000B_REG,
200 DEVICE_SET_NMI_8000B_VAL);
201}
202IWL_EXPORT_SYMBOL(iwl_force_nmi);
203
204static const char *get_fh_string(int cmd)
205{
206#define IWL_CMD(x) case x: return #x
207 switch (cmd) {
208 IWL_CMD(FH_RSCSR_CHNL0_STTS_WPTR_REG);
209 IWL_CMD(FH_RSCSR_CHNL0_RBDCB_BASE_REG);
210 IWL_CMD(FH_RSCSR_CHNL0_WPTR);
211 IWL_CMD(FH_MEM_RCSR_CHNL0_CONFIG_REG);
212 IWL_CMD(FH_MEM_RSSR_SHARED_CTRL_REG);
213 IWL_CMD(FH_MEM_RSSR_RX_STATUS_REG);
214 IWL_CMD(FH_MEM_RSSR_RX_ENABLE_ERR_IRQ2DRV);
215 IWL_CMD(FH_TSSR_TX_STATUS_REG);
216 IWL_CMD(FH_TSSR_TX_ERROR_REG);
217 default:
218 return "UNKNOWN";
219 }
220#undef IWL_CMD
221}
222
223int iwl_dump_fh(struct iwl_trans *trans, char **buf)
224{
225 int i;
226 static const u32 fh_tbl[] = {
227 FH_RSCSR_CHNL0_STTS_WPTR_REG,
228 FH_RSCSR_CHNL0_RBDCB_BASE_REG,
229 FH_RSCSR_CHNL0_WPTR,
230 FH_MEM_RCSR_CHNL0_CONFIG_REG,
231 FH_MEM_RSSR_SHARED_CTRL_REG,
232 FH_MEM_RSSR_RX_STATUS_REG,
233 FH_MEM_RSSR_RX_ENABLE_ERR_IRQ2DRV,
234 FH_TSSR_TX_STATUS_REG,
235 FH_TSSR_TX_ERROR_REG
236 };
237
238#ifdef CONFIG_IWLWIFI_DEBUGFS
239 if (buf) {
240 int pos = 0;
241 size_t bufsz = ARRAY_SIZE(fh_tbl) * 48 + 40;
242
243 *buf = kmalloc(bufsz, GFP_KERNEL);
244 if (!*buf)
245 return -ENOMEM;
246
247 pos += scnprintf(*buf + pos, bufsz - pos,
248 "FH register values:\n");
249
250 for (i = 0; i < ARRAY_SIZE(fh_tbl); i++)
251 pos += scnprintf(*buf + pos, bufsz - pos,
252 " %34s: 0X%08x\n",
253 get_fh_string(fh_tbl[i]),
254 iwl_read_direct32(trans, fh_tbl[i]));
255
256 return pos;
257 }
258#endif
259
260 IWL_ERR(trans, "FH register values:\n");
261 for (i = 0; i < ARRAY_SIZE(fh_tbl); i++)
262 IWL_ERR(trans, " %34s: 0X%08x\n",
263 get_fh_string(fh_tbl[i]),
264 iwl_read_direct32(trans, fh_tbl[i]));
265
266 return 0;
267}
268
