Commit | Line | Data |
---|---|---|
792bc3cb WYG |
1 | /****************************************************************************** |
2 | * | |
3 | * GPL LICENSE SUMMARY | |
4 | * | |
51368bf7 | 5 | * Copyright(c) 2008 - 2014 Intel Corporation. All rights reserved. |
792bc3cb WYG |
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 | |
410dc5aa | 22 | * in the file called COPYING. |
792bc3cb WYG |
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> | |
792bc3cb | 31 | |
81b8176e | 32 | #include "iwl-io.h" |
19e6cda0 | 33 | #include "iwl-agn-hw.h" |
bdfbf092 | 34 | #include "iwl-trans.h" |
dda61a44 | 35 | #include "iwl-fh.h" |
d0f76d68 | 36 | #include "iwl-op-mode.h" |
741a6266 | 37 | |
1023fdc4 JB |
38 | #include "dev.h" |
39 | #include "agn.h" | |
40 | #include "calib.h" | |
41 | ||
de7f5f92 DF |
42 | /****************************************************************************** |
43 | * | |
44 | * uCode download functions | |
45 | * | |
46 | ******************************************************************************/ | |
47 | ||
0692fe41 JB |
48 | static inline const struct fw_img * |
49 | iwl_get_ucode_image(struct iwl_priv *priv, enum iwl_ucode_type ucode_type) | |
8929c24b | 50 | { |
6dfa8d01 DS |
51 | if (ucode_type >= IWL_UCODE_TYPE_MAX) |
52 | return NULL; | |
53 | ||
54 | return &priv->fw->img[ucode_type]; | |
8929c24b DF |
55 | } |
56 | ||
741a6266 WYG |
57 | /* |
58 | * Calibration | |
59 | */ | |
e1991885 | 60 | static int iwl_set_Xtal_calib(struct iwl_priv *priv) |
741a6266 WYG |
61 | { |
62 | struct iwl_calib_xtal_freq_cmd cmd; | |
b7998c8b | 63 | __le16 *xtal_calib = priv->nvm_data->xtal_calib; |
741a6266 | 64 | |
1f8bf039 | 65 | iwl_set_calib_hdr(&cmd.hdr, IWL_PHY_CALIBRATE_CRYSTAL_FRQ_CMD); |
741a6266 WYG |
66 | cmd.cap_pin1 = le16_to_cpu(xtal_calib[0]); |
67 | cmd.cap_pin2 = le16_to_cpu(xtal_calib[1]); | |
e1991885 | 68 | return iwl_calib_set(priv, (void *)&cmd, sizeof(cmd)); |
741a6266 WYG |
69 | } |
70 | ||
e1991885 | 71 | static int iwl_set_temperature_offset_calib(struct iwl_priv *priv) |
bf53f939 SZ |
72 | { |
73 | struct iwl_calib_temperature_offset_cmd cmd; | |
1f8bf039 WYG |
74 | |
75 | memset(&cmd, 0, sizeof(cmd)); | |
76 | iwl_set_calib_hdr(&cmd.hdr, IWL_PHY_CALIBRATE_TEMP_OFFSET_CMD); | |
b7998c8b | 77 | cmd.radio_sensor_offset = priv->nvm_data->raw_temperature; |
bf53f939 SZ |
78 | if (!(cmd.radio_sensor_offset)) |
79 | cmd.radio_sensor_offset = DEFAULT_RADIO_SENSOR_OFFSET; | |
1f8bf039 | 80 | |
e1991885 | 81 | IWL_DEBUG_CALIB(priv, "Radio sensor offset: %d\n", |
2e277996 | 82 | le16_to_cpu(cmd.radio_sensor_offset)); |
e1991885 | 83 | return iwl_calib_set(priv, (void *)&cmd, sizeof(cmd)); |
bf53f939 SZ |
84 | } |
85 | ||
e1991885 | 86 | static int iwl_set_temperature_offset_calib_v2(struct iwl_priv *priv) |
c6f30347 WYG |
87 | { |
88 | struct iwl_calib_temperature_offset_v2_cmd cmd; | |
c6f30347 WYG |
89 | |
90 | memset(&cmd, 0, sizeof(cmd)); | |
91 | iwl_set_calib_hdr(&cmd.hdr, IWL_PHY_CALIBRATE_TEMP_OFFSET_CMD); | |
b7998c8b EL |
92 | cmd.radio_sensor_offset_high = priv->nvm_data->kelvin_temperature; |
93 | cmd.radio_sensor_offset_low = priv->nvm_data->raw_temperature; | |
26a7ca9a | 94 | if (!cmd.radio_sensor_offset_low) { |
e1991885 | 95 | IWL_DEBUG_CALIB(priv, "no info in EEPROM, use default\n"); |
c6f30347 WYG |
96 | cmd.radio_sensor_offset_low = DEFAULT_RADIO_SENSOR_OFFSET; |
97 | cmd.radio_sensor_offset_high = DEFAULT_RADIO_SENSOR_OFFSET; | |
98 | } | |
b7998c8b | 99 | cmd.burntVoltageRef = priv->nvm_data->calib_voltage; |
c6f30347 | 100 | |
e1991885 | 101 | IWL_DEBUG_CALIB(priv, "Radio sensor offset high: %d\n", |
c6f30347 | 102 | le16_to_cpu(cmd.radio_sensor_offset_high)); |
e1991885 | 103 | IWL_DEBUG_CALIB(priv, "Radio sensor offset low: %d\n", |
c6f30347 | 104 | le16_to_cpu(cmd.radio_sensor_offset_low)); |
e1991885 | 105 | IWL_DEBUG_CALIB(priv, "Voltage Ref: %d\n", |
c6f30347 WYG |
106 | le16_to_cpu(cmd.burntVoltageRef)); |
107 | ||
e1991885 | 108 | return iwl_calib_set(priv, (void *)&cmd, sizeof(cmd)); |
c6f30347 WYG |
109 | } |
110 | ||
e1991885 | 111 | static int iwl_send_calib_cfg(struct iwl_priv *priv) |
741a6266 WYG |
112 | { |
113 | struct iwl_calib_cfg_cmd calib_cfg_cmd; | |
114 | struct iwl_host_cmd cmd = { | |
115 | .id = CALIBRATION_CFG_CMD, | |
3fa50738 JB |
116 | .len = { sizeof(struct iwl_calib_cfg_cmd), }, |
117 | .data = { &calib_cfg_cmd, }, | |
741a6266 WYG |
118 | }; |
119 | ||
120 | memset(&calib_cfg_cmd, 0, sizeof(calib_cfg_cmd)); | |
121 | calib_cfg_cmd.ucd_calib_cfg.once.is_enable = IWL_CALIB_INIT_CFG_ALL; | |
122 | calib_cfg_cmd.ucd_calib_cfg.once.start = IWL_CALIB_INIT_CFG_ALL; | |
123 | calib_cfg_cmd.ucd_calib_cfg.once.send_res = IWL_CALIB_INIT_CFG_ALL; | |
df2a4dc8 WYG |
124 | calib_cfg_cmd.ucd_calib_cfg.flags = |
125 | IWL_CALIB_CFG_FLAG_SEND_COMPLETE_NTFY_MSK; | |
741a6266 | 126 | |
e10a0533 | 127 | return iwl_dvm_send_cmd(priv, &cmd); |
741a6266 WYG |
128 | } |
129 | ||
e1991885 | 130 | int iwl_init_alive_start(struct iwl_priv *priv) |
741a6266 | 131 | { |
ca7966c8 | 132 | int ret; |
741a6266 | 133 | |
0d8877a1 JB |
134 | if (priv->lib->bt_params && |
135 | priv->lib->bt_params->advanced_bt_coexist) { | |
f7322f8f WYG |
136 | /* |
137 | * Tell uCode we are ready to perform calibration | |
138 | * need to perform this before any calibration | |
139 | * no need to close the envlope since we are going | |
140 | * to load the runtime uCode later. | |
141 | */ | |
e1991885 | 142 | ret = iwl_send_bt_env(priv, IWL_BT_COEX_ENV_OPEN, |
f7322f8f | 143 | BT_COEX_PRIO_TBL_EVT_INIT_CALIB2); |
ca7966c8 JB |
144 | if (ret) |
145 | return ret; | |
f7322f8f WYG |
146 | |
147 | } | |
ca7966c8 | 148 | |
e1991885 | 149 | ret = iwl_send_calib_cfg(priv); |
ca7966c8 JB |
150 | if (ret) |
151 | return ret; | |
bf53f939 SZ |
152 | |
153 | /** | |
154 | * temperature offset calibration is only needed for runtime ucode, | |
155 | * so prepare the value now. | |
156 | */ | |
0d8877a1 JB |
157 | if (priv->lib->need_temp_offset_calib) { |
158 | if (priv->lib->temp_offset_v2) | |
e1991885 | 159 | return iwl_set_temperature_offset_calib_v2(priv); |
c6f30347 | 160 | else |
e1991885 | 161 | return iwl_set_temperature_offset_calib(priv); |
c6f30347 | 162 | } |
741a6266 | 163 | |
ca7966c8 | 164 | return 0; |
741a6266 WYG |
165 | } |
166 | ||
aca86268 | 167 | static int iwl_send_wimax_coex(struct iwl_priv *priv) |
f4012413 WYG |
168 | { |
169 | struct iwl_wimax_coex_cmd coex_cmd; | |
170 | ||
85560af3 JB |
171 | /* coexistence is disabled */ |
172 | memset(&coex_cmd, 0, sizeof(coex_cmd)); | |
f4012413 | 173 | |
e10a0533 | 174 | return iwl_dvm_send_cmd_pdu(priv, |
a1022927 | 175 | COEX_PRIORITY_TABLE_CMD, 0, |
f4012413 WYG |
176 | sizeof(coex_cmd), &coex_cmd); |
177 | } | |
178 | ||
66128b14 | 179 | static const u8 iwl_bt_prio_tbl[BT_COEX_PRIO_TBL_EVT_MAX] = { |
aeb4a2ee WYG |
180 | ((BT_COEX_PRIO_TBL_PRIO_BYPASS << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | |
181 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
182 | ((BT_COEX_PRIO_TBL_PRIO_BYPASS << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | | |
183 | (1 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
184 | ((BT_COEX_PRIO_TBL_PRIO_LOW << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | | |
185 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
186 | ((BT_COEX_PRIO_TBL_PRIO_LOW << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | | |
187 | (1 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
188 | ((BT_COEX_PRIO_TBL_PRIO_HIGH << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | | |
189 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
190 | ((BT_COEX_PRIO_TBL_PRIO_HIGH << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | | |
191 | (1 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
192 | ((BT_COEX_PRIO_TBL_PRIO_BYPASS << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | | |
193 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
194 | ((BT_COEX_PRIO_TBL_PRIO_COEX_OFF << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | | |
195 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
196 | ((BT_COEX_PRIO_TBL_PRIO_COEX_ON << IWL_BT_COEX_PRIO_TBL_PRIO_POS) | | |
197 | (0 << IWL_BT_COEX_PRIO_TBL_SHARED_ANTENNA_POS)), | |
198 | 0, 0, 0, 0, 0, 0, 0 | |
199 | }; | |
200 | ||
e1991885 | 201 | void iwl_send_prio_tbl(struct iwl_priv *priv) |
aeb4a2ee WYG |
202 | { |
203 | struct iwl_bt_coex_prio_table_cmd prio_tbl_cmd; | |
204 | ||
66128b14 DF |
205 | memcpy(prio_tbl_cmd.prio_tbl, iwl_bt_prio_tbl, |
206 | sizeof(iwl_bt_prio_tbl)); | |
e10a0533 | 207 | if (iwl_dvm_send_cmd_pdu(priv, |
a1022927 | 208 | REPLY_BT_COEX_PRIO_TABLE, 0, |
aeb4a2ee | 209 | sizeof(prio_tbl_cmd), &prio_tbl_cmd)) |
e1991885 | 210 | IWL_ERR(priv, "failed to send BT prio tbl command\n"); |
aeb4a2ee WYG |
211 | } |
212 | ||
e1991885 | 213 | int iwl_send_bt_env(struct iwl_priv *priv, u8 action, u8 type) |
aeb4a2ee WYG |
214 | { |
215 | struct iwl_bt_coex_prot_env_cmd env_cmd; | |
ca7966c8 | 216 | int ret; |
aeb4a2ee WYG |
217 | |
218 | env_cmd.action = action; | |
219 | env_cmd.type = type; | |
e10a0533 | 220 | ret = iwl_dvm_send_cmd_pdu(priv, |
a1022927 | 221 | REPLY_BT_COEX_PROT_ENV, 0, |
ca7966c8 JB |
222 | sizeof(env_cmd), &env_cmd); |
223 | if (ret) | |
e1991885 | 224 | IWL_ERR(priv, "failed to send BT env command\n"); |
ca7966c8 | 225 | return ret; |
aeb4a2ee WYG |
226 | } |
227 | ||
b04db9ac EG |
228 | static const u8 iwlagn_default_queue_to_tx_fifo[] = { |
229 | IWL_TX_FIFO_VO, | |
230 | IWL_TX_FIFO_VI, | |
231 | IWL_TX_FIFO_BE, | |
232 | IWL_TX_FIFO_BK, | |
233 | }; | |
234 | ||
235 | static const u8 iwlagn_ipan_queue_to_tx_fifo[] = { | |
236 | IWL_TX_FIFO_VO, | |
237 | IWL_TX_FIFO_VI, | |
238 | IWL_TX_FIFO_BE, | |
239 | IWL_TX_FIFO_BK, | |
240 | IWL_TX_FIFO_BK_IPAN, | |
241 | IWL_TX_FIFO_BE_IPAN, | |
242 | IWL_TX_FIFO_VI_IPAN, | |
243 | IWL_TX_FIFO_VO_IPAN, | |
244 | IWL_TX_FIFO_BE_IPAN, | |
245 | IWL_TX_FIFO_UNUSED, | |
246 | IWL_TX_FIFO_AUX, | |
247 | }; | |
aeb4a2ee | 248 | |
e1991885 | 249 | static int iwl_alive_notify(struct iwl_priv *priv) |
741a6266 | 250 | { |
b04db9ac EG |
251 | const u8 *queue_to_txf; |
252 | u8 n_queues; | |
7415952f | 253 | int ret; |
b04db9ac | 254 | int i; |
741a6266 | 255 | |
adca1235 | 256 | iwl_trans_fw_alive(priv->trans, 0); |
e755f882 | 257 | |
b04db9ac | 258 | if (priv->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_PAN && |
b7998c8b | 259 | priv->nvm_data->sku_cap_ipan_enable) { |
b04db9ac EG |
260 | n_queues = ARRAY_SIZE(iwlagn_ipan_queue_to_tx_fifo); |
261 | queue_to_txf = iwlagn_ipan_queue_to_tx_fifo; | |
262 | } else { | |
263 | n_queues = ARRAY_SIZE(iwlagn_default_queue_to_tx_fifo); | |
264 | queue_to_txf = iwlagn_default_queue_to_tx_fifo; | |
265 | } | |
266 | ||
267 | for (i = 0; i < n_queues; i++) | |
268 | if (queue_to_txf[i] != IWL_TX_FIFO_UNUSED) | |
269 | iwl_trans_ac_txq_enable(priv->trans, i, | |
4cf677fd | 270 | queue_to_txf[i], 0); |
b04db9ac | 271 | |
e755f882 JB |
272 | priv->passive_no_rx = false; |
273 | priv->transport_queue_stop = 0; | |
e7cad69c | 274 | |
e1991885 | 275 | ret = iwl_send_wimax_coex(priv); |
7415952f WYG |
276 | if (ret) |
277 | return ret; | |
278 | ||
0d8877a1 | 279 | if (!priv->lib->no_xtal_calib) { |
e1991885 | 280 | ret = iwl_set_Xtal_calib(priv); |
93b64105 JB |
281 | if (ret) |
282 | return ret; | |
283 | } | |
741a6266 | 284 | |
e1991885 | 285 | return iwl_send_calib_results(priv); |
741a6266 | 286 | } |
db41dd27 | 287 | |
69a679b0 | 288 | struct iwl_alive_data { |
ca7966c8 JB |
289 | bool valid; |
290 | u8 subtype; | |
291 | }; | |
292 | ||
db662d47 JB |
293 | static bool iwl_alive_fn(struct iwl_notif_wait_data *notif_wait, |
294 | struct iwl_rx_packet *pkt, void *data) | |
ca7966c8 | 295 | { |
4bd14dd5 JB |
296 | struct iwl_priv *priv = |
297 | container_of(notif_wait, struct iwl_priv, notif_wait); | |
69a679b0 | 298 | struct iwl_alive_data *alive_data = data; |
ca7966c8 JB |
299 | struct iwl_alive_resp *palive; |
300 | ||
f8d7c1a1 | 301 | palive = (void *)pkt->data; |
ca7966c8 | 302 | |
e1991885 | 303 | IWL_DEBUG_FW(priv, "Alive ucode status 0x%08X revision " |
ca7966c8 JB |
304 | "0x%01X 0x%01X\n", |
305 | palive->is_valid, palive->ver_type, | |
306 | palive->ver_subtype); | |
307 | ||
2fdfc476 | 308 | priv->device_pointers.error_event_table = |
ca7966c8 | 309 | le32_to_cpu(palive->error_event_table_ptr); |
2fdfc476 | 310 | priv->device_pointers.log_event_table = |
ca7966c8 JB |
311 | le32_to_cpu(palive->log_event_table_ptr); |
312 | ||
313 | alive_data->subtype = palive->ver_subtype; | |
314 | alive_data->valid = palive->is_valid == UCODE_VALID_OK; | |
db662d47 JB |
315 | |
316 | return true; | |
ca7966c8 JB |
317 | } |
318 | ||
319 | #define UCODE_ALIVE_TIMEOUT HZ | |
320 | #define UCODE_CALIB_TIMEOUT (2*HZ) | |
321 | ||
e1991885 | 322 | int iwl_load_ucode_wait_alive(struct iwl_priv *priv, |
de7f5f92 | 323 | enum iwl_ucode_type ucode_type) |
ca7966c8 JB |
324 | { |
325 | struct iwl_notification_wait alive_wait; | |
69a679b0 | 326 | struct iwl_alive_data alive_data; |
0692fe41 | 327 | const struct fw_img *fw; |
ca7966c8 | 328 | int ret; |
de7f5f92 | 329 | enum iwl_ucode_type old_type; |
db662d47 | 330 | static const u8 alive_cmd[] = { REPLY_ALIVE }; |
ca7966c8 | 331 | |
e1991885 | 332 | fw = iwl_get_ucode_image(priv, ucode_type); |
befe9b6f JB |
333 | if (WARN_ON(!fw)) |
334 | return -EINVAL; | |
ca7966c8 | 335 | |
befe9b6f JB |
336 | old_type = priv->cur_ucode; |
337 | priv->cur_ucode = ucode_type; | |
8f7ffbe2 DS |
338 | priv->ucode_loaded = false; |
339 | ||
db662d47 JB |
340 | iwl_init_notification_wait(&priv->notif_wait, &alive_wait, |
341 | alive_cmd, ARRAY_SIZE(alive_cmd), | |
342 | iwl_alive_fn, &alive_data); | |
f4720893 | 343 | |
6ae02f3e | 344 | ret = iwl_trans_start_fw(priv->trans, fw, false); |
ca7966c8 | 345 | if (ret) { |
a42506eb | 346 | priv->cur_ucode = old_type; |
4bd14dd5 | 347 | iwl_remove_notification(&priv->notif_wait, &alive_wait); |
ca7966c8 JB |
348 | return ret; |
349 | } | |
350 | ||
ca7966c8 JB |
351 | /* |
352 | * Some things may run in the background now, but we | |
353 | * just wait for the ALIVE notification here. | |
354 | */ | |
4bd14dd5 | 355 | ret = iwl_wait_notification(&priv->notif_wait, &alive_wait, |
dd5fe104 | 356 | UCODE_ALIVE_TIMEOUT); |
ca7966c8 | 357 | if (ret) { |
a42506eb | 358 | priv->cur_ucode = old_type; |
ca7966c8 JB |
359 | return ret; |
360 | } | |
361 | ||
362 | if (!alive_data.valid) { | |
e1991885 | 363 | IWL_ERR(priv, "Loaded ucode is not valid!\n"); |
a42506eb | 364 | priv->cur_ucode = old_type; |
ca7966c8 JB |
365 | return -EIO; |
366 | } | |
367 | ||
2d5d50ee EG |
368 | priv->ucode_loaded = true; |
369 | ||
c8ac61cf | 370 | if (ucode_type != IWL_UCODE_WOWLAN) { |
c8ac61cf JB |
371 | /* delay a bit to give rfkill time to run */ |
372 | msleep(5); | |
373 | } | |
ca7966c8 | 374 | |
e1991885 | 375 | ret = iwl_alive_notify(priv); |
ca7966c8 | 376 | if (ret) { |
e1991885 | 377 | IWL_WARN(priv, |
ca7966c8 | 378 | "Could not complete ALIVE transition: %d\n", ret); |
a42506eb | 379 | priv->cur_ucode = old_type; |
ca7966c8 JB |
380 | return ret; |
381 | } | |
382 | ||
383 | return 0; | |
384 | } | |
385 | ||
e1f0c501 JB |
386 | static bool iwlagn_wait_calib(struct iwl_notif_wait_data *notif_wait, |
387 | struct iwl_rx_packet *pkt, void *data) | |
388 | { | |
389 | struct iwl_priv *priv = data; | |
390 | struct iwl_calib_hdr *hdr; | |
e1f0c501 JB |
391 | |
392 | if (pkt->hdr.cmd != CALIBRATION_RES_NOTIFICATION) { | |
393 | WARN_ON(pkt->hdr.cmd != CALIBRATION_COMPLETE_NOTIFICATION); | |
394 | return true; | |
395 | } | |
396 | ||
397 | hdr = (struct iwl_calib_hdr *)pkt->data; | |
e1f0c501 | 398 | |
65b30348 | 399 | if (iwl_calib_set(priv, hdr, iwl_rx_packet_payload_len(pkt))) |
e1f0c501 JB |
400 | IWL_ERR(priv, "Failed to record calibration data %d\n", |
401 | hdr->op_code); | |
402 | ||
403 | return false; | |
404 | } | |
405 | ||
e1991885 | 406 | int iwl_run_init_ucode(struct iwl_priv *priv) |
ca7966c8 JB |
407 | { |
408 | struct iwl_notification_wait calib_wait; | |
db662d47 | 409 | static const u8 calib_complete[] = { |
e1f0c501 | 410 | CALIBRATION_RES_NOTIFICATION, |
db662d47 JB |
411 | CALIBRATION_COMPLETE_NOTIFICATION |
412 | }; | |
ca7966c8 JB |
413 | int ret; |
414 | ||
b1eea297 | 415 | lockdep_assert_held(&priv->mutex); |
ca7966c8 JB |
416 | |
417 | /* No init ucode required? Curious, but maybe ok */ | |
6dfa8d01 | 418 | if (!priv->fw->img[IWL_UCODE_INIT].sec[0].len) |
ca7966c8 JB |
419 | return 0; |
420 | ||
4bd14dd5 | 421 | iwl_init_notification_wait(&priv->notif_wait, &calib_wait, |
db662d47 | 422 | calib_complete, ARRAY_SIZE(calib_complete), |
e1f0c501 | 423 | iwlagn_wait_calib, priv); |
ca7966c8 JB |
424 | |
425 | /* Will also start the device */ | |
e1991885 | 426 | ret = iwl_load_ucode_wait_alive(priv, IWL_UCODE_INIT); |
ca7966c8 JB |
427 | if (ret) |
428 | goto error; | |
429 | ||
e1991885 | 430 | ret = iwl_init_alive_start(priv); |
ca7966c8 JB |
431 | if (ret) |
432 | goto error; | |
433 | ||
434 | /* | |
435 | * Some things may run in the background now, but we | |
436 | * just wait for the calibration complete notification. | |
437 | */ | |
4bd14dd5 | 438 | ret = iwl_wait_notification(&priv->notif_wait, &calib_wait, |
dd5fe104 | 439 | UCODE_CALIB_TIMEOUT); |
ca7966c8 JB |
440 | |
441 | goto out; | |
442 | ||
443 | error: | |
4bd14dd5 | 444 | iwl_remove_notification(&priv->notif_wait, &calib_wait); |
ca7966c8 JB |
445 | out: |
446 | /* Whatever happened, stop the device */ | |
68e8dfda | 447 | iwl_trans_stop_device(priv->trans); |
8f7ffbe2 DS |
448 | priv->ucode_loaded = false; |
449 | ||
ca7966c8 JB |
450 | return ret; |
451 | } |