1 files changed, 17 insertions, 34 deletions

diff --git a/drivers/net/wireless/iwlwifi/iwl-agn-ucode.c b/drivers/net/wireless/iwlwifi/iwl-agn-ucode.c
index 127c842fea55..2205b6035207 100644
--- a/drivers/net/wireless/iwlwifi/iwl-agn-ucode.c
+++ b/drivers/net/wireless/iwlwifi/iwl-agn-ucode.c
@@ -542,8 +542,6 @@ int iwlagn_alive_notify(struct iwl_priv *priv)
 static int iwlcore_verify_inst_sparse(struct iwl_priv *priv, __le32 *image, u32 len)
 {
         u32 val;
-        int ret = 0;
-        u32 errcnt = 0;
         u32 i;
 
         IWL_DEBUG_INFO(priv, "ucode inst image size is %u\n", len);
@@ -555,56 +553,39 @@ static int iwlcore_verify_inst_sparse(struct iwl_priv *priv, __le32 *image, u32
                 iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR,
                         i + IWLAGN_RTC_INST_LOWER_BOUND);
                 val = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
-                if (val != le32_to_cpu(*image)) {
-                        ret = -EIO;
-                        errcnt++;
-                        if (errcnt >= 3)
-                                break;
-                }
+                if (val != le32_to_cpu(*image))
+                        return -EIO;
         }
 
-        return ret;
+        return 0;
 }
 
-/**
- * iwlcore_verify_inst_full - verify runtime uCode image in card vs. host,
- *     looking at all data.
- */
-static int iwl_verify_inst_full(struct iwl_priv *priv, __le32 *image,
-                                 u32 len)
+static void iwl_print_mismatch_inst(struct iwl_priv *priv,
+                                    __le32 *image, u32 len)
 {
         u32 val;
-        u32 save_len = len;
-        int ret = 0;
-        u32 errcnt;
+        u32 offs;
+        int errors = 0;
 
         IWL_DEBUG_INFO(priv, "ucode inst image size is %u\n", len);
 
         iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR,
                            IWLAGN_RTC_INST_LOWER_BOUND);
 
-        errcnt = 0;
-        for (; len > 0; len -= sizeof(u32), image++) {
+        for (offs = 0;
+             offs < len && errors < 20;
+             offs += sizeof(u32), image++) {
                 /* read data comes through single port, auto-incr addr */
                 /* NOTE: Use the debugless read so we don't flood kernel log
                  * if IWL_DL_IO is set */
                 val = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
                 if (val != le32_to_cpu(*image)) {
-                        IWL_ERR(priv, "uCode INST section is invalid at "
-                                  "offset 0x%x, is 0x%x, s/b 0x%x\n",
-                                  save_len - len, val, le32_to_cpu(*image));
-                        ret = -EIO;
-                        errcnt++;
-                        if (errcnt >= 20)
-                                break;
+                        IWL_ERR(priv, "uCode INST section at "
+                                "offset 0x%x, is 0x%x, s/b 0x%x\n",
+                                offs, val, le32_to_cpu(*image));
+                        errors++;
                 }
         }
-
-        if (!errcnt)
-                IWL_DEBUG_INFO(priv,
-                    "ucode image in INSTRUCTION memory is good\n");
-
-        return ret;
 }
 
 /**
@@ -651,5 +632,7 @@ int iwl_verify_ucode(struct iwl_priv *priv)
          * Selection of bootstrap image (vs. other images) is arbitrary. */
         image = (__le32 *)priv->ucode_boot.v_addr;
         len = priv->ucode_boot.len;
-        return iwl_verify_inst_full(priv, image, len);
+        iwl_print_mismatch_inst(priv, image, len);
+
+        return -EIO;
 }