diff options
-rw-r--r-- | drivers/net/wireless/iwlwifi/iwl-eeprom.c | 23 |
1 files changed, 11 insertions, 12 deletions
diff --git a/drivers/net/wireless/iwlwifi/iwl-eeprom.c b/drivers/net/wireless/iwlwifi/iwl-eeprom.c index 3d2b93a61e62..e14c9952a935 100644 --- a/drivers/net/wireless/iwlwifi/iwl-eeprom.c +++ b/drivers/net/wireless/iwlwifi/iwl-eeprom.c | |||
@@ -410,7 +410,6 @@ static int iwl_find_otp_image(struct iwl_priv *priv, | |||
410 | u16 *validblockaddr) | 410 | u16 *validblockaddr) |
411 | { | 411 | { |
412 | u16 next_link_addr = 0, link_value = 0, valid_addr; | 412 | u16 next_link_addr = 0, link_value = 0, valid_addr; |
413 | int ret = 0; | ||
414 | int usedblocks = 0; | 413 | int usedblocks = 0; |
415 | 414 | ||
416 | /* set addressing mode to absolute to traverse the link list */ | 415 | /* set addressing mode to absolute to traverse the link list */ |
@@ -430,29 +429,29 @@ static int iwl_find_otp_image(struct iwl_priv *priv, | |||
430 | * check for more block on the link list | 429 | * check for more block on the link list |
431 | */ | 430 | */ |
432 | valid_addr = next_link_addr; | 431 | valid_addr = next_link_addr; |
433 | next_link_addr = link_value; | 432 | next_link_addr = link_value * sizeof(u16); |
434 | IWL_DEBUG_INFO(priv, "OTP blocks %d addr 0x%x\n", | 433 | IWL_DEBUG_INFO(priv, "OTP blocks %d addr 0x%x\n", |
435 | usedblocks, next_link_addr); | 434 | usedblocks, next_link_addr); |
436 | if (iwl_read_otp_word(priv, next_link_addr, &link_value)) | 435 | if (iwl_read_otp_word(priv, next_link_addr, &link_value)) |
437 | return -EINVAL; | 436 | return -EINVAL; |
438 | if (!link_value) { | 437 | if (!link_value) { |
439 | /* | 438 | /* |
440 | * reach the end of link list, | 439 | * reach the end of link list, return success and |
441 | * set address point to the starting address | 440 | * set address point to the starting address |
442 | * of the image | 441 | * of the image |
443 | */ | 442 | */ |
444 | goto done; | 443 | *validblockaddr = valid_addr; |
444 | /* skip first 2 bytes (link list pointer) */ | ||
445 | *validblockaddr += 2; | ||
446 | return 0; | ||
445 | } | 447 | } |
446 | /* more in the link list, continue */ | 448 | /* more in the link list, continue */ |
447 | usedblocks++; | 449 | usedblocks++; |
448 | } while (usedblocks < priv->cfg->max_ll_items); | 450 | } while (usedblocks <= priv->cfg->max_ll_items); |
449 | /* OTP full, use last block */ | 451 | |
450 | IWL_DEBUG_INFO(priv, "OTP is full, use last block\n"); | 452 | /* OTP has no valid blocks */ |
451 | done: | 453 | IWL_DEBUG_INFO(priv, "OTP has no valid blocks\n"); |
452 | *validblockaddr = valid_addr; | 454 | return -EINVAL; |
453 | /* skip first 2 bytes (link list pointer) */ | ||
454 | *validblockaddr += 2; | ||
455 | return ret; | ||
456 | } | 455 | } |
457 | 456 | ||
458 | /** | 457 | /** |