Wey-Yi Guy | 792bc3c | 2010-03-16 10:23:29 -0700 | [diff] [blame] | 1 | /****************************************************************************** |
| 2 | * |
| 3 | * GPL LICENSE SUMMARY |
| 4 | * |
Wey-Yi Guy | 4e31826 | 2011-12-27 11:21:32 -0800 | [diff] [blame] | 5 | * Copyright(c) 2008 - 2012 Intel Corporation. All rights reserved. |
Wey-Yi Guy | 792bc3c | 2010-03-16 10:23:29 -0700 | [diff] [blame] | 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> |
Wey-Yi Guy | 792bc3c | 2010-03-16 10:23:29 -0700 | [diff] [blame] | 31 | #include <linux/init.h> |
| 32 | |
| 33 | #include "iwl-dev.h" |
Wey-Yi Guy | 81b8176 | 2010-03-16 10:23:30 -0700 | [diff] [blame] | 34 | #include "iwl-io.h" |
Wey-Yi Guy | 19e6cda | 2010-03-16 17:41:23 -0700 | [diff] [blame] | 35 | #include "iwl-agn-hw.h" |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 36 | #include "iwl-agn.h" |
Johannes Berg | 0de7673 | 2010-09-22 18:02:11 +0200 | [diff] [blame] | 37 | #include "iwl-agn-calib.h" |
Emmanuel Grumbach | bdfbf09 | 2011-07-08 08:46:16 -0700 | [diff] [blame] | 38 | #include "iwl-trans.h" |
Emmanuel Grumbach | dda61a4 | 2011-08-25 23:11:11 -0700 | [diff] [blame] | 39 | #include "iwl-fh.h" |
Emmanuel Grumbach | d0f76d6 | 2012-02-09 16:08:15 +0200 | [diff] [blame] | 40 | #include "iwl-op-mode.h" |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 41 | |
Don Fry | de7f5f9 | 2011-11-10 06:55:10 -0800 | [diff] [blame] | 42 | /****************************************************************************** |
| 43 | * |
| 44 | * uCode download functions |
| 45 | * |
| 46 | ******************************************************************************/ |
| 47 | |
Johannes Berg | 0692fe4 | 2012-03-06 13:30:37 -0800 | [diff] [blame] | 48 | static inline const struct fw_img * |
| 49 | iwl_get_ucode_image(struct iwl_priv *priv, enum iwl_ucode_type ucode_type) |
Don Fry | 8929c24 | 2011-11-10 06:55:08 -0800 | [diff] [blame] | 50 | { |
David Spinadel | 6dfa8d0 | 2012-03-10 13:00:14 -0800 | [diff] [blame] | 51 | if (ucode_type >= IWL_UCODE_TYPE_MAX) |
| 52 | return NULL; |
| 53 | |
| 54 | return &priv->fw->img[ucode_type]; |
Don Fry | 8929c24 | 2011-11-10 06:55:08 -0800 | [diff] [blame] | 55 | } |
| 56 | |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 57 | /* |
| 58 | * Calibration |
| 59 | */ |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 60 | static int iwl_set_Xtal_calib(struct iwl_priv *priv) |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 61 | { |
| 62 | struct iwl_calib_xtal_freq_cmd cmd; |
| 63 | __le16 *xtal_calib = |
Johannes Berg | 11483b5 | 2012-04-09 17:46:58 -0700 | [diff] [blame] | 64 | (__le16 *)iwl_eeprom_query_addr(priv, EEPROM_XTAL); |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 65 | |
Wey-Yi Guy | 1f8bf03 | 2011-06-06 14:26:43 -0700 | [diff] [blame] | 66 | iwl_set_calib_hdr(&cmd.hdr, IWL_PHY_CALIBRATE_CRYSTAL_FRQ_CMD); |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 67 | cmd.cap_pin1 = le16_to_cpu(xtal_calib[0]); |
| 68 | cmd.cap_pin2 = le16_to_cpu(xtal_calib[1]); |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 69 | return iwl_calib_set(priv, (void *)&cmd, sizeof(cmd)); |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 70 | } |
| 71 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 72 | static int iwl_set_temperature_offset_calib(struct iwl_priv *priv) |
Shanyu Zhao | bf53f93 | 2010-09-21 16:54:01 -0700 | [diff] [blame] | 73 | { |
| 74 | struct iwl_calib_temperature_offset_cmd cmd; |
| 75 | __le16 *offset_calib = |
Johannes Berg | 11483b5 | 2012-04-09 17:46:58 -0700 | [diff] [blame] | 76 | (__le16 *)iwl_eeprom_query_addr(priv, EEPROM_RAW_TEMPERATURE); |
Wey-Yi Guy | 1f8bf03 | 2011-06-06 14:26:43 -0700 | [diff] [blame] | 77 | |
| 78 | memset(&cmd, 0, sizeof(cmd)); |
| 79 | iwl_set_calib_hdr(&cmd.hdr, IWL_PHY_CALIBRATE_TEMP_OFFSET_CMD); |
Johannes Berg | 456fc37 | 2011-09-12 21:08:25 +0200 | [diff] [blame] | 80 | memcpy(&cmd.radio_sensor_offset, offset_calib, sizeof(*offset_calib)); |
Shanyu Zhao | bf53f93 | 2010-09-21 16:54:01 -0700 | [diff] [blame] | 81 | if (!(cmd.radio_sensor_offset)) |
| 82 | cmd.radio_sensor_offset = DEFAULT_RADIO_SENSOR_OFFSET; |
Wey-Yi Guy | 1f8bf03 | 2011-06-06 14:26:43 -0700 | [diff] [blame] | 83 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 84 | IWL_DEBUG_CALIB(priv, "Radio sensor offset: %d\n", |
Wey-Yi Guy | 2e27799 | 2011-07-08 14:29:48 -0700 | [diff] [blame] | 85 | le16_to_cpu(cmd.radio_sensor_offset)); |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 86 | return iwl_calib_set(priv, (void *)&cmd, sizeof(cmd)); |
Shanyu Zhao | bf53f93 | 2010-09-21 16:54:01 -0700 | [diff] [blame] | 87 | } |
| 88 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 89 | static int iwl_set_temperature_offset_calib_v2(struct iwl_priv *priv) |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 90 | { |
| 91 | struct iwl_calib_temperature_offset_v2_cmd cmd; |
Johannes Berg | 11483b5 | 2012-04-09 17:46:58 -0700 | [diff] [blame] | 92 | __le16 *offset_calib_high = (__le16 *)iwl_eeprom_query_addr(priv, |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 93 | EEPROM_KELVIN_TEMPERATURE); |
| 94 | __le16 *offset_calib_low = |
Johannes Berg | 11483b5 | 2012-04-09 17:46:58 -0700 | [diff] [blame] | 95 | (__le16 *)iwl_eeprom_query_addr(priv, EEPROM_RAW_TEMPERATURE); |
Wey-Yi Guy | 7d8f2d5 | 2011-09-15 11:46:51 -0700 | [diff] [blame] | 96 | struct iwl_eeprom_calib_hdr *hdr; |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 97 | |
| 98 | memset(&cmd, 0, sizeof(cmd)); |
| 99 | iwl_set_calib_hdr(&cmd.hdr, IWL_PHY_CALIBRATE_TEMP_OFFSET_CMD); |
Johannes Berg | 11483b5 | 2012-04-09 17:46:58 -0700 | [diff] [blame] | 100 | hdr = (struct iwl_eeprom_calib_hdr *)iwl_eeprom_query_addr(priv, |
Wey-Yi Guy | 7d8f2d5 | 2011-09-15 11:46:51 -0700 | [diff] [blame] | 101 | EEPROM_CALIB_ALL); |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 102 | memcpy(&cmd.radio_sensor_offset_high, offset_calib_high, |
Wey-Yi Guy | 0008500 | 2011-09-15 11:46:53 -0700 | [diff] [blame] | 103 | sizeof(*offset_calib_high)); |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 104 | memcpy(&cmd.radio_sensor_offset_low, offset_calib_low, |
Wey-Yi Guy | 0008500 | 2011-09-15 11:46:53 -0700 | [diff] [blame] | 105 | sizeof(*offset_calib_low)); |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 106 | if (!(cmd.radio_sensor_offset_low)) { |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 107 | IWL_DEBUG_CALIB(priv, "no info in EEPROM, use default\n"); |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 108 | cmd.radio_sensor_offset_low = DEFAULT_RADIO_SENSOR_OFFSET; |
| 109 | cmd.radio_sensor_offset_high = DEFAULT_RADIO_SENSOR_OFFSET; |
| 110 | } |
Wey-Yi Guy | 7d8f2d5 | 2011-09-15 11:46:51 -0700 | [diff] [blame] | 111 | memcpy(&cmd.burntVoltageRef, &hdr->voltage, |
| 112 | sizeof(hdr->voltage)); |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 113 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 114 | IWL_DEBUG_CALIB(priv, "Radio sensor offset high: %d\n", |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 115 | le16_to_cpu(cmd.radio_sensor_offset_high)); |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 116 | IWL_DEBUG_CALIB(priv, "Radio sensor offset low: %d\n", |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 117 | le16_to_cpu(cmd.radio_sensor_offset_low)); |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 118 | IWL_DEBUG_CALIB(priv, "Voltage Ref: %d\n", |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 119 | le16_to_cpu(cmd.burntVoltageRef)); |
| 120 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 121 | return iwl_calib_set(priv, (void *)&cmd, sizeof(cmd)); |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 122 | } |
| 123 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 124 | static int iwl_send_calib_cfg(struct iwl_priv *priv) |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 125 | { |
| 126 | struct iwl_calib_cfg_cmd calib_cfg_cmd; |
| 127 | struct iwl_host_cmd cmd = { |
| 128 | .id = CALIBRATION_CFG_CMD, |
Johannes Berg | 3fa5073 | 2011-05-04 07:50:38 -0700 | [diff] [blame] | 129 | .len = { sizeof(struct iwl_calib_cfg_cmd), }, |
| 130 | .data = { &calib_cfg_cmd, }, |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 131 | }; |
| 132 | |
| 133 | memset(&calib_cfg_cmd, 0, sizeof(calib_cfg_cmd)); |
| 134 | calib_cfg_cmd.ucd_calib_cfg.once.is_enable = IWL_CALIB_INIT_CFG_ALL; |
| 135 | calib_cfg_cmd.ucd_calib_cfg.once.start = IWL_CALIB_INIT_CFG_ALL; |
| 136 | calib_cfg_cmd.ucd_calib_cfg.once.send_res = IWL_CALIB_INIT_CFG_ALL; |
Wey-Yi Guy | df2a4dc | 2011-07-08 14:29:45 -0700 | [diff] [blame] | 137 | calib_cfg_cmd.ucd_calib_cfg.flags = |
| 138 | IWL_CALIB_CFG_FLAG_SEND_COMPLETE_NTFY_MSK; |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 139 | |
Johannes Berg | e10a053 | 2012-03-06 13:30:39 -0800 | [diff] [blame] | 140 | return iwl_dvm_send_cmd(priv, &cmd); |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 141 | } |
| 142 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 143 | int iwl_init_alive_start(struct iwl_priv *priv) |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 144 | { |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 145 | int ret; |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 146 | |
Emmanuel Grumbach | 2152268 | 2012-03-22 17:51:44 +0200 | [diff] [blame] | 147 | if (priv->cfg->bt_params && |
| 148 | priv->cfg->bt_params->advanced_bt_coexist) { |
Wey-Yi Guy | f7322f8 | 2010-08-23 15:24:49 -0700 | [diff] [blame] | 149 | /* |
| 150 | * Tell uCode we are ready to perform calibration |
| 151 | * need to perform this before any calibration |
| 152 | * no need to close the envlope since we are going |
| 153 | * to load the runtime uCode later. |
| 154 | */ |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 155 | ret = iwl_send_bt_env(priv, IWL_BT_COEX_ENV_OPEN, |
Wey-Yi Guy | f7322f8 | 2010-08-23 15:24:49 -0700 | [diff] [blame] | 156 | BT_COEX_PRIO_TBL_EVT_INIT_CALIB2); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 157 | if (ret) |
| 158 | return ret; |
Wey-Yi Guy | f7322f8 | 2010-08-23 15:24:49 -0700 | [diff] [blame] | 159 | |
| 160 | } |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 161 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 162 | ret = iwl_send_calib_cfg(priv); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 163 | if (ret) |
| 164 | return ret; |
Shanyu Zhao | bf53f93 | 2010-09-21 16:54:01 -0700 | [diff] [blame] | 165 | |
| 166 | /** |
| 167 | * temperature offset calibration is only needed for runtime ucode, |
| 168 | * so prepare the value now. |
| 169 | */ |
Emmanuel Grumbach | 2152268 | 2012-03-22 17:51:44 +0200 | [diff] [blame] | 170 | if (priv->cfg->need_temp_offset_calib) { |
| 171 | if (priv->cfg->temp_offset_v2) |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 172 | return iwl_set_temperature_offset_calib_v2(priv); |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 173 | else |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 174 | return iwl_set_temperature_offset_calib(priv); |
Wey-Yi Guy | c6f3034 | 2011-09-15 11:46:50 -0700 | [diff] [blame] | 175 | } |
Shanyu Zhao | bf53f93 | 2010-09-21 16:54:01 -0700 | [diff] [blame] | 176 | |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 177 | return 0; |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 178 | } |
| 179 | |
David Spinadel | 50c1e9a | 2012-04-16 14:43:30 -0700 | [diff] [blame] | 180 | int iwl_send_wimax_coex(struct iwl_priv *priv) |
Wey-Yi Guy | f401241 | 2010-04-27 14:10:00 -0700 | [diff] [blame] | 181 | { |
| 182 | struct iwl_wimax_coex_cmd coex_cmd; |
| 183 | |
Johannes Berg | 85560af | 2012-03-15 13:26:48 -0700 | [diff] [blame] | 184 | /* coexistence is disabled */ |
| 185 | memset(&coex_cmd, 0, sizeof(coex_cmd)); |
Wey-Yi Guy | f401241 | 2010-04-27 14:10:00 -0700 | [diff] [blame] | 186 | |
Johannes Berg | e10a053 | 2012-03-06 13:30:39 -0800 | [diff] [blame] | 187 | return iwl_dvm_send_cmd_pdu(priv, |
Emmanuel Grumbach | e419d62 | 2011-07-08 08:46:14 -0700 | [diff] [blame] | 188 | COEX_PRIORITY_TABLE_CMD, CMD_SYNC, |
Wey-Yi Guy | f401241 | 2010-04-27 14:10:00 -0700 | [diff] [blame] | 189 | sizeof(coex_cmd), &coex_cmd); |
| 190 | } |
| 191 | |
Don Fry | 66128b1 | 2011-11-28 14:35:14 -0800 | [diff] [blame] | 192 | static const u8 iwl_bt_prio_tbl[BT_COEX_PRIO_TBL_EVT_MAX] = { |
Wey-Yi Guy | aeb4a2e | 2010-08-23 07:57:05 -0700 | [diff] [blame] | 193 | ((BT_COEX_PRIO_TBL_PRIO_BYPASS << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 194 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 195 | ((BT_COEX_PRIO_TBL_PRIO_BYPASS << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 196 | (1 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 197 | ((BT_COEX_PRIO_TBL_PRIO_LOW << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 198 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 199 | ((BT_COEX_PRIO_TBL_PRIO_LOW << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 200 | (1 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 201 | ((BT_COEX_PRIO_TBL_PRIO_HIGH << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 202 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 203 | ((BT_COEX_PRIO_TBL_PRIO_HIGH << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 204 | (1 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 205 | ((BT_COEX_PRIO_TBL_PRIO_BYPASS << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 206 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 207 | ((BT_COEX_PRIO_TBL_PRIO_COEX_OFF << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 208 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 209 | ((BT_COEX_PRIO_TBL_PRIO_COEX_ON << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
| 210 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), |
| 211 | 0, 0, 0, 0, 0, 0, 0 |
| 212 | }; |
| 213 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 214 | void iwl_send_prio_tbl(struct iwl_priv *priv) |
Wey-Yi Guy | aeb4a2e | 2010-08-23 07:57:05 -0700 | [diff] [blame] | 215 | { |
| 216 | struct iwl_bt_coex_prio_table_cmd prio_tbl_cmd; |
| 217 | |
Don Fry | 66128b1 | 2011-11-28 14:35:14 -0800 | [diff] [blame] | 218 | memcpy(prio_tbl_cmd.prio_tbl, iwl_bt_prio_tbl, |
| 219 | sizeof(iwl_bt_prio_tbl)); |
Johannes Berg | e10a053 | 2012-03-06 13:30:39 -0800 | [diff] [blame] | 220 | if (iwl_dvm_send_cmd_pdu(priv, |
Emmanuel Grumbach | e419d62 | 2011-07-08 08:46:14 -0700 | [diff] [blame] | 221 | REPLY_BT_COEX_PRIO_TABLE, CMD_SYNC, |
Wey-Yi Guy | aeb4a2e | 2010-08-23 07:57:05 -0700 | [diff] [blame] | 222 | sizeof(prio_tbl_cmd), &prio_tbl_cmd)) |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 223 | IWL_ERR(priv, "failed to send BT prio tbl command\n"); |
Wey-Yi Guy | aeb4a2e | 2010-08-23 07:57:05 -0700 | [diff] [blame] | 224 | } |
| 225 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 226 | int iwl_send_bt_env(struct iwl_priv *priv, u8 action, u8 type) |
Wey-Yi Guy | aeb4a2e | 2010-08-23 07:57:05 -0700 | [diff] [blame] | 227 | { |
| 228 | struct iwl_bt_coex_prot_env_cmd env_cmd; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 229 | int ret; |
Wey-Yi Guy | aeb4a2e | 2010-08-23 07:57:05 -0700 | [diff] [blame] | 230 | |
| 231 | env_cmd.action = action; |
| 232 | env_cmd.type = type; |
Johannes Berg | e10a053 | 2012-03-06 13:30:39 -0800 | [diff] [blame] | 233 | ret = iwl_dvm_send_cmd_pdu(priv, |
Emmanuel Grumbach | e419d62 | 2011-07-08 08:46:14 -0700 | [diff] [blame] | 234 | REPLY_BT_COEX_PROT_ENV, CMD_SYNC, |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 235 | sizeof(env_cmd), &env_cmd); |
| 236 | if (ret) |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 237 | IWL_ERR(priv, "failed to send BT env command\n"); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 238 | return ret; |
Wey-Yi Guy | aeb4a2e | 2010-08-23 07:57:05 -0700 | [diff] [blame] | 239 | } |
| 240 | |
| 241 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 242 | static int iwl_alive_notify(struct iwl_priv *priv) |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 243 | { |
Wey-Yi Guy | 7415952 | 2011-04-05 09:42:01 -0700 | [diff] [blame] | 244 | int ret; |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 245 | |
Emmanuel Grumbach | 68e8dfd | 2012-04-18 07:28:17 -0700 | [diff] [blame] | 246 | iwl_trans_fw_alive(priv->trans); |
Johannes Berg | e755f88 | 2012-03-07 09:52:16 -0800 | [diff] [blame] | 247 | |
| 248 | priv->passive_no_rx = false; |
| 249 | priv->transport_queue_stop = 0; |
Grumbach, Emmanuel | e7cad69 | 2010-11-18 03:47:38 -0800 | [diff] [blame] | 250 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 251 | ret = iwl_send_wimax_coex(priv); |
Wey-Yi Guy | 7415952 | 2011-04-05 09:42:01 -0700 | [diff] [blame] | 252 | if (ret) |
| 253 | return ret; |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 254 | |
Emmanuel Grumbach | 2152268 | 2012-03-22 17:51:44 +0200 | [diff] [blame] | 255 | if (!priv->cfg->no_xtal_calib) { |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 256 | ret = iwl_set_Xtal_calib(priv); |
Johannes Berg | 93b6410 | 2011-11-17 08:51:53 -0800 | [diff] [blame] | 257 | if (ret) |
| 258 | return ret; |
| 259 | } |
Wey-Yi Guy | 7415952 | 2011-04-05 09:42:01 -0700 | [diff] [blame] | 260 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 261 | return iwl_send_calib_results(priv); |
Wey-Yi Guy | 741a626 | 2010-03-16 12:37:24 -0700 | [diff] [blame] | 262 | } |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 263 | |
| 264 | |
| 265 | /** |
| 266 | * iwl_verify_inst_sparse - verify runtime uCode image in card vs. host, |
| 267 | * using sample data 100 bytes apart. If these sample points are good, |
| 268 | * it's a pretty good bet that everything between them is good, too. |
| 269 | */ |
David Spinadel | 6dfa8d0 | 2012-03-10 13:00:14 -0800 | [diff] [blame] | 270 | static int iwl_verify_sec_sparse(struct iwl_priv *priv, |
Johannes Berg | 0692fe4 | 2012-03-06 13:30:37 -0800 | [diff] [blame] | 271 | const struct fw_desc *fw_desc) |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 272 | { |
Johannes Berg | 35b1d92 | 2011-04-05 09:41:56 -0700 | [diff] [blame] | 273 | __le32 *image = (__le32 *)fw_desc->v_addr; |
| 274 | u32 len = fw_desc->len; |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 275 | u32 val; |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 276 | u32 i; |
| 277 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 278 | IWL_DEBUG_FW(priv, "ucode inst image size is %u\n", len); |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 279 | |
| 280 | for (i = 0; i < len; i += 100, image += 100/sizeof(u32)) { |
| 281 | /* read data comes through single port, auto-incr addr */ |
| 282 | /* NOTE: Use the debugless read so we don't flood kernel log |
| 283 | * if IWL_DL_IO is set */ |
Emmanuel Grumbach | 68e8dfd | 2012-04-18 07:28:17 -0700 | [diff] [blame] | 284 | iwl_write_direct32(priv->trans, HBUS_TARG_MEM_RADDR, |
David Spinadel | 6dfa8d0 | 2012-03-10 13:00:14 -0800 | [diff] [blame] | 285 | i + fw_desc->offset); |
Emmanuel Grumbach | 68e8dfd | 2012-04-18 07:28:17 -0700 | [diff] [blame] | 286 | val = iwl_read32(priv->trans, HBUS_TARG_MEM_RDAT); |
Johannes Berg | fb66216 | 2011-04-05 09:41:55 -0700 | [diff] [blame] | 287 | if (val != le32_to_cpu(*image)) |
| 288 | return -EIO; |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 289 | } |
| 290 | |
Johannes Berg | fb66216 | 2011-04-05 09:41:55 -0700 | [diff] [blame] | 291 | return 0; |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 292 | } |
| 293 | |
David Spinadel | 6dfa8d0 | 2012-03-10 13:00:14 -0800 | [diff] [blame] | 294 | static void iwl_print_mismatch_sec(struct iwl_priv *priv, |
Johannes Berg | 0692fe4 | 2012-03-06 13:30:37 -0800 | [diff] [blame] | 295 | const struct fw_desc *fw_desc) |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 296 | { |
Johannes Berg | 35b1d92 | 2011-04-05 09:41:56 -0700 | [diff] [blame] | 297 | __le32 *image = (__le32 *)fw_desc->v_addr; |
| 298 | u32 len = fw_desc->len; |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 299 | u32 val; |
Johannes Berg | fb66216 | 2011-04-05 09:41:55 -0700 | [diff] [blame] | 300 | u32 offs; |
| 301 | int errors = 0; |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 302 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 303 | IWL_DEBUG_FW(priv, "ucode inst image size is %u\n", len); |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 304 | |
Emmanuel Grumbach | 68e8dfd | 2012-04-18 07:28:17 -0700 | [diff] [blame] | 305 | iwl_write_direct32(priv->trans, HBUS_TARG_MEM_RADDR, |
David Spinadel | 6dfa8d0 | 2012-03-10 13:00:14 -0800 | [diff] [blame] | 306 | fw_desc->offset); |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 307 | |
Johannes Berg | fb66216 | 2011-04-05 09:41:55 -0700 | [diff] [blame] | 308 | for (offs = 0; |
| 309 | offs < len && errors < 20; |
| 310 | offs += sizeof(u32), image++) { |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 311 | /* read data comes through single port, auto-incr addr */ |
Emmanuel Grumbach | 68e8dfd | 2012-04-18 07:28:17 -0700 | [diff] [blame] | 312 | val = iwl_read32(priv->trans, HBUS_TARG_MEM_RDAT); |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 313 | if (val != le32_to_cpu(*image)) { |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 314 | IWL_ERR(priv, "uCode INST section at " |
Johannes Berg | fb66216 | 2011-04-05 09:41:55 -0700 | [diff] [blame] | 315 | "offset 0x%x, is 0x%x, s/b 0x%x\n", |
| 316 | offs, val, le32_to_cpu(*image)); |
| 317 | errors++; |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 318 | } |
| 319 | } |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 320 | } |
| 321 | |
| 322 | /** |
| 323 | * iwl_verify_ucode - determine which instruction image is in SRAM, |
| 324 | * and verify its contents |
| 325 | */ |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 326 | static int iwl_verify_ucode(struct iwl_priv *priv, |
Don Fry | de7f5f9 | 2011-11-10 06:55:10 -0800 | [diff] [blame] | 327 | enum iwl_ucode_type ucode_type) |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 328 | { |
Johannes Berg | 0692fe4 | 2012-03-06 13:30:37 -0800 | [diff] [blame] | 329 | const struct fw_img *img = iwl_get_ucode_image(priv, ucode_type); |
Don Fry | baa0005 | 2011-11-10 06:55:09 -0800 | [diff] [blame] | 330 | |
| 331 | if (!img) { |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 332 | IWL_ERR(priv, "Invalid ucode requested (%d)\n", ucode_type); |
Don Fry | baa0005 | 2011-11-10 06:55:09 -0800 | [diff] [blame] | 333 | return -EINVAL; |
| 334 | } |
| 335 | |
David Spinadel | 6dfa8d0 | 2012-03-10 13:00:14 -0800 | [diff] [blame] | 336 | if (!iwl_verify_sec_sparse(priv, &img->sec[IWL_UCODE_SECTION_INST])) { |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 337 | IWL_DEBUG_FW(priv, "uCode is good in inst SRAM\n"); |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 338 | return 0; |
| 339 | } |
| 340 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 341 | IWL_ERR(priv, "UCODE IMAGE IN INSTRUCTION SRAM NOT VALID!!\n"); |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 342 | |
David Spinadel | 6dfa8d0 | 2012-03-10 13:00:14 -0800 | [diff] [blame] | 343 | iwl_print_mismatch_sec(priv, &img->sec[IWL_UCODE_SECTION_INST]); |
Johannes Berg | fb66216 | 2011-04-05 09:41:55 -0700 | [diff] [blame] | 344 | return -EIO; |
Wey-Yi Guy | db41dd27 | 2010-05-10 14:15:25 -0700 | [diff] [blame] | 345 | } |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 346 | |
Don Fry | 69a679b | 2011-12-07 08:50:46 -0800 | [diff] [blame] | 347 | struct iwl_alive_data { |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 348 | bool valid; |
| 349 | u8 subtype; |
| 350 | }; |
| 351 | |
Johannes Berg | db662d4 | 2012-03-15 13:26:44 -0700 | [diff] [blame] | 352 | static bool iwl_alive_fn(struct iwl_notif_wait_data *notif_wait, |
| 353 | struct iwl_rx_packet *pkt, void *data) |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 354 | { |
Johannes Berg | 4bd14dd | 2012-03-06 13:30:58 -0800 | [diff] [blame] | 355 | struct iwl_priv *priv = |
| 356 | container_of(notif_wait, struct iwl_priv, notif_wait); |
Don Fry | 69a679b | 2011-12-07 08:50:46 -0800 | [diff] [blame] | 357 | struct iwl_alive_data *alive_data = data; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 358 | struct iwl_alive_resp *palive; |
| 359 | |
Johannes Berg | f8d7c1a | 2012-03-06 13:31:02 -0800 | [diff] [blame] | 360 | palive = (void *)pkt->data; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 361 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 362 | IWL_DEBUG_FW(priv, "Alive ucode status 0x%08X revision " |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 363 | "0x%01X 0x%01X\n", |
| 364 | palive->is_valid, palive->ver_type, |
| 365 | palive->ver_subtype); |
| 366 | |
Meenakshi Venkataraman | 2fdfc47 | 2012-03-15 13:26:56 -0700 | [diff] [blame] | 367 | priv->device_pointers.error_event_table = |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 368 | le32_to_cpu(palive->error_event_table_ptr); |
Meenakshi Venkataraman | 2fdfc47 | 2012-03-15 13:26:56 -0700 | [diff] [blame] | 369 | priv->device_pointers.log_event_table = |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 370 | le32_to_cpu(palive->log_event_table_ptr); |
| 371 | |
| 372 | alive_data->subtype = palive->ver_subtype; |
| 373 | alive_data->valid = palive->is_valid == UCODE_VALID_OK; |
Johannes Berg | db662d4 | 2012-03-15 13:26:44 -0700 | [diff] [blame] | 374 | |
| 375 | return true; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 376 | } |
| 377 | |
| 378 | #define UCODE_ALIVE_TIMEOUT HZ |
| 379 | #define UCODE_CALIB_TIMEOUT (2*HZ) |
| 380 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 381 | int iwl_load_ucode_wait_alive(struct iwl_priv *priv, |
Don Fry | de7f5f9 | 2011-11-10 06:55:10 -0800 | [diff] [blame] | 382 | enum iwl_ucode_type ucode_type) |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 383 | { |
| 384 | struct iwl_notification_wait alive_wait; |
Don Fry | 69a679b | 2011-12-07 08:50:46 -0800 | [diff] [blame] | 385 | struct iwl_alive_data alive_data; |
Johannes Berg | 0692fe4 | 2012-03-06 13:30:37 -0800 | [diff] [blame] | 386 | const struct fw_img *fw; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 387 | int ret; |
Don Fry | de7f5f9 | 2011-11-10 06:55:10 -0800 | [diff] [blame] | 388 | enum iwl_ucode_type old_type; |
Johannes Berg | db662d4 | 2012-03-15 13:26:44 -0700 | [diff] [blame] | 389 | static const u8 alive_cmd[] = { REPLY_ALIVE }; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 390 | |
Meenakshi Venkataraman | a42506e | 2012-03-15 13:26:57 -0700 | [diff] [blame] | 391 | old_type = priv->cur_ucode; |
| 392 | priv->cur_ucode = ucode_type; |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 393 | fw = iwl_get_ucode_image(priv, ucode_type); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 394 | |
David Spinadel | 8f7ffbe | 2012-03-10 13:00:10 -0800 | [diff] [blame] | 395 | priv->ucode_loaded = false; |
| 396 | |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 397 | if (!fw) |
| 398 | return -EINVAL; |
| 399 | |
Johannes Berg | db662d4 | 2012-03-15 13:26:44 -0700 | [diff] [blame] | 400 | iwl_init_notification_wait(&priv->notif_wait, &alive_wait, |
| 401 | alive_cmd, ARRAY_SIZE(alive_cmd), |
| 402 | iwl_alive_fn, &alive_data); |
Johannes Berg | f472089 | 2012-03-06 13:30:57 -0800 | [diff] [blame] | 403 | |
Emmanuel Grumbach | 68e8dfd | 2012-04-18 07:28:17 -0700 | [diff] [blame] | 404 | ret = iwl_trans_start_fw(priv->trans, fw); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 405 | if (ret) { |
Meenakshi Venkataraman | a42506e | 2012-03-15 13:26:57 -0700 | [diff] [blame] | 406 | priv->cur_ucode = old_type; |
Johannes Berg | 4bd14dd | 2012-03-06 13:30:58 -0800 | [diff] [blame] | 407 | iwl_remove_notification(&priv->notif_wait, &alive_wait); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 408 | return ret; |
| 409 | } |
| 410 | |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 411 | /* |
| 412 | * Some things may run in the background now, but we |
| 413 | * just wait for the ALIVE notification here. |
| 414 | */ |
Johannes Berg | 4bd14dd | 2012-03-06 13:30:58 -0800 | [diff] [blame] | 415 | ret = iwl_wait_notification(&priv->notif_wait, &alive_wait, |
Don Fry | dd5fe10 | 2011-11-28 16:13:19 -0800 | [diff] [blame] | 416 | UCODE_ALIVE_TIMEOUT); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 417 | if (ret) { |
Meenakshi Venkataraman | a42506e | 2012-03-15 13:26:57 -0700 | [diff] [blame] | 418 | priv->cur_ucode = old_type; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 419 | return ret; |
| 420 | } |
| 421 | |
| 422 | if (!alive_data.valid) { |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 423 | IWL_ERR(priv, "Loaded ucode is not valid!\n"); |
Meenakshi Venkataraman | a42506e | 2012-03-15 13:26:57 -0700 | [diff] [blame] | 424 | priv->cur_ucode = old_type; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 425 | return -EIO; |
| 426 | } |
| 427 | |
Johannes Berg | c8ac61c | 2011-07-15 13:23:45 -0700 | [diff] [blame] | 428 | /* |
| 429 | * This step takes a long time (60-80ms!!) and |
| 430 | * WoWLAN image should be loaded quickly, so |
| 431 | * skip it for WoWLAN. |
| 432 | */ |
| 433 | if (ucode_type != IWL_UCODE_WOWLAN) { |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 434 | ret = iwl_verify_ucode(priv, ucode_type); |
Johannes Berg | c8ac61c | 2011-07-15 13:23:45 -0700 | [diff] [blame] | 435 | if (ret) { |
Meenakshi Venkataraman | a42506e | 2012-03-15 13:26:57 -0700 | [diff] [blame] | 436 | priv->cur_ucode = old_type; |
Johannes Berg | c8ac61c | 2011-07-15 13:23:45 -0700 | [diff] [blame] | 437 | return ret; |
| 438 | } |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 439 | |
Johannes Berg | c8ac61c | 2011-07-15 13:23:45 -0700 | [diff] [blame] | 440 | /* delay a bit to give rfkill time to run */ |
| 441 | msleep(5); |
| 442 | } |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 443 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 444 | ret = iwl_alive_notify(priv); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 445 | if (ret) { |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 446 | IWL_WARN(priv, |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 447 | "Could not complete ALIVE transition: %d\n", ret); |
Meenakshi Venkataraman | a42506e | 2012-03-15 13:26:57 -0700 | [diff] [blame] | 448 | priv->cur_ucode = old_type; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 449 | return ret; |
| 450 | } |
| 451 | |
David Spinadel | 8f7ffbe | 2012-03-10 13:00:10 -0800 | [diff] [blame] | 452 | priv->ucode_loaded = true; |
| 453 | |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 454 | return 0; |
| 455 | } |
| 456 | |
Johannes Berg | e1f0c50 | 2012-03-15 13:26:45 -0700 | [diff] [blame] | 457 | static bool iwlagn_wait_calib(struct iwl_notif_wait_data *notif_wait, |
| 458 | struct iwl_rx_packet *pkt, void *data) |
| 459 | { |
| 460 | struct iwl_priv *priv = data; |
| 461 | struct iwl_calib_hdr *hdr; |
| 462 | int len; |
| 463 | |
| 464 | if (pkt->hdr.cmd != CALIBRATION_RES_NOTIFICATION) { |
| 465 | WARN_ON(pkt->hdr.cmd != CALIBRATION_COMPLETE_NOTIFICATION); |
| 466 | return true; |
| 467 | } |
| 468 | |
| 469 | hdr = (struct iwl_calib_hdr *)pkt->data; |
| 470 | len = le32_to_cpu(pkt->len_n_flags) & FH_RSCSR_FRAME_SIZE_MSK; |
| 471 | |
| 472 | /* reduce the size by the length field itself */ |
| 473 | len -= sizeof(__le32); |
| 474 | |
| 475 | if (iwl_calib_set(priv, hdr, len)) |
| 476 | IWL_ERR(priv, "Failed to record calibration data %d\n", |
| 477 | hdr->op_code); |
| 478 | |
| 479 | return false; |
| 480 | } |
| 481 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 482 | int iwl_run_init_ucode(struct iwl_priv *priv) |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 483 | { |
| 484 | struct iwl_notification_wait calib_wait; |
Johannes Berg | db662d4 | 2012-03-15 13:26:44 -0700 | [diff] [blame] | 485 | static const u8 calib_complete[] = { |
Johannes Berg | e1f0c50 | 2012-03-15 13:26:45 -0700 | [diff] [blame] | 486 | CALIBRATION_RES_NOTIFICATION, |
Johannes Berg | db662d4 | 2012-03-15 13:26:44 -0700 | [diff] [blame] | 487 | CALIBRATION_COMPLETE_NOTIFICATION |
| 488 | }; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 489 | int ret; |
| 490 | |
Johannes Berg | b1eea29 | 2012-03-06 13:30:42 -0800 | [diff] [blame] | 491 | lockdep_assert_held(&priv->mutex); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 492 | |
| 493 | /* No init ucode required? Curious, but maybe ok */ |
David Spinadel | 6dfa8d0 | 2012-03-10 13:00:14 -0800 | [diff] [blame] | 494 | if (!priv->fw->img[IWL_UCODE_INIT].sec[0].len) |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 495 | return 0; |
| 496 | |
David Spinadel | b5ea162 | 2012-03-10 13:00:11 -0800 | [diff] [blame] | 497 | if (priv->init_ucode_run) |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 498 | return 0; |
| 499 | |
Johannes Berg | 4bd14dd | 2012-03-06 13:30:58 -0800 | [diff] [blame] | 500 | iwl_init_notification_wait(&priv->notif_wait, &calib_wait, |
Johannes Berg | db662d4 | 2012-03-15 13:26:44 -0700 | [diff] [blame] | 501 | calib_complete, ARRAY_SIZE(calib_complete), |
Johannes Berg | e1f0c50 | 2012-03-15 13:26:45 -0700 | [diff] [blame] | 502 | iwlagn_wait_calib, priv); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 503 | |
| 504 | /* Will also start the device */ |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 505 | ret = iwl_load_ucode_wait_alive(priv, IWL_UCODE_INIT); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 506 | if (ret) |
| 507 | goto error; |
| 508 | |
Johannes Berg | e199188 | 2012-03-06 13:30:36 -0800 | [diff] [blame] | 509 | ret = iwl_init_alive_start(priv); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 510 | if (ret) |
| 511 | goto error; |
| 512 | |
| 513 | /* |
| 514 | * Some things may run in the background now, but we |
| 515 | * just wait for the calibration complete notification. |
| 516 | */ |
Johannes Berg | 4bd14dd | 2012-03-06 13:30:58 -0800 | [diff] [blame] | 517 | ret = iwl_wait_notification(&priv->notif_wait, &calib_wait, |
Don Fry | dd5fe10 | 2011-11-28 16:13:19 -0800 | [diff] [blame] | 518 | UCODE_CALIB_TIMEOUT); |
David Spinadel | b5ea162 | 2012-03-10 13:00:11 -0800 | [diff] [blame] | 519 | if (!ret) |
| 520 | priv->init_ucode_run = true; |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 521 | |
| 522 | goto out; |
| 523 | |
| 524 | error: |
Johannes Berg | 4bd14dd | 2012-03-06 13:30:58 -0800 | [diff] [blame] | 525 | iwl_remove_notification(&priv->notif_wait, &calib_wait); |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 526 | out: |
| 527 | /* Whatever happened, stop the device */ |
Emmanuel Grumbach | 68e8dfd | 2012-04-18 07:28:17 -0700 | [diff] [blame] | 528 | iwl_trans_stop_device(priv->trans); |
David Spinadel | 8f7ffbe | 2012-03-10 13:00:10 -0800 | [diff] [blame] | 529 | priv->ucode_loaded = false; |
| 530 | |
Johannes Berg | ca7966c | 2011-04-22 10:15:23 -0700 | [diff] [blame] | 531 | return ret; |
| 532 | } |