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
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62#include <linux/types.h>
63#include <linux/slab.h>
64#include <linux/export.h>
65
66#include "iwl-drv.h"
67#include "iwl-debug.h"
68#include "iwl-eeprom-read.h"
69#include "iwl-io.h"
70#include "iwl-prph.h"
71#include "iwl-csr.h"
72
73
74
75
76
77
78
79
80
81#define IWL_EEPROM_ACCESS_TIMEOUT 5000
82
83#define IWL_EEPROM_SEM_TIMEOUT 10
84#define IWL_EEPROM_SEM_RETRY_LIMIT 1000
85
86
87
88
89
90
91
92
93
94#define EEPROM_SEM_TIMEOUT 10
95#define EEPROM_SEM_RETRY_LIMIT 1000
96
97static int iwl_eeprom_acquire_semaphore(struct iwl_trans *trans)
98{
99 u16 count;
100 int ret;
101
102 for (count = 0; count < EEPROM_SEM_RETRY_LIMIT; count++) {
103
104 iwl_set_bit(trans, CSR_HW_IF_CONFIG_REG,
105 CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM);
106
107
108 ret = iwl_poll_bit(trans, CSR_HW_IF_CONFIG_REG,
109 CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM,
110 CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM,
111 EEPROM_SEM_TIMEOUT);
112 if (ret >= 0) {
113 IWL_DEBUG_EEPROM(trans->dev,
114 "Acquired semaphore after %d tries.\n",
115 count+1);
116 return ret;
117 }
118 }
119
120 return ret;
121}
122
123static void iwl_eeprom_release_semaphore(struct iwl_trans *trans)
124{
125 iwl_clear_bit(trans, CSR_HW_IF_CONFIG_REG,
126 CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM);
127}
128
129static int iwl_eeprom_verify_signature(struct iwl_trans *trans, bool nvm_is_otp)
130{
131 u32 gp = iwl_read32(trans, CSR_EEPROM_GP) & CSR_EEPROM_GP_VALID_MSK;
132
133 IWL_DEBUG_EEPROM(trans->dev, "EEPROM signature=0x%08x\n", gp);
134
135 switch (gp) {
136 case CSR_EEPROM_GP_BAD_SIG_EEP_GOOD_SIG_OTP:
137 if (!nvm_is_otp) {
138 IWL_ERR(trans, "EEPROM with bad signature: 0x%08x\n",
139 gp);
140 return -ENOENT;
141 }
142 return 0;
143 case CSR_EEPROM_GP_GOOD_SIG_EEP_LESS_THAN_4K:
144 case CSR_EEPROM_GP_GOOD_SIG_EEP_MORE_THAN_4K:
145 if (nvm_is_otp) {
146 IWL_ERR(trans, "OTP with bad signature: 0x%08x\n", gp);
147 return -ENOENT;
148 }
149 return 0;
150 case CSR_EEPROM_GP_BAD_SIGNATURE_BOTH_EEP_AND_OTP:
151 default:
152 IWL_ERR(trans,
153 "bad EEPROM/OTP signature, type=%s, EEPROM_GP=0x%08x\n",
154 nvm_is_otp ? "OTP" : "EEPROM", gp);
155 return -ENOENT;
156 }
157}
158
159
160
161
162
163
164
165static void iwl_set_otp_access_absolute(struct iwl_trans *trans)
166{
167 iwl_read32(trans, CSR_OTP_GP_REG);
168
169 iwl_clear_bit(trans, CSR_OTP_GP_REG,
170 CSR_OTP_GP_REG_OTP_ACCESS_MODE);
171}
172
173static int iwl_nvm_is_otp(struct iwl_trans *trans)
174{
175 u32 otpgp;
176
177
178 switch (trans->hw_rev & CSR_HW_REV_TYPE_MSK) {
179 case CSR_HW_REV_TYPE_NONE:
180 IWL_ERR(trans, "Unknown hardware type\n");
181 return -EIO;
182 case CSR_HW_REV_TYPE_5300:
183 case CSR_HW_REV_TYPE_5350:
184 case CSR_HW_REV_TYPE_5100:
185 case CSR_HW_REV_TYPE_5150:
186 return 0;
187 default:
188 otpgp = iwl_read32(trans, CSR_OTP_GP_REG);
189 if (otpgp & CSR_OTP_GP_REG_DEVICE_SELECT)
190 return 1;
191 return 0;
192 }
193}
194
195static int iwl_init_otp_access(struct iwl_trans *trans)
196{
197 int ret;
198
199
200 iwl_write32(trans, CSR_GP_CNTRL,
201 iwl_read32(trans, CSR_GP_CNTRL) |
202 CSR_GP_CNTRL_REG_FLAG_INIT_DONE);
203
204
205 ret = iwl_poll_bit(trans, CSR_GP_CNTRL,
206 CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY,
207 CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY,
208 25000);
209 if (ret < 0) {
210 IWL_ERR(trans, "Time out access OTP\n");
211 } else {
212 iwl_set_bits_prph(trans, APMG_PS_CTRL_REG,
213 APMG_PS_CTRL_VAL_RESET_REQ);
214 udelay(5);
215 iwl_clear_bits_prph(trans, APMG_PS_CTRL_REG,
216 APMG_PS_CTRL_VAL_RESET_REQ);
217
218
219
220
221
222 if (trans->cfg->base_params->shadow_ram_support)
223 iwl_set_bit(trans, CSR_DBG_LINK_PWR_MGMT_REG,
224 CSR_RESET_LINK_PWR_MGMT_DISABLED);
225 }
226 return ret;
227}
228
229static int iwl_read_otp_word(struct iwl_trans *trans, u16 addr,
230 __le16 *eeprom_data)
231{
232 int ret = 0;
233 u32 r;
234 u32 otpgp;
235
236 iwl_write32(trans, CSR_EEPROM_REG,
237 CSR_EEPROM_REG_MSK_ADDR & (addr << 1));
238 ret = iwl_poll_bit(trans, CSR_EEPROM_REG,
239 CSR_EEPROM_REG_READ_VALID_MSK,
240 CSR_EEPROM_REG_READ_VALID_MSK,
241 IWL_EEPROM_ACCESS_TIMEOUT);
242 if (ret < 0) {
243 IWL_ERR(trans, "Time out reading OTP[%d]\n", addr);
244 return ret;
245 }
246 r = iwl_read32(trans, CSR_EEPROM_REG);
247
248 otpgp = iwl_read32(trans, CSR_OTP_GP_REG);
249 if (otpgp & CSR_OTP_GP_REG_ECC_UNCORR_STATUS_MSK) {
250
251
252 iwl_set_bit(trans, CSR_OTP_GP_REG,
253 CSR_OTP_GP_REG_ECC_UNCORR_STATUS_MSK);
254 IWL_ERR(trans, "Uncorrectable OTP ECC error, abort OTP read\n");
255 return -EINVAL;
256 }
257 if (otpgp & CSR_OTP_GP_REG_ECC_CORR_STATUS_MSK) {
258
259
260 iwl_set_bit(trans, CSR_OTP_GP_REG,
261 CSR_OTP_GP_REG_ECC_CORR_STATUS_MSK);
262 IWL_ERR(trans, "Correctable OTP ECC error, continue read\n");
263 }
264 *eeprom_data = cpu_to_le16(r >> 16);
265 return 0;
266}
267
268
269
270
271static bool iwl_is_otp_empty(struct iwl_trans *trans)
272{
273 u16 next_link_addr = 0;
274 __le16 link_value;
275 bool is_empty = false;
276
277
278 if (!iwl_read_otp_word(trans, next_link_addr, &link_value)) {
279 if (!link_value) {
280 IWL_ERR(trans, "OTP is empty\n");
281 is_empty = true;
282 }
283 } else {
284 IWL_ERR(trans, "Unable to read first block of OTP list.\n");
285 is_empty = true;
286 }
287
288 return is_empty;
289}
290
291
292
293
294
295
296
297
298
299
300
301static int iwl_find_otp_image(struct iwl_trans *trans,
302 u16 *validblockaddr)
303{
304 u16 next_link_addr = 0, valid_addr;
305 __le16 link_value = 0;
306 int usedblocks = 0;
307
308
309 iwl_set_otp_access_absolute(trans);
310
311
312 if (iwl_is_otp_empty(trans))
313 return -EINVAL;
314
315
316
317
318
319
320 do {
321
322
323
324 valid_addr = next_link_addr;
325 next_link_addr = le16_to_cpu(link_value) * sizeof(u16);
326 IWL_DEBUG_EEPROM(trans->dev, "OTP blocks %d addr 0x%x\n",
327 usedblocks, next_link_addr);
328 if (iwl_read_otp_word(trans, next_link_addr, &link_value))
329 return -EINVAL;
330 if (!link_value) {
331
332
333
334
335
336 *validblockaddr = valid_addr;
337
338 *validblockaddr += 2;
339 return 0;
340 }
341
342 usedblocks++;
343 } while (usedblocks <= trans->cfg->base_params->max_ll_items);
344
345
346 IWL_DEBUG_EEPROM(trans->dev, "OTP has no valid blocks\n");
347 return -EINVAL;
348}
349
350
351
352
353
354
355
356
357
358int iwl_read_eeprom(struct iwl_trans *trans, u8 **eeprom, size_t *eeprom_size)
359{
360 __le16 *e;
361 u32 gp = iwl_read32(trans, CSR_EEPROM_GP);
362 int sz;
363 int ret;
364 u16 addr;
365 u16 validblockaddr = 0;
366 u16 cache_addr = 0;
367 int nvm_is_otp;
368
369 if (!eeprom || !eeprom_size)
370 return -EINVAL;
371
372 nvm_is_otp = iwl_nvm_is_otp(trans);
373 if (nvm_is_otp < 0)
374 return nvm_is_otp;
375
376 sz = trans->cfg->base_params->eeprom_size;
377 IWL_DEBUG_EEPROM(trans->dev, "NVM size = %d\n", sz);
378
379 e = kmalloc(sz, GFP_KERNEL);
380 if (!e)
381 return -ENOMEM;
382
383 ret = iwl_eeprom_verify_signature(trans, nvm_is_otp);
384 if (ret < 0) {
385 IWL_ERR(trans, "EEPROM not found, EEPROM_GP=0x%08x\n", gp);
386 goto err_free;
387 }
388
389
390 ret = iwl_eeprom_acquire_semaphore(trans);
391 if (ret < 0) {
392 IWL_ERR(trans, "Failed to acquire EEPROM semaphore.\n");
393 goto err_free;
394 }
395
396 if (nvm_is_otp) {
397 ret = iwl_init_otp_access(trans);
398 if (ret) {
399 IWL_ERR(trans, "Failed to initialize OTP access.\n");
400 goto err_unlock;
401 }
402
403 iwl_write32(trans, CSR_EEPROM_GP,
404 iwl_read32(trans, CSR_EEPROM_GP) &
405 ~CSR_EEPROM_GP_IF_OWNER_MSK);
406
407 iwl_set_bit(trans, CSR_OTP_GP_REG,
408 CSR_OTP_GP_REG_ECC_CORR_STATUS_MSK |
409 CSR_OTP_GP_REG_ECC_UNCORR_STATUS_MSK);
410
411 if (!trans->cfg->base_params->shadow_ram_support) {
412 ret = iwl_find_otp_image(trans, &validblockaddr);
413 if (ret)
414 goto err_unlock;
415 }
416 for (addr = validblockaddr; addr < validblockaddr + sz;
417 addr += sizeof(u16)) {
418 __le16 eeprom_data;
419
420 ret = iwl_read_otp_word(trans, addr, &eeprom_data);
421 if (ret)
422 goto err_unlock;
423 e[cache_addr / 2] = eeprom_data;
424 cache_addr += sizeof(u16);
425 }
426 } else {
427
428 for (addr = 0; addr < sz; addr += sizeof(u16)) {
429 u32 r;
430
431 iwl_write32(trans, CSR_EEPROM_REG,
432 CSR_EEPROM_REG_MSK_ADDR & (addr << 1));
433
434 ret = iwl_poll_bit(trans, CSR_EEPROM_REG,
435 CSR_EEPROM_REG_READ_VALID_MSK,
436 CSR_EEPROM_REG_READ_VALID_MSK,
437 IWL_EEPROM_ACCESS_TIMEOUT);
438 if (ret < 0) {
439 IWL_ERR(trans,
440 "Time out reading EEPROM[%d]\n", addr);
441 goto err_unlock;
442 }
443 r = iwl_read32(trans, CSR_EEPROM_REG);
444 e[addr / 2] = cpu_to_le16(r >> 16);
445 }
446 }
447
448 IWL_DEBUG_EEPROM(trans->dev, "NVM Type: %s\n",
449 nvm_is_otp ? "OTP" : "EEPROM");
450
451 iwl_eeprom_release_semaphore(trans);
452
453 *eeprom_size = sz;
454 *eeprom = (u8 *)e;
455 return 0;
456
457 err_unlock:
458 iwl_eeprom_release_semaphore(trans);
459 err_free:
460 kfree(e);
461
462 return ret;
463}
464IWL_EXPORT_SYMBOL(iwl_read_eeprom);
465