1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/kernel.h>
18#include <linux/fs.h>
19#include <linux/errno.h>
20#include <linux/types.h>
21#include <linux/fcntl.h>
22#include <linux/aio.h>
23#include <linux/pci.h>
24#include <linux/init.h>
25#include <linux/ioctl.h>
26#include <linux/cdev.h>
27#include <linux/list.h>
28#include <linux/delay.h>
29#include <linux/sched.h>
30#include <linux/uuid.h>
31#include <linux/jiffies.h>
32#include <linux/uaccess.h>
33
34#include <linux/mei.h>
35
36#include "mei_dev.h"
37#include "hbm.h"
38#include "hw-me.h"
39#include "client.h"
40
41const uuid_le mei_amthif_guid = UUID_LE(0x12f80028, 0xb4b7, 0x4b2d,
42 0xac, 0xa8, 0x46, 0xe0,
43 0xff, 0x65, 0x81, 0x4c);
44
45
46
47
48
49
50void mei_amthif_reset_params(struct mei_device *dev)
51{
52
53 dev->iamthif_current_cb = NULL;
54 dev->iamthif_msg_buf_size = 0;
55 dev->iamthif_msg_buf_index = 0;
56 dev->iamthif_canceled = false;
57 dev->iamthif_ioctl = false;
58 dev->iamthif_state = MEI_IAMTHIF_IDLE;
59 dev->iamthif_timer = 0;
60}
61
62
63
64
65
66
67
68int mei_amthif_host_init(struct mei_device *dev)
69{
70 struct mei_cl *cl = &dev->iamthif_cl;
71 unsigned char *msg_buf;
72 int ret, i;
73
74 dev->iamthif_state = MEI_IAMTHIF_IDLE;
75
76 mei_cl_init(cl, dev);
77
78 i = mei_me_cl_by_uuid(dev, &mei_amthif_guid);
79 if (i < 0) {
80 dev_info(&dev->pdev->dev, "amthif: failed to find the client\n");
81 return -ENOENT;
82 }
83
84 cl->me_client_id = dev->me_clients[i].client_id;
85
86
87
88 dev->iamthif_mtu = dev->me_clients[i].props.max_msg_length;
89 dev_dbg(&dev->pdev->dev, "IAMTHIF_MTU = %d\n",
90 dev->me_clients[i].props.max_msg_length);
91
92 kfree(dev->iamthif_msg_buf);
93 dev->iamthif_msg_buf = NULL;
94
95
96 msg_buf = kcalloc(dev->iamthif_mtu,
97 sizeof(unsigned char), GFP_KERNEL);
98 if (!msg_buf) {
99 dev_err(&dev->pdev->dev, "amthif: memory allocation for ME message buffer failed.\n");
100 return -ENOMEM;
101 }
102
103 dev->iamthif_msg_buf = msg_buf;
104
105 ret = mei_cl_link(cl, MEI_IAMTHIF_HOST_CLIENT_ID);
106
107 if (ret < 0) {
108 dev_err(&dev->pdev->dev, "amthif: failed link client\n");
109 return -ENOENT;
110 }
111
112 cl->state = MEI_FILE_CONNECTING;
113
114 if (mei_hbm_cl_connect_req(dev, cl)) {
115 dev_dbg(&dev->pdev->dev, "amthif: Failed to connect to ME client\n");
116 cl->state = MEI_FILE_DISCONNECTED;
117 cl->host_client_id = 0;
118 } else {
119 cl->timer_count = MEI_CONNECT_TIMEOUT;
120 }
121 return 0;
122}
123
124
125
126
127
128
129
130
131
132struct mei_cl_cb *mei_amthif_find_read_list_entry(struct mei_device *dev,
133 struct file *file)
134{
135 struct mei_cl_cb *pos = NULL;
136 struct mei_cl_cb *next = NULL;
137
138 list_for_each_entry_safe(pos, next,
139 &dev->amthif_rd_complete_list.list, list) {
140 if (pos->cl && pos->cl == &dev->iamthif_cl &&
141 pos->file_object == file)
142 return pos;
143 }
144 return NULL;
145}
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165int mei_amthif_read(struct mei_device *dev, struct file *file,
166 char __user *ubuf, size_t length, loff_t *offset)
167{
168 int rets;
169 int wait_ret;
170 struct mei_cl_cb *cb = NULL;
171 struct mei_cl *cl = file->private_data;
172 unsigned long timeout;
173 int i;
174
175
176 if (!cl || cl != &dev->iamthif_cl) {
177 dev_dbg(&dev->pdev->dev, "bad file ext.\n");
178 return -ETIMEDOUT;
179 }
180
181 i = mei_me_cl_by_id(dev, dev->iamthif_cl.me_client_id);
182
183 if (i < 0) {
184 dev_dbg(&dev->pdev->dev, "amthif client not found.\n");
185 return -ENODEV;
186 }
187 dev_dbg(&dev->pdev->dev, "checking amthif data\n");
188 cb = mei_amthif_find_read_list_entry(dev, file);
189
190
191 if (cb == NULL && file->f_flags & O_NONBLOCK)
192 return -EAGAIN;
193
194
195 dev_dbg(&dev->pdev->dev, "waiting for amthif data\n");
196 while (cb == NULL) {
197
198 mutex_unlock(&dev->device_lock);
199
200 wait_ret = wait_event_interruptible(dev->iamthif_cl.wait,
201 (cb = mei_amthif_find_read_list_entry(dev, file)));
202
203
204 mutex_lock(&dev->device_lock);
205
206 if (wait_ret)
207 return -ERESTARTSYS;
208
209 dev_dbg(&dev->pdev->dev, "woke up from sleep\n");
210 }
211
212
213 dev_dbg(&dev->pdev->dev, "Got amthif data\n");
214 dev->iamthif_timer = 0;
215
216 if (cb) {
217 timeout = cb->read_time +
218 mei_secs_to_jiffies(MEI_IAMTHIF_READ_TIMER);
219 dev_dbg(&dev->pdev->dev, "amthif timeout = %lud\n",
220 timeout);
221
222 if (time_after(jiffies, timeout)) {
223 dev_dbg(&dev->pdev->dev, "amthif Time out\n");
224
225 list_del(&cb->list);
226 rets = -ETIMEDOUT;
227 goto free;
228 }
229 }
230
231 if (cb->buf_idx >= *offset && length >= (cb->buf_idx - *offset))
232 list_del(&cb->list);
233 else if (cb->buf_idx > 0 && cb->buf_idx <= *offset) {
234
235 list_del(&cb->list);
236 rets = 0;
237 goto free;
238 }
239
240
241
242
243 dev_dbg(&dev->pdev->dev, "amthif cb->response_buffer size - %d\n",
244 cb->response_buffer.size);
245 dev_dbg(&dev->pdev->dev, "amthif cb->buf_idx - %lu\n", cb->buf_idx);
246
247
248
249 length = min_t(size_t, length, (cb->buf_idx - *offset));
250
251 if (copy_to_user(ubuf, cb->response_buffer.data + *offset, length))
252 rets = -EFAULT;
253 else {
254 rets = length;
255 if ((*offset + length) < cb->buf_idx) {
256 *offset += length;
257 goto out;
258 }
259 }
260free:
261 dev_dbg(&dev->pdev->dev, "free amthif cb memory.\n");
262 *offset = 0;
263 mei_io_cb_free(cb);
264out:
265 return rets;
266}
267
268
269
270
271
272
273
274
275
276
277static int mei_amthif_send_cmd(struct mei_device *dev, struct mei_cl_cb *cb)
278{
279 struct mei_msg_hdr mei_hdr;
280 int ret;
281
282 if (!dev || !cb)
283 return -ENODEV;
284
285 dev_dbg(&dev->pdev->dev, "write data to amthif client.\n");
286
287 dev->iamthif_state = MEI_IAMTHIF_WRITING;
288 dev->iamthif_current_cb = cb;
289 dev->iamthif_file_object = cb->file_object;
290 dev->iamthif_canceled = false;
291 dev->iamthif_ioctl = true;
292 dev->iamthif_msg_buf_size = cb->request_buffer.size;
293 memcpy(dev->iamthif_msg_buf, cb->request_buffer.data,
294 cb->request_buffer.size);
295
296 ret = mei_cl_flow_ctrl_creds(&dev->iamthif_cl);
297 if (ret < 0)
298 return ret;
299
300 if (ret && dev->hbuf_is_ready) {
301 ret = 0;
302 dev->hbuf_is_ready = false;
303 if (cb->request_buffer.size > mei_hbuf_max_len(dev)) {
304 mei_hdr.length = mei_hbuf_max_len(dev);
305 mei_hdr.msg_complete = 0;
306 } else {
307 mei_hdr.length = cb->request_buffer.size;
308 mei_hdr.msg_complete = 1;
309 }
310
311 mei_hdr.host_addr = dev->iamthif_cl.host_client_id;
312 mei_hdr.me_addr = dev->iamthif_cl.me_client_id;
313 mei_hdr.reserved = 0;
314 dev->iamthif_msg_buf_index += mei_hdr.length;
315 if (mei_write_message(dev, &mei_hdr,
316 (unsigned char *)dev->iamthif_msg_buf))
317 return -ENODEV;
318
319 if (mei_hdr.msg_complete) {
320 if (mei_cl_flow_ctrl_reduce(&dev->iamthif_cl))
321 return -ENODEV;
322 dev->iamthif_flow_control_pending = true;
323 dev->iamthif_state = MEI_IAMTHIF_FLOW_CONTROL;
324 dev_dbg(&dev->pdev->dev, "add amthif cb to write waiting list\n");
325 dev->iamthif_current_cb = cb;
326 dev->iamthif_file_object = cb->file_object;
327 list_add_tail(&cb->list, &dev->write_waiting_list.list);
328 } else {
329 dev_dbg(&dev->pdev->dev, "message does not complete, so add amthif cb to write list.\n");
330 list_add_tail(&cb->list, &dev->write_list.list);
331 }
332 } else {
333 if (!dev->hbuf_is_ready)
334 dev_dbg(&dev->pdev->dev, "host buffer is not empty");
335
336 dev_dbg(&dev->pdev->dev, "No flow control credentials, so add iamthif cb to write list.\n");
337 list_add_tail(&cb->list, &dev->write_list.list);
338 }
339 return 0;
340}
341
342
343
344
345
346
347
348
349
350
351int mei_amthif_write(struct mei_device *dev, struct mei_cl_cb *cb)
352{
353 int ret;
354
355 if (!dev || !cb)
356 return -ENODEV;
357
358 ret = mei_io_cb_alloc_resp_buf(cb, dev->iamthif_mtu);
359 if (ret)
360 return ret;
361
362 cb->fop_type = MEI_FOP_IOCTL;
363
364 if (!list_empty(&dev->amthif_cmd_list.list) ||
365 dev->iamthif_state != MEI_IAMTHIF_IDLE) {
366 dev_dbg(&dev->pdev->dev,
367 "amthif state = %d\n", dev->iamthif_state);
368 dev_dbg(&dev->pdev->dev, "AMTHIF: add cb to the wait list\n");
369 list_add_tail(&cb->list, &dev->amthif_cmd_list.list);
370 return 0;
371 }
372 return mei_amthif_send_cmd(dev, cb);
373}
374
375
376
377
378
379
380
381void mei_amthif_run_next_cmd(struct mei_device *dev)
382{
383 struct mei_cl_cb *pos = NULL;
384 struct mei_cl_cb *next = NULL;
385 int status;
386
387 if (!dev)
388 return;
389
390 dev->iamthif_msg_buf_size = 0;
391 dev->iamthif_msg_buf_index = 0;
392 dev->iamthif_canceled = false;
393 dev->iamthif_ioctl = true;
394 dev->iamthif_state = MEI_IAMTHIF_IDLE;
395 dev->iamthif_timer = 0;
396 dev->iamthif_file_object = NULL;
397
398 dev_dbg(&dev->pdev->dev, "complete amthif cmd_list cb.\n");
399
400 list_for_each_entry_safe(pos, next, &dev->amthif_cmd_list.list, list) {
401 list_del(&pos->list);
402
403 if (pos->cl && pos->cl == &dev->iamthif_cl) {
404 status = mei_amthif_send_cmd(dev, pos);
405 if (status) {
406 dev_dbg(&dev->pdev->dev,
407 "amthif write failed status = %d\n",
408 status);
409 return;
410 }
411 break;
412 }
413 }
414}
415
416
417unsigned int mei_amthif_poll(struct mei_device *dev,
418 struct file *file, poll_table *wait)
419{
420 unsigned int mask = 0;
421 mutex_unlock(&dev->device_lock);
422 poll_wait(file, &dev->iamthif_cl.wait, wait);
423 mutex_lock(&dev->device_lock);
424 if (dev->iamthif_state == MEI_IAMTHIF_READ_COMPLETE &&
425 dev->iamthif_file_object == file) {
426 mask |= (POLLIN | POLLRDNORM);
427 dev_dbg(&dev->pdev->dev, "run next amthif cb\n");
428 mei_amthif_run_next_cmd(dev);
429 }
430 return mask;
431}
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446int mei_amthif_irq_write_complete(struct mei_device *dev, s32 *slots,
447 struct mei_cl_cb *cb, struct mei_cl_cb *cmpl_list)
448{
449 struct mei_msg_hdr mei_hdr;
450 struct mei_cl *cl = cb->cl;
451 size_t len = dev->iamthif_msg_buf_size - dev->iamthif_msg_buf_index;
452 u32 msg_slots = mei_data2slots(len);
453
454 mei_hdr.host_addr = cl->host_client_id;
455 mei_hdr.me_addr = cl->me_client_id;
456 mei_hdr.reserved = 0;
457
458 if (*slots >= msg_slots) {
459 mei_hdr.length = len;
460 mei_hdr.msg_complete = 1;
461
462 } else if (*slots == dev->hbuf_depth) {
463 msg_slots = *slots;
464 len = (*slots * sizeof(u32)) - sizeof(struct mei_msg_hdr);
465 mei_hdr.length = len;
466 mei_hdr.msg_complete = 0;
467 } else {
468
469 return 0;
470 }
471
472 dev_dbg(&dev->pdev->dev, MEI_HDR_FMT, MEI_HDR_PRM(&mei_hdr));
473
474 *slots -= msg_slots;
475 if (mei_write_message(dev, &mei_hdr,
476 dev->iamthif_msg_buf + dev->iamthif_msg_buf_index)) {
477 dev->iamthif_state = MEI_IAMTHIF_IDLE;
478 cl->status = -ENODEV;
479 list_del(&cb->list);
480 return -ENODEV;
481 }
482
483 if (mei_cl_flow_ctrl_reduce(cl))
484 return -ENODEV;
485
486 dev->iamthif_msg_buf_index += mei_hdr.length;
487 cl->status = 0;
488
489 if (mei_hdr.msg_complete) {
490 dev->iamthif_state = MEI_IAMTHIF_FLOW_CONTROL;
491 dev->iamthif_flow_control_pending = true;
492
493
494 cb->buf_idx = dev->iamthif_msg_buf_index;
495 dev->iamthif_current_cb = cb;
496
497 list_move_tail(&cb->list, &dev->write_waiting_list.list);
498 }
499
500
501 return 0;
502}
503
504
505
506
507
508
509
510
511
512
513
514int mei_amthif_irq_read_msg(struct mei_device *dev,
515 struct mei_msg_hdr *mei_hdr,
516 struct mei_cl_cb *complete_list)
517{
518 struct mei_cl_cb *cb;
519 unsigned char *buffer;
520
521 BUG_ON(mei_hdr->me_addr != dev->iamthif_cl.me_client_id);
522 BUG_ON(dev->iamthif_state != MEI_IAMTHIF_READING);
523
524 buffer = dev->iamthif_msg_buf + dev->iamthif_msg_buf_index;
525 BUG_ON(dev->iamthif_mtu < dev->iamthif_msg_buf_index + mei_hdr->length);
526
527 mei_read_slots(dev, buffer, mei_hdr->length);
528
529 dev->iamthif_msg_buf_index += mei_hdr->length;
530
531 if (!mei_hdr->msg_complete)
532 return 0;
533
534 dev_dbg(&dev->pdev->dev, "amthif_message_buffer_index =%d\n",
535 mei_hdr->length);
536
537 dev_dbg(&dev->pdev->dev, "completed amthif read.\n ");
538 if (!dev->iamthif_current_cb)
539 return -ENODEV;
540
541 cb = dev->iamthif_current_cb;
542 dev->iamthif_current_cb = NULL;
543
544 if (!cb->cl)
545 return -ENODEV;
546
547 dev->iamthif_stall_timer = 0;
548 cb->buf_idx = dev->iamthif_msg_buf_index;
549 cb->read_time = jiffies;
550 if (dev->iamthif_ioctl && cb->cl == &dev->iamthif_cl) {
551
552 dev_dbg(&dev->pdev->dev, "complete the amthif read cb.\n ");
553 dev_dbg(&dev->pdev->dev, "add the amthif read cb to complete.\n ");
554 list_add_tail(&cb->list, &complete_list->list);
555 }
556 return 0;
557}
558
559
560
561
562
563
564
565
566
567int mei_amthif_irq_read(struct mei_device *dev, s32 *slots)
568{
569 u32 msg_slots = mei_data2slots(sizeof(struct hbm_flow_control));
570
571 if (*slots < msg_slots)
572 return -EMSGSIZE;
573
574 *slots -= msg_slots;
575
576 if (mei_hbm_cl_flow_control_req(dev, &dev->iamthif_cl)) {
577 dev_dbg(&dev->pdev->dev, "iamthif flow control failed\n");
578 return -EIO;
579 }
580
581 dev_dbg(&dev->pdev->dev, "iamthif flow control success\n");
582 dev->iamthif_state = MEI_IAMTHIF_READING;
583 dev->iamthif_flow_control_pending = false;
584 dev->iamthif_msg_buf_index = 0;
585 dev->iamthif_msg_buf_size = 0;
586 dev->iamthif_stall_timer = MEI_IAMTHIF_STALL_TIMER;
587 dev->hbuf_is_ready = mei_hbuf_is_ready(dev);
588 return 0;
589}
590
591
592
593
594
595
596
597void mei_amthif_complete(struct mei_device *dev, struct mei_cl_cb *cb)
598{
599 if (dev->iamthif_canceled != 1) {
600 dev->iamthif_state = MEI_IAMTHIF_READ_COMPLETE;
601 dev->iamthif_stall_timer = 0;
602 memcpy(cb->response_buffer.data,
603 dev->iamthif_msg_buf,
604 dev->iamthif_msg_buf_index);
605 list_add_tail(&cb->list, &dev->amthif_rd_complete_list.list);
606 dev_dbg(&dev->pdev->dev, "amthif read completed\n");
607 dev->iamthif_timer = jiffies;
608 dev_dbg(&dev->pdev->dev, "dev->iamthif_timer = %ld\n",
609 dev->iamthif_timer);
610 } else {
611 mei_amthif_run_next_cmd(dev);
612 }
613
614 dev_dbg(&dev->pdev->dev, "completing amthif call back.\n");
615 wake_up_interruptible(&dev->iamthif_cl.wait);
616}
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631static bool mei_clear_list(struct mei_device *dev,
632 const struct file *file, struct list_head *mei_cb_list)
633{
634 struct mei_cl_cb *cb_pos = NULL;
635 struct mei_cl_cb *cb_next = NULL;
636 bool removed = false;
637
638
639 list_for_each_entry_safe(cb_pos, cb_next, mei_cb_list, list) {
640
641 if (file == cb_pos->file_object) {
642
643 list_del(&cb_pos->list);
644
645 if (dev->iamthif_current_cb == cb_pos) {
646 dev->iamthif_current_cb = NULL;
647
648 mei_hbm_cl_flow_control_req(dev,
649 &dev->iamthif_cl);
650 }
651
652 mei_io_cb_free(cb_pos);
653 cb_pos = NULL;
654 removed = true;
655 }
656 }
657 return removed;
658}
659
660
661
662
663
664
665
666
667
668
669
670
671static bool mei_clear_lists(struct mei_device *dev, struct file *file)
672{
673 bool removed = false;
674
675
676 mei_clear_list(dev, file, &dev->amthif_cmd_list.list);
677 if (mei_clear_list(dev, file, &dev->amthif_rd_complete_list.list))
678 removed = true;
679
680 mei_clear_list(dev, file, &dev->ctrl_rd_list.list);
681
682 if (mei_clear_list(dev, file, &dev->ctrl_wr_list.list))
683 removed = true;
684
685 if (mei_clear_list(dev, file, &dev->write_waiting_list.list))
686 removed = true;
687
688 if (mei_clear_list(dev, file, &dev->write_list.list))
689 removed = true;
690
691
692 if (dev->iamthif_current_cb && !removed) {
693
694 if (dev->iamthif_current_cb->file_object == file) {
695
696 mei_io_cb_free(dev->iamthif_current_cb);
697 dev->iamthif_current_cb = NULL;
698 removed = true;
699 }
700 }
701 return removed;
702}
703
704
705
706
707
708
709
710
711
712int mei_amthif_release(struct mei_device *dev, struct file *file)
713{
714 if (dev->open_handle_count > 0)
715 dev->open_handle_count--;
716
717 if (dev->iamthif_file_object == file &&
718 dev->iamthif_state != MEI_IAMTHIF_IDLE) {
719
720 dev_dbg(&dev->pdev->dev, "amthif canceled iamthif state %d\n",
721 dev->iamthif_state);
722 dev->iamthif_canceled = true;
723 if (dev->iamthif_state == MEI_IAMTHIF_READ_COMPLETE) {
724 dev_dbg(&dev->pdev->dev, "run next amthif iamthif cb\n");
725 mei_amthif_run_next_cmd(dev);
726 }
727 }
728
729 if (mei_clear_lists(dev, file))
730 dev->iamthif_state = MEI_IAMTHIF_IDLE;
731
732 return 0;
733}
734