]>
Commit | Line | Data |
---|---|---|
fb7d879f OW |
1 | /* |
2 | * | |
3 | * Intel Management Engine Interface (Intel MEI) Linux driver | |
733ba91c | 4 | * Copyright (c) 2003-2012, Intel Corporation. |
fb7d879f OW |
5 | * |
6 | * This program is free software; you can redistribute it and/or modify it | |
7 | * under the terms and conditions of the GNU General Public License, | |
8 | * version 2, as published by the Free Software Foundation. | |
9 | * | |
10 | * This program is distributed in the hope it will be useful, but WITHOUT | |
11 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
12 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
13 | * more details. | |
14 | * | |
15 | */ | |
16 | ||
17 | ||
40e0b67b | 18 | #include <linux/export.h> |
fb7d879f OW |
19 | #include <linux/kthread.h> |
20 | #include <linux/interrupt.h> | |
21 | #include <linux/fs.h> | |
22 | #include <linux/jiffies.h> | |
1f180359 | 23 | #include <linux/slab.h> |
34af1913 | 24 | #include <linux/pm_runtime.h> |
fb7d879f | 25 | |
4f3afe1d | 26 | #include <linux/mei.h> |
47a73801 TW |
27 | |
28 | #include "mei_dev.h" | |
0edb23fc | 29 | #include "hbm.h" |
90e0b5f1 | 30 | #include "client.h" |
fb7d879f OW |
31 | |
32 | ||
4c6e22b8 | 33 | /** |
83ce0741 | 34 | * mei_irq_compl_handler - dispatch complete handlers |
4c6e22b8 TW |
35 | * for the completed callbacks |
36 | * | |
a8605ea2 AU |
37 | * @dev: mei device |
38 | * @compl_list: list of completed cbs | |
4c6e22b8 TW |
39 | */ |
40 | void mei_irq_compl_handler(struct mei_device *dev, struct mei_cl_cb *compl_list) | |
41 | { | |
42 | struct mei_cl_cb *cb, *next; | |
43 | struct mei_cl *cl; | |
44 | ||
45 | list_for_each_entry_safe(cb, next, &compl_list->list, list) { | |
46 | cl = cb->cl; | |
c54bf3ab | 47 | list_del_init(&cb->list); |
4c6e22b8 | 48 | |
2bf94cab | 49 | dev_dbg(dev->dev, "completing call back.\n"); |
4c6e22b8 | 50 | if (cl == &dev->iamthif_cl) |
9abd8b31 | 51 | mei_amthif_complete(cl, cb); |
4c6e22b8 | 52 | else |
db086fa9 | 53 | mei_cl_complete(cl, cb); |
4c6e22b8 TW |
54 | } |
55 | } | |
40e0b67b | 56 | EXPORT_SYMBOL_GPL(mei_irq_compl_handler); |
6e0f180f | 57 | |
fb7d879f | 58 | /** |
6e0f180f | 59 | * mei_cl_hbm_equal - check if hbm is addressed to the client |
fb7d879f | 60 | * |
6e0f180f | 61 | * @cl: host client |
fb7d879f OW |
62 | * @mei_hdr: header of mei client message |
63 | * | |
a8605ea2 | 64 | * Return: true if matches, false otherwise |
fb7d879f | 65 | */ |
6e0f180f TW |
66 | static inline int mei_cl_hbm_equal(struct mei_cl *cl, |
67 | struct mei_msg_hdr *mei_hdr) | |
fb7d879f | 68 | { |
1df629ef | 69 | return mei_cl_host_addr(cl) == mei_hdr->host_addr && |
d49ed64a | 70 | mei_cl_me_id(cl) == mei_hdr->me_addr; |
6e0f180f | 71 | } |
fb7d879f | 72 | |
331e4187 TW |
73 | /** |
74 | * mei_irq_discard_msg - discard received message | |
75 | * | |
76 | * @dev: mei device | |
77 | * @hdr: message header | |
78 | */ | |
79 | static inline | |
80 | void mei_irq_discard_msg(struct mei_device *dev, struct mei_msg_hdr *hdr) | |
81 | { | |
82 | /* | |
83 | * no need to check for size as it is guarantied | |
84 | * that length fits into rd_msg_buf | |
85 | */ | |
86 | mei_read_slots(dev, dev->rd_msg_buf, hdr->length); | |
87 | dev_dbg(dev->dev, "discarding message " MEI_HDR_FMT "\n", | |
88 | MEI_HDR_PRM(hdr)); | |
89 | } | |
90 | ||
fb7d879f | 91 | /** |
ce23139c | 92 | * mei_cl_irq_read_msg - process client message |
fb7d879f | 93 | * |
3d33ff24 | 94 | * @cl: reading client |
fb7d879f | 95 | * @mei_hdr: header of mei client message |
3d33ff24 | 96 | * @complete_list: completion list |
fb7d879f | 97 | * |
3d33ff24 | 98 | * Return: always 0 |
fb7d879f | 99 | */ |
331e4187 TW |
100 | int mei_cl_irq_read_msg(struct mei_cl *cl, |
101 | struct mei_msg_hdr *mei_hdr, | |
102 | struct mei_cl_cb *complete_list) | |
fb7d879f | 103 | { |
3d33ff24 TW |
104 | struct mei_device *dev = cl->dev; |
105 | struct mei_cl_cb *cb; | |
479bc59d | 106 | unsigned char *buffer = NULL; |
f862b6b2 | 107 | size_t buf_sz; |
fb7d879f | 108 | |
a9bed610 TW |
109 | cb = list_first_entry_or_null(&cl->rd_pending, struct mei_cl_cb, list); |
110 | if (!cb) { | |
111 | cl_err(dev, cl, "pending read cb not found\n"); | |
3d33ff24 TW |
112 | goto out; |
113 | } | |
6e0f180f | 114 | |
f3de9b63 | 115 | if (!mei_cl_is_connected(cl)) { |
a9bed610 TW |
116 | cl_dbg(dev, cl, "not connected\n"); |
117 | cb->status = -ENODEV; | |
3d33ff24 TW |
118 | goto out; |
119 | } | |
6e0f180f | 120 | |
5db7514d | 121 | if (cb->buf.size == 0 || cb->buf.data == NULL) { |
3d33ff24 TW |
122 | cl_err(dev, cl, "response buffer is not allocated.\n"); |
123 | list_move_tail(&cb->list, &complete_list->list); | |
124 | cb->status = -ENOMEM; | |
125 | goto out; | |
126 | } | |
6e0f180f | 127 | |
f862b6b2 TW |
128 | buf_sz = mei_hdr->length + cb->buf_idx; |
129 | /* catch for integer overflow */ | |
130 | if (buf_sz < cb->buf_idx) { | |
131 | cl_err(dev, cl, "message is too big len %d idx %ld\n", | |
132 | mei_hdr->length, cb->buf_idx); | |
133 | ||
134 | list_move_tail(&cb->list, &complete_list->list); | |
135 | cb->status = -EMSGSIZE; | |
136 | goto out; | |
137 | } | |
138 | ||
139 | if (cb->buf.size < buf_sz) { | |
140 | cl_dbg(dev, cl, "message overflow. size %zd len %d idx %zd\n", | |
5db7514d | 141 | cb->buf.size, mei_hdr->length, cb->buf_idx); |
f862b6b2 | 142 | buffer = krealloc(cb->buf.data, buf_sz, GFP_KERNEL); |
3d33ff24 TW |
143 | |
144 | if (!buffer) { | |
145 | cb->status = -ENOMEM; | |
146 | list_move_tail(&cb->list, &complete_list->list); | |
147 | goto out; | |
6e0f180f | 148 | } |
5db7514d | 149 | cb->buf.data = buffer; |
f862b6b2 | 150 | cb->buf.size = buf_sz; |
fb7d879f OW |
151 | } |
152 | ||
5db7514d | 153 | buffer = cb->buf.data + cb->buf_idx; |
3d33ff24 TW |
154 | mei_read_slots(dev, buffer, mei_hdr->length); |
155 | ||
156 | cb->buf_idx += mei_hdr->length; | |
331e4187 | 157 | |
3d33ff24 | 158 | if (mei_hdr->msg_complete) { |
a9bed610 | 159 | cl_dbg(dev, cl, "completed read length = %lu\n", cb->buf_idx); |
3d33ff24 | 160 | list_move_tail(&cb->list, &complete_list->list); |
34af1913 AU |
161 | } else { |
162 | pm_runtime_mark_last_busy(dev->dev); | |
163 | pm_request_autosuspend(dev->dev); | |
3d33ff24 TW |
164 | } |
165 | ||
166 | out: | |
331e4187 TW |
167 | if (!buffer) |
168 | mei_irq_discard_msg(dev, mei_hdr); | |
fb7d879f OW |
169 | |
170 | return 0; | |
171 | } | |
172 | ||
6bb948c9 TW |
173 | /** |
174 | * mei_cl_irq_disconnect_rsp - send disconnection response message | |
175 | * | |
176 | * @cl: client | |
177 | * @cb: callback block. | |
6bb948c9 TW |
178 | * @cmpl_list: complete list. |
179 | * | |
a8605ea2 | 180 | * Return: 0, OK; otherwise, error. |
6bb948c9 TW |
181 | */ |
182 | static int mei_cl_irq_disconnect_rsp(struct mei_cl *cl, struct mei_cl_cb *cb, | |
9d098192 | 183 | struct mei_cl_cb *cmpl_list) |
6bb948c9 TW |
184 | { |
185 | struct mei_device *dev = cl->dev; | |
9d098192 TW |
186 | u32 msg_slots; |
187 | int slots; | |
6bb948c9 TW |
188 | int ret; |
189 | ||
9d098192 TW |
190 | slots = mei_hbuf_empty_slots(dev); |
191 | msg_slots = mei_data2slots(sizeof(struct hbm_client_connect_response)); | |
6bb948c9 | 192 | |
9d098192 | 193 | if (slots < msg_slots) |
6bb948c9 TW |
194 | return -EMSGSIZE; |
195 | ||
6bb948c9 | 196 | ret = mei_hbm_cl_disconnect_rsp(dev, cl); |
3c666182 | 197 | mei_cl_set_disconnected(cl); |
6bb948c9 | 198 | mei_io_cb_free(cb); |
d49ed64a AU |
199 | mei_me_cl_put(cl->me_cl); |
200 | cl->me_cl = NULL; | |
6bb948c9 TW |
201 | |
202 | return ret; | |
203 | } | |
204 | ||
fb7d879f | 205 | /** |
ce23139c | 206 | * mei_cl_irq_read - processes client read related operation from the |
6220d6a0 | 207 | * interrupt thread context - request for flow control credits |
fb7d879f | 208 | * |
6220d6a0 TW |
209 | * @cl: client |
210 | * @cb: callback block. | |
fb7d879f OW |
211 | * @cmpl_list: complete list. |
212 | * | |
a8605ea2 | 213 | * Return: 0, OK; otherwise, error. |
fb7d879f | 214 | */ |
6220d6a0 | 215 | static int mei_cl_irq_read(struct mei_cl *cl, struct mei_cl_cb *cb, |
9d098192 | 216 | struct mei_cl_cb *cmpl_list) |
fb7d879f | 217 | { |
6220d6a0 | 218 | struct mei_device *dev = cl->dev; |
9d098192 TW |
219 | u32 msg_slots; |
220 | int slots; | |
2ebf8c94 TW |
221 | int ret; |
222 | ||
9d098192 TW |
223 | msg_slots = mei_data2slots(sizeof(struct hbm_flow_control)); |
224 | slots = mei_hbuf_empty_slots(dev); | |
2ebf8c94 | 225 | |
9d098192 | 226 | if (slots < msg_slots) |
c8c8d080 | 227 | return -EMSGSIZE; |
7bdf72d3 | 228 | |
2ebf8c94 TW |
229 | ret = mei_hbm_cl_flow_control_req(dev, cl); |
230 | if (ret) { | |
231 | cl->status = ret; | |
6220d6a0 TW |
232 | cb->buf_idx = 0; |
233 | list_move_tail(&cb->list, &cmpl_list->list); | |
2ebf8c94 | 234 | return ret; |
1ccb7b62 | 235 | } |
2ebf8c94 | 236 | |
a9bed610 | 237 | list_move_tail(&cb->list, &cl->rd_pending); |
1ccb7b62 | 238 | |
fb7d879f OW |
239 | return 0; |
240 | } | |
241 | ||
fb7d879f | 242 | /** |
393b148f | 243 | * mei_irq_read_handler - bottom half read routine after ISR to |
fb7d879f OW |
244 | * handle the read processing. |
245 | * | |
fb7d879f | 246 | * @dev: the device structure |
06ecd645 | 247 | * @cmpl_list: An instance of our list structure |
fb7d879f OW |
248 | * @slots: slots to read. |
249 | * | |
a8605ea2 | 250 | * Return: 0 on success, <0 on failure. |
fb7d879f | 251 | */ |
06ecd645 TW |
252 | int mei_irq_read_handler(struct mei_device *dev, |
253 | struct mei_cl_cb *cmpl_list, s32 *slots) | |
fb7d879f OW |
254 | { |
255 | struct mei_msg_hdr *mei_hdr; | |
10ee9074 TW |
256 | struct mei_cl *cl; |
257 | int ret; | |
fb7d879f OW |
258 | |
259 | if (!dev->rd_msg_hdr) { | |
827eef51 | 260 | dev->rd_msg_hdr = mei_read_hdr(dev); |
fb7d879f | 261 | (*slots)--; |
2bf94cab | 262 | dev_dbg(dev->dev, "slots =%08x.\n", *slots); |
fb7d879f OW |
263 | } |
264 | mei_hdr = (struct mei_msg_hdr *) &dev->rd_msg_hdr; | |
2bf94cab | 265 | dev_dbg(dev->dev, MEI_HDR_FMT, MEI_HDR_PRM(mei_hdr)); |
fb7d879f OW |
266 | |
267 | if (mei_hdr->reserved || !dev->rd_msg_hdr) { | |
2bf94cab | 268 | dev_err(dev->dev, "corrupted message header 0x%08X\n", |
10ee9074 | 269 | dev->rd_msg_hdr); |
fb7d879f OW |
270 | ret = -EBADMSG; |
271 | goto end; | |
272 | } | |
273 | ||
10ee9074 | 274 | if (mei_slots2data(*slots) < mei_hdr->length) { |
2bf94cab | 275 | dev_err(dev->dev, "less data available than length=%08x.\n", |
fb7d879f OW |
276 | *slots); |
277 | /* we can't read the message */ | |
b1b94b5d | 278 | ret = -ENODATA; |
fb7d879f OW |
279 | goto end; |
280 | } | |
281 | ||
10ee9074 TW |
282 | /* HBM message */ |
283 | if (mei_hdr->host_addr == 0 && mei_hdr->me_addr == 0) { | |
544f9460 TW |
284 | ret = mei_hbm_dispatch(dev, mei_hdr); |
285 | if (ret) { | |
2bf94cab | 286 | dev_dbg(dev->dev, "mei_hbm_dispatch failed ret = %d\n", |
544f9460 TW |
287 | ret); |
288 | goto end; | |
289 | } | |
10ee9074 TW |
290 | goto reset_slots; |
291 | } | |
15d4acc5 | 292 | |
83ce0741 | 293 | /* find recipient cl */ |
10ee9074 TW |
294 | list_for_each_entry(cl, &dev->file_list, link) { |
295 | if (mei_cl_hbm_equal(cl, mei_hdr)) { | |
296 | cl_dbg(dev, cl, "got a message\n"); | |
297 | break; | |
298 | } | |
299 | } | |
300 | ||
83ce0741 | 301 | /* if no recipient cl was found we assume corrupted header */ |
10ee9074 | 302 | if (&cl->link == &dev->file_list) { |
2bf94cab | 303 | dev_err(dev->dev, "no destination client found 0x%08X\n", |
10ee9074 TW |
304 | dev->rd_msg_hdr); |
305 | ret = -EBADMSG; | |
306 | goto end; | |
307 | } | |
308 | ||
db4756fd TW |
309 | if (cl == &dev->iamthif_cl) { |
310 | ret = mei_amthif_irq_read_msg(cl, mei_hdr, cmpl_list); | |
fb7d879f | 311 | } else { |
3d33ff24 | 312 | ret = mei_cl_irq_read_msg(cl, mei_hdr, cmpl_list); |
fb7d879f OW |
313 | } |
314 | ||
3d33ff24 | 315 | |
10ee9074 | 316 | reset_slots: |
fb7d879f OW |
317 | /* reset the number of slots and header */ |
318 | *slots = mei_count_full_read_slots(dev); | |
319 | dev->rd_msg_hdr = 0; | |
320 | ||
321 | if (*slots == -EOVERFLOW) { | |
322 | /* overflow - reset */ | |
2bf94cab | 323 | dev_err(dev->dev, "resetting due to slots overflow.\n"); |
fb7d879f OW |
324 | /* set the event since message has been read */ |
325 | ret = -ERANGE; | |
326 | goto end; | |
327 | } | |
328 | end: | |
329 | return ret; | |
330 | } | |
40e0b67b | 331 | EXPORT_SYMBOL_GPL(mei_irq_read_handler); |
fb7d879f OW |
332 | |
333 | ||
334 | /** | |
06ecd645 TW |
335 | * mei_irq_write_handler - dispatch write requests |
336 | * after irq received | |
fb7d879f | 337 | * |
fb7d879f | 338 | * @dev: the device structure |
9a84d616 | 339 | * @cmpl_list: An instance of our list structure |
fb7d879f | 340 | * |
a8605ea2 | 341 | * Return: 0 on success, <0 on failure. |
fb7d879f | 342 | */ |
c8c8d080 | 343 | int mei_irq_write_handler(struct mei_device *dev, struct mei_cl_cb *cmpl_list) |
fb7d879f OW |
344 | { |
345 | ||
346 | struct mei_cl *cl; | |
6220d6a0 | 347 | struct mei_cl_cb *cb, *next; |
fb601adb | 348 | struct mei_cl_cb *list; |
9a84d616 | 349 | s32 slots; |
fb7d879f OW |
350 | int ret; |
351 | ||
6aae48ff TW |
352 | |
353 | if (!mei_hbuf_acquire(dev)) | |
fb7d879f | 354 | return 0; |
6aae48ff | 355 | |
9a84d616 TW |
356 | slots = mei_hbuf_empty_slots(dev); |
357 | if (slots <= 0) | |
7d5e0e59 TW |
358 | return -EMSGSIZE; |
359 | ||
fb7d879f | 360 | /* complete all waiting for write CB */ |
2bf94cab | 361 | dev_dbg(dev->dev, "complete all waiting for write cb.\n"); |
fb7d879f OW |
362 | |
363 | list = &dev->write_waiting_list; | |
6220d6a0 TW |
364 | list_for_each_entry_safe(cb, next, &list->list, list) { |
365 | cl = cb->cl; | |
b7cd2d9f TW |
366 | |
367 | cl->status = 0; | |
c54bf3ab TW |
368 | cl_dbg(dev, cl, "MEI WRITE COMPLETE\n"); |
369 | cl->writing_state = MEI_WRITE_COMPLETE; | |
370 | list_move_tail(&cb->list, &cmpl_list->list); | |
fb7d879f OW |
371 | } |
372 | ||
fb7d879f | 373 | /* complete control write list CB */ |
2bf94cab | 374 | dev_dbg(dev->dev, "complete control write list cb.\n"); |
6220d6a0 TW |
375 | list_for_each_entry_safe(cb, next, &dev->ctrl_wr_list.list, list) { |
376 | cl = cb->cl; | |
6220d6a0 | 377 | switch (cb->fop_type) { |
5a8373fb | 378 | case MEI_FOP_DISCONNECT: |
c8372094 | 379 | /* send disconnect message */ |
5a8373fb | 380 | ret = mei_cl_irq_disconnect(cl, cb, cmpl_list); |
c8372094 TW |
381 | if (ret) |
382 | return ret; | |
fb7d879f | 383 | |
c8372094 | 384 | break; |
4b8960b4 | 385 | case MEI_FOP_READ: |
c8372094 | 386 | /* send flow control message */ |
9d098192 | 387 | ret = mei_cl_irq_read(cl, cb, cmpl_list); |
c8372094 TW |
388 | if (ret) |
389 | return ret; | |
fb7d879f | 390 | |
c8372094 | 391 | break; |
02a7eecc | 392 | case MEI_FOP_CONNECT: |
c8372094 | 393 | /* connect message */ |
9d098192 | 394 | ret = mei_cl_irq_connect(cl, cb, cmpl_list); |
c8372094 TW |
395 | if (ret) |
396 | return ret; | |
fb7d879f | 397 | |
c8372094 | 398 | break; |
6bb948c9 TW |
399 | case MEI_FOP_DISCONNECT_RSP: |
400 | /* send disconnect resp */ | |
9d098192 | 401 | ret = mei_cl_irq_disconnect_rsp(cl, cb, cmpl_list); |
6bb948c9 TW |
402 | if (ret) |
403 | return ret; | |
31a5ef24 | 404 | break; |
51678ccb TW |
405 | |
406 | case MEI_FOP_NOTIFY_START: | |
407 | case MEI_FOP_NOTIFY_STOP: | |
408 | ret = mei_cl_irq_notify(cl, cb, cmpl_list); | |
409 | if (ret) | |
410 | return ret; | |
411 | break; | |
c8372094 TW |
412 | default: |
413 | BUG(); | |
fb7d879f | 414 | } |
c8372094 | 415 | |
fb7d879f OW |
416 | } |
417 | /* complete write list CB */ | |
2bf94cab | 418 | dev_dbg(dev->dev, "complete write list cb.\n"); |
6220d6a0 TW |
419 | list_for_each_entry_safe(cb, next, &dev->write_list.list, list) { |
420 | cl = cb->cl; | |
be9d87a7 | 421 | if (cl == &dev->iamthif_cl) |
9d098192 | 422 | ret = mei_amthif_irq_write(cl, cb, cmpl_list); |
be9d87a7 | 423 | else |
9d098192 | 424 | ret = mei_cl_irq_write(cl, cb, cmpl_list); |
be9d87a7 TW |
425 | if (ret) |
426 | return ret; | |
fb7d879f OW |
427 | } |
428 | return 0; | |
429 | } | |
40e0b67b | 430 | EXPORT_SYMBOL_GPL(mei_irq_write_handler); |
fb7d879f OW |
431 | |
432 | ||
18901357 AU |
433 | /** |
434 | * mei_connect_timeout - connect/disconnect timeouts | |
435 | * | |
436 | * @cl: host client | |
437 | */ | |
438 | static void mei_connect_timeout(struct mei_cl *cl) | |
439 | { | |
440 | struct mei_device *dev = cl->dev; | |
441 | ||
442 | if (cl->state == MEI_FILE_CONNECTING) { | |
443 | if (dev->hbm_f_dot_supported) { | |
444 | cl->state = MEI_FILE_DISCONNECT_REQUIRED; | |
445 | wake_up(&cl->wait); | |
446 | return; | |
447 | } | |
448 | } | |
449 | mei_reset(dev); | |
450 | } | |
fb7d879f OW |
451 | |
452 | /** | |
453 | * mei_timer - timer function. | |
454 | * | |
455 | * @work: pointer to the work_struct structure | |
456 | * | |
fb7d879f | 457 | */ |
a61c6530 | 458 | void mei_timer(struct work_struct *work) |
fb7d879f | 459 | { |
31f88f57 | 460 | struct mei_cl *cl; |
fb7d879f OW |
461 | |
462 | struct mei_device *dev = container_of(work, | |
a61c6530 | 463 | struct mei_device, timer_work.work); |
fb7d879f OW |
464 | |
465 | ||
466 | mutex_lock(&dev->device_lock); | |
66ae460b TW |
467 | |
468 | /* Catch interrupt stalls during HBM init handshake */ | |
469 | if (dev->dev_state == MEI_DEV_INIT_CLIENTS && | |
470 | dev->hbm_state != MEI_HBM_IDLE) { | |
471 | ||
472 | if (dev->init_clients_timer) { | |
473 | if (--dev->init_clients_timer == 0) { | |
2bf94cab | 474 | dev_err(dev->dev, "timer: init clients timeout hbm_state = %d.\n", |
66ae460b | 475 | dev->hbm_state); |
33ec0826 | 476 | mei_reset(dev); |
66ae460b | 477 | goto out; |
fb7d879f OW |
478 | } |
479 | } | |
fb7d879f | 480 | } |
66ae460b TW |
481 | |
482 | if (dev->dev_state != MEI_DEV_ENABLED) | |
483 | goto out; | |
484 | ||
fb7d879f | 485 | /*** connect/disconnect timeouts ***/ |
31f88f57 TW |
486 | list_for_each_entry(cl, &dev->file_list, link) { |
487 | if (cl->timer_count) { | |
488 | if (--cl->timer_count == 0) { | |
2bf94cab | 489 | dev_err(dev->dev, "timer: connect/disconnect timeout.\n"); |
18901357 | 490 | mei_connect_timeout(cl); |
fb7d879f OW |
491 | goto out; |
492 | } | |
493 | } | |
494 | } | |
495 | ||
64092858 TW |
496 | if (!mei_cl_is_connected(&dev->iamthif_cl)) |
497 | goto out; | |
498 | ||
fb7d879f OW |
499 | if (dev->iamthif_stall_timer) { |
500 | if (--dev->iamthif_stall_timer == 0) { | |
2bf94cab | 501 | dev_err(dev->dev, "timer: amthif hanged.\n"); |
33ec0826 | 502 | mei_reset(dev); |
eb9af0ac | 503 | dev->iamthif_canceled = false; |
fb7d879f | 504 | dev->iamthif_state = MEI_IAMTHIF_IDLE; |
fb7d879f | 505 | |
601a1efa TW |
506 | mei_io_cb_free(dev->iamthif_current_cb); |
507 | dev->iamthif_current_cb = NULL; | |
fb7d879f | 508 | |
62e8e6ad | 509 | dev->iamthif_fp = NULL; |
19838fb8 | 510 | mei_amthif_run_next_cmd(dev); |
fb7d879f OW |
511 | } |
512 | } | |
513 | ||
fb7d879f | 514 | out: |
33ec0826 TW |
515 | if (dev->dev_state != MEI_DEV_DISABLED) |
516 | schedule_delayed_work(&dev->timer_work, 2 * HZ); | |
441ab50f | 517 | mutex_unlock(&dev->device_lock); |
fb7d879f | 518 | } |