Wey-Yi Guy | be663ab | 2011-02-21 11:27:26 -0800 | [diff] [blame^] | 1 | /****************************************************************************** |
| 2 | * |
| 3 | * GPL LICENSE SUMMARY |
| 4 | * |
| 5 | * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of version 2 of the GNU General Public License as |
| 9 | * published by the Free Software Foundation. |
| 10 | * |
| 11 | * This program is distributed in the hope that it will be useful, but |
| 12 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 14 | * General Public License for more details. |
| 15 | * |
| 16 | * You should have received a copy of the GNU General Public License |
| 17 | * along with this program; if not, write to the Free Software |
| 18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, |
| 19 | * USA |
| 20 | * |
| 21 | * The full GNU General Public License is included in this distribution |
| 22 | * in the file called LICENSE.GPL. |
| 23 | * |
| 24 | * Contact Information: |
| 25 | * Intel Linux Wireless <ilw@linux.intel.com> |
| 26 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
| 27 | * |
| 28 | *****************************************************************************/ |
| 29 | |
| 30 | #include <linux/kernel.h> |
| 31 | #include <linux/module.h> |
| 32 | #include <linux/init.h> |
| 33 | #include <linux/sched.h> |
| 34 | |
| 35 | #include "iwl-dev.h" |
| 36 | #include "iwl-core.h" |
| 37 | #include "iwl-io.h" |
| 38 | #include "iwl-helpers.h" |
| 39 | #include "iwl-4965-hw.h" |
| 40 | #include "iwl-4965.h" |
| 41 | #include "iwl-4965-calib.h" |
| 42 | |
| 43 | #define IWL_AC_UNSET -1 |
| 44 | |
| 45 | /** |
| 46 | * iwl_verify_inst_sparse - verify runtime uCode image in card vs. host, |
| 47 | * using sample data 100 bytes apart. If these sample points are good, |
| 48 | * it's a pretty good bet that everything between them is good, too. |
| 49 | */ |
| 50 | static int |
| 51 | iwl4965_verify_inst_sparse(struct iwl_priv *priv, __le32 *image, u32 len) |
| 52 | { |
| 53 | u32 val; |
| 54 | int ret = 0; |
| 55 | u32 errcnt = 0; |
| 56 | u32 i; |
| 57 | |
| 58 | IWL_DEBUG_INFO(priv, "ucode inst image size is %u\n", len); |
| 59 | |
| 60 | for (i = 0; i < len; i += 100, image += 100/sizeof(u32)) { |
| 61 | /* read data comes through single port, auto-incr addr */ |
| 62 | /* NOTE: Use the debugless read so we don't flood kernel log |
| 63 | * if IWL_DL_IO is set */ |
| 64 | iwl_legacy_write_direct32(priv, HBUS_TARG_MEM_RADDR, |
| 65 | i + IWL4965_RTC_INST_LOWER_BOUND); |
| 66 | val = _iwl_legacy_read_direct32(priv, HBUS_TARG_MEM_RDAT); |
| 67 | if (val != le32_to_cpu(*image)) { |
| 68 | ret = -EIO; |
| 69 | errcnt++; |
| 70 | if (errcnt >= 3) |
| 71 | break; |
| 72 | } |
| 73 | } |
| 74 | |
| 75 | return ret; |
| 76 | } |
| 77 | |
| 78 | /** |
| 79 | * iwl4965_verify_inst_full - verify runtime uCode image in card vs. host, |
| 80 | * looking at all data. |
| 81 | */ |
| 82 | static int iwl4965_verify_inst_full(struct iwl_priv *priv, __le32 *image, |
| 83 | u32 len) |
| 84 | { |
| 85 | u32 val; |
| 86 | u32 save_len = len; |
| 87 | int ret = 0; |
| 88 | u32 errcnt; |
| 89 | |
| 90 | IWL_DEBUG_INFO(priv, "ucode inst image size is %u\n", len); |
| 91 | |
| 92 | iwl_legacy_write_direct32(priv, HBUS_TARG_MEM_RADDR, |
| 93 | IWL4965_RTC_INST_LOWER_BOUND); |
| 94 | |
| 95 | errcnt = 0; |
| 96 | for (; len > 0; len -= sizeof(u32), image++) { |
| 97 | /* read data comes through single port, auto-incr addr */ |
| 98 | /* NOTE: Use the debugless read so we don't flood kernel log |
| 99 | * if IWL_DL_IO is set */ |
| 100 | val = _iwl_legacy_read_direct32(priv, HBUS_TARG_MEM_RDAT); |
| 101 | if (val != le32_to_cpu(*image)) { |
| 102 | IWL_ERR(priv, "uCode INST section is invalid at " |
| 103 | "offset 0x%x, is 0x%x, s/b 0x%x\n", |
| 104 | save_len - len, val, le32_to_cpu(*image)); |
| 105 | ret = -EIO; |
| 106 | errcnt++; |
| 107 | if (errcnt >= 20) |
| 108 | break; |
| 109 | } |
| 110 | } |
| 111 | |
| 112 | if (!errcnt) |
| 113 | IWL_DEBUG_INFO(priv, |
| 114 | "ucode image in INSTRUCTION memory is good\n"); |
| 115 | |
| 116 | return ret; |
| 117 | } |
| 118 | |
| 119 | /** |
| 120 | * iwl4965_verify_ucode - determine which instruction image is in SRAM, |
| 121 | * and verify its contents |
| 122 | */ |
| 123 | int iwl4965_verify_ucode(struct iwl_priv *priv) |
| 124 | { |
| 125 | __le32 *image; |
| 126 | u32 len; |
| 127 | int ret; |
| 128 | |
| 129 | /* Try bootstrap */ |
| 130 | image = (__le32 *)priv->ucode_boot.v_addr; |
| 131 | len = priv->ucode_boot.len; |
| 132 | ret = iwl4965_verify_inst_sparse(priv, image, len); |
| 133 | if (!ret) { |
| 134 | IWL_DEBUG_INFO(priv, "Bootstrap uCode is good in inst SRAM\n"); |
| 135 | return 0; |
| 136 | } |
| 137 | |
| 138 | /* Try initialize */ |
| 139 | image = (__le32 *)priv->ucode_init.v_addr; |
| 140 | len = priv->ucode_init.len; |
| 141 | ret = iwl4965_verify_inst_sparse(priv, image, len); |
| 142 | if (!ret) { |
| 143 | IWL_DEBUG_INFO(priv, "Initialize uCode is good in inst SRAM\n"); |
| 144 | return 0; |
| 145 | } |
| 146 | |
| 147 | /* Try runtime/protocol */ |
| 148 | image = (__le32 *)priv->ucode_code.v_addr; |
| 149 | len = priv->ucode_code.len; |
| 150 | ret = iwl4965_verify_inst_sparse(priv, image, len); |
| 151 | if (!ret) { |
| 152 | IWL_DEBUG_INFO(priv, "Runtime uCode is good in inst SRAM\n"); |
| 153 | return 0; |
| 154 | } |
| 155 | |
| 156 | IWL_ERR(priv, "NO VALID UCODE IMAGE IN INSTRUCTION SRAM!!\n"); |
| 157 | |
| 158 | /* Since nothing seems to match, show first several data entries in |
| 159 | * instruction SRAM, so maybe visual inspection will give a clue. |
| 160 | * Selection of bootstrap image (vs. other images) is arbitrary. */ |
| 161 | image = (__le32 *)priv->ucode_boot.v_addr; |
| 162 | len = priv->ucode_boot.len; |
| 163 | ret = iwl4965_verify_inst_full(priv, image, len); |
| 164 | |
| 165 | return ret; |
| 166 | } |