2012-11-02 03:17:15 +08:00
|
|
|
/*
|
|
|
|
*
|
|
|
|
* Intel Management Engine Interface (Intel MEI) Linux driver
|
|
|
|
* Copyright (c) 2003-2012, Intel Corporation.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms and conditions of the GNU General Public License,
|
|
|
|
* version 2, as published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
|
* more details.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/fs.h>
|
|
|
|
#include <linux/errno.h>
|
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/fcntl.h>
|
|
|
|
#include <linux/aio.h>
|
|
|
|
#include <linux/pci.h>
|
|
|
|
#include <linux/ioctl.h>
|
|
|
|
#include <linux/cdev.h>
|
|
|
|
#include <linux/list.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/sched.h>
|
|
|
|
#include <linux/uuid.h>
|
|
|
|
#include <linux/jiffies.h>
|
|
|
|
#include <linux/uaccess.h>
|
|
|
|
|
2012-12-26 01:06:03 +08:00
|
|
|
#include <linux/mei.h>
|
2012-11-02 03:17:15 +08:00
|
|
|
|
|
|
|
#include "mei_dev.h"
|
2013-01-09 05:07:12 +08:00
|
|
|
#include "hbm.h"
|
2013-01-09 05:07:14 +08:00
|
|
|
#include "client.h"
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
const uuid_le mei_amthif_guid = UUID_LE(0x12f80028, 0xb4b7, 0x4b2d,
|
|
|
|
0xac, 0xa8, 0x46, 0xe0,
|
|
|
|
0xff, 0x65, 0x81, 0x4c);
|
2012-11-02 03:17:15 +08:00
|
|
|
|
|
|
|
/**
|
|
|
|
* mei_amthif_reset_params - initializes mei device iamthif
|
|
|
|
*
|
|
|
|
* @dev: the device structure
|
|
|
|
*/
|
|
|
|
void mei_amthif_reset_params(struct mei_device *dev)
|
|
|
|
{
|
|
|
|
/* reset iamthif parameters. */
|
|
|
|
dev->iamthif_current_cb = NULL;
|
|
|
|
dev->iamthif_msg_buf_size = 0;
|
|
|
|
dev->iamthif_msg_buf_index = 0;
|
|
|
|
dev->iamthif_canceled = false;
|
|
|
|
dev->iamthif_ioctl = false;
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_IDLE;
|
|
|
|
dev->iamthif_timer = 0;
|
2013-09-02 18:29:47 +08:00
|
|
|
dev->iamthif_stall_timer = 0;
|
2013-09-17 04:44:47 +08:00
|
|
|
dev->iamthif_open_count = 0;
|
2012-11-02 03:17:15 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2013-04-05 00:05:05 +08:00
|
|
|
* mei_amthif_host_init - mei initialization amthif client.
|
2012-11-02 03:17:15 +08:00
|
|
|
*
|
|
|
|
* @dev: the device structure
|
|
|
|
*
|
|
|
|
*/
|
2013-01-09 05:07:22 +08:00
|
|
|
int mei_amthif_host_init(struct mei_device *dev)
|
2012-11-02 03:17:15 +08:00
|
|
|
{
|
2013-01-09 05:07:22 +08:00
|
|
|
struct mei_cl *cl = &dev->iamthif_cl;
|
2014-08-24 17:08:55 +08:00
|
|
|
struct mei_me_client *me_cl;
|
2012-11-02 03:17:15 +08:00
|
|
|
unsigned char *msg_buf;
|
2014-08-24 17:08:55 +08:00
|
|
|
int ret;
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2013-01-09 05:07:23 +08:00
|
|
|
dev->iamthif_state = MEI_IAMTHIF_IDLE;
|
|
|
|
|
2013-01-09 05:07:22 +08:00
|
|
|
mei_cl_init(cl, dev);
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2014-08-24 17:08:55 +08:00
|
|
|
me_cl = mei_me_cl_by_uuid(dev, &mei_amthif_guid);
|
|
|
|
if (!me_cl) {
|
|
|
|
dev_info(&dev->pdev->dev, "amthif: failed to find the client");
|
2014-02-19 23:35:49 +08:00
|
|
|
return -ENOTTY;
|
2012-11-02 03:17:15 +08:00
|
|
|
}
|
|
|
|
|
2014-08-24 17:08:55 +08:00
|
|
|
cl->me_client_id = me_cl->client_id;
|
2013-01-09 05:07:22 +08:00
|
|
|
|
2012-11-02 03:17:15 +08:00
|
|
|
/* Assign iamthif_mtu to the value received from ME */
|
|
|
|
|
2014-08-24 17:08:55 +08:00
|
|
|
dev->iamthif_mtu = me_cl->props.max_msg_length;
|
|
|
|
dev_dbg(&dev->pdev->dev, "IAMTHIF_MTU = %d\n", dev->iamthif_mtu);
|
2012-11-02 03:17:15 +08:00
|
|
|
|
|
|
|
kfree(dev->iamthif_msg_buf);
|
|
|
|
dev->iamthif_msg_buf = NULL;
|
|
|
|
|
|
|
|
/* allocate storage for ME message buffer */
|
|
|
|
msg_buf = kcalloc(dev->iamthif_mtu,
|
|
|
|
sizeof(unsigned char), GFP_KERNEL);
|
|
|
|
if (!msg_buf) {
|
2013-01-09 05:07:22 +08:00
|
|
|
dev_err(&dev->pdev->dev, "amthif: memory allocation for ME message buffer failed.\n");
|
|
|
|
return -ENOMEM;
|
2012-11-02 03:17:15 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
dev->iamthif_msg_buf = msg_buf;
|
|
|
|
|
2013-01-09 05:07:22 +08:00
|
|
|
ret = mei_cl_link(cl, MEI_IAMTHIF_HOST_CLIENT_ID);
|
|
|
|
|
|
|
|
if (ret < 0) {
|
2013-09-17 04:44:48 +08:00
|
|
|
dev_err(&dev->pdev->dev,
|
|
|
|
"amthif: failed link client %d\n", ret);
|
|
|
|
return ret;
|
2013-01-09 05:07:22 +08:00
|
|
|
}
|
|
|
|
|
2014-02-17 21:13:21 +08:00
|
|
|
ret = mei_cl_connect(cl, NULL);
|
|
|
|
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_IDLE;
|
|
|
|
|
|
|
|
return ret;
|
2012-11-02 03:17:15 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* mei_amthif_find_read_list_entry - finds a amthilist entry for current file
|
|
|
|
*
|
|
|
|
* @dev: the device structure
|
|
|
|
* @file: pointer to file object
|
|
|
|
*
|
|
|
|
* returns returned a list entry on success, NULL on failure.
|
|
|
|
*/
|
|
|
|
struct mei_cl_cb *mei_amthif_find_read_list_entry(struct mei_device *dev,
|
|
|
|
struct file *file)
|
|
|
|
{
|
2014-02-17 21:13:25 +08:00
|
|
|
struct mei_cl_cb *cb;
|
2014-08-14 22:22:21 +08:00
|
|
|
list_for_each_entry(cb, &dev->amthif_rd_complete_list.list, list)
|
|
|
|
if (cb->file_object == file)
|
2014-02-17 21:13:25 +08:00
|
|
|
return cb;
|
2012-11-02 03:17:15 +08:00
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
* mei_amthif_read - read data from AMTHIF client
|
|
|
|
*
|
|
|
|
* @dev: the device structure
|
|
|
|
* @if_num: minor number
|
|
|
|
* @file: pointer to file object
|
|
|
|
* @*ubuf: pointer to user data in user space
|
|
|
|
* @length: data length to read
|
|
|
|
* @offset: data read offset
|
|
|
|
*
|
|
|
|
* Locking: called under "dev->device_lock" lock
|
|
|
|
*
|
|
|
|
* returns
|
|
|
|
* returned data length on success,
|
|
|
|
* zero if no data to read,
|
|
|
|
* negative on failure.
|
|
|
|
*/
|
|
|
|
int mei_amthif_read(struct mei_device *dev, struct file *file,
|
|
|
|
char __user *ubuf, size_t length, loff_t *offset)
|
|
|
|
{
|
|
|
|
struct mei_cl *cl = file->private_data;
|
2014-08-24 17:08:55 +08:00
|
|
|
struct mei_cl_cb *cb;
|
2012-11-02 03:17:15 +08:00
|
|
|
unsigned long timeout;
|
2014-08-24 17:08:55 +08:00
|
|
|
int rets;
|
|
|
|
int wait_ret;
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2014-01-09 04:31:46 +08:00
|
|
|
/* Only possible if we are in timeout */
|
2014-08-14 22:22:21 +08:00
|
|
|
if (!cl) {
|
|
|
|
dev_err(&dev->pdev->dev, "bad file ext.\n");
|
2014-02-19 23:35:49 +08:00
|
|
|
return -ETIME;
|
2012-11-02 03:17:15 +08:00
|
|
|
}
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "checking amthif data\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
cb = mei_amthif_find_read_list_entry(dev, file);
|
|
|
|
|
|
|
|
/* Check for if we can block or not*/
|
|
|
|
if (cb == NULL && file->f_flags & O_NONBLOCK)
|
|
|
|
return -EAGAIN;
|
|
|
|
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "waiting for amthif data\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
while (cb == NULL) {
|
|
|
|
/* unlock the Mutex */
|
|
|
|
mutex_unlock(&dev->device_lock);
|
|
|
|
|
|
|
|
wait_ret = wait_event_interruptible(dev->iamthif_cl.wait,
|
|
|
|
(cb = mei_amthif_find_read_list_entry(dev, file)));
|
|
|
|
|
2012-12-22 05:44:16 +08:00
|
|
|
/* Locking again the Mutex */
|
|
|
|
mutex_lock(&dev->device_lock);
|
|
|
|
|
2012-11-02 03:17:15 +08:00
|
|
|
if (wait_ret)
|
|
|
|
return -ERESTARTSYS;
|
|
|
|
|
|
|
|
dev_dbg(&dev->pdev->dev, "woke up from sleep\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "Got amthif data\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
dev->iamthif_timer = 0;
|
|
|
|
|
|
|
|
if (cb) {
|
|
|
|
timeout = cb->read_time +
|
|
|
|
mei_secs_to_jiffies(MEI_IAMTHIF_READ_TIMER);
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "amthif timeout = %lud\n",
|
2012-11-02 03:17:15 +08:00
|
|
|
timeout);
|
|
|
|
|
|
|
|
if (time_after(jiffies, timeout)) {
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "amthif Time out\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
/* 15 sec for the message has expired */
|
|
|
|
list_del(&cb->list);
|
2014-02-19 23:35:49 +08:00
|
|
|
rets = -ETIME;
|
2012-11-02 03:17:15 +08:00
|
|
|
goto free;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
/* if the whole message will fit remove it from the list */
|
|
|
|
if (cb->buf_idx >= *offset && length >= (cb->buf_idx - *offset))
|
|
|
|
list_del(&cb->list);
|
|
|
|
else if (cb->buf_idx > 0 && cb->buf_idx <= *offset) {
|
|
|
|
/* end of the message has been reached */
|
|
|
|
list_del(&cb->list);
|
|
|
|
rets = 0;
|
|
|
|
goto free;
|
|
|
|
}
|
|
|
|
/* else means that not full buffer will be read and do not
|
|
|
|
* remove message from deletion list
|
|
|
|
*/
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "amthif cb->response_buffer size - %d\n",
|
2012-11-02 03:17:15 +08:00
|
|
|
cb->response_buffer.size);
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "amthif cb->buf_idx - %lu\n", cb->buf_idx);
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2014-01-09 04:31:46 +08:00
|
|
|
/* length is being truncated to PAGE_SIZE, however,
|
2012-11-02 03:17:15 +08:00
|
|
|
* the buf_idx may point beyond */
|
|
|
|
length = min_t(size_t, length, (cb->buf_idx - *offset));
|
|
|
|
|
2014-03-12 19:19:13 +08:00
|
|
|
if (copy_to_user(ubuf, cb->response_buffer.data + *offset, length)) {
|
|
|
|
dev_dbg(&dev->pdev->dev, "failed to copy data to userland\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
rets = -EFAULT;
|
2014-03-16 20:35:57 +08:00
|
|
|
} else {
|
2012-11-02 03:17:15 +08:00
|
|
|
rets = length;
|
|
|
|
if ((*offset + length) < cb->buf_idx) {
|
|
|
|
*offset += length;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
free:
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "free amthif cb memory.\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
*offset = 0;
|
|
|
|
mei_io_cb_free(cb);
|
|
|
|
out:
|
|
|
|
return rets;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2012-11-02 03:17:18 +08:00
|
|
|
* mei_amthif_send_cmd - send amthif command to the ME
|
2012-11-02 03:17:15 +08:00
|
|
|
*
|
|
|
|
* @dev: the device structure
|
|
|
|
* @cb: mei call back struct
|
|
|
|
*
|
|
|
|
* returns 0 on success, <0 on failure.
|
2012-11-02 03:17:18 +08:00
|
|
|
*
|
2012-11-02 03:17:15 +08:00
|
|
|
*/
|
2012-11-02 03:17:18 +08:00
|
|
|
static int mei_amthif_send_cmd(struct mei_device *dev, struct mei_cl_cb *cb)
|
2012-11-02 03:17:15 +08:00
|
|
|
{
|
|
|
|
struct mei_msg_hdr mei_hdr;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (!dev || !cb)
|
|
|
|
return -ENODEV;
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "write data to amthif client.\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_WRITING;
|
|
|
|
dev->iamthif_current_cb = cb;
|
|
|
|
dev->iamthif_file_object = cb->file_object;
|
|
|
|
dev->iamthif_canceled = false;
|
|
|
|
dev->iamthif_ioctl = true;
|
|
|
|
dev->iamthif_msg_buf_size = cb->request_buffer.size;
|
|
|
|
memcpy(dev->iamthif_msg_buf, cb->request_buffer.data,
|
|
|
|
cb->request_buffer.size);
|
|
|
|
|
2013-01-09 05:07:14 +08:00
|
|
|
ret = mei_cl_flow_ctrl_creds(&dev->iamthif_cl);
|
2012-11-02 03:17:15 +08:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
2014-02-19 23:35:47 +08:00
|
|
|
if (ret && mei_hbuf_acquire(dev)) {
|
2012-11-02 03:17:15 +08:00
|
|
|
ret = 0;
|
2013-02-06 20:06:41 +08:00
|
|
|
if (cb->request_buffer.size > mei_hbuf_max_len(dev)) {
|
|
|
|
mei_hdr.length = mei_hbuf_max_len(dev);
|
2012-11-02 03:17:15 +08:00
|
|
|
mei_hdr.msg_complete = 0;
|
|
|
|
} else {
|
|
|
|
mei_hdr.length = cb->request_buffer.size;
|
|
|
|
mei_hdr.msg_complete = 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
mei_hdr.host_addr = dev->iamthif_cl.host_client_id;
|
|
|
|
mei_hdr.me_addr = dev->iamthif_cl.me_client_id;
|
|
|
|
mei_hdr.reserved = 0;
|
2013-12-17 21:56:56 +08:00
|
|
|
mei_hdr.internal = 0;
|
2012-11-02 03:17:15 +08:00
|
|
|
dev->iamthif_msg_buf_index += mei_hdr.length;
|
2013-09-17 04:44:43 +08:00
|
|
|
ret = mei_write_message(dev, &mei_hdr, dev->iamthif_msg_buf);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
2012-11-02 03:17:15 +08:00
|
|
|
|
|
|
|
if (mei_hdr.msg_complete) {
|
2013-01-09 05:07:14 +08:00
|
|
|
if (mei_cl_flow_ctrl_reduce(&dev->iamthif_cl))
|
2013-09-17 04:44:43 +08:00
|
|
|
return -EIO;
|
2012-11-02 03:17:15 +08:00
|
|
|
dev->iamthif_flow_control_pending = true;
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_FLOW_CONTROL;
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "add amthif cb to write waiting list\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
dev->iamthif_current_cb = cb;
|
|
|
|
dev->iamthif_file_object = cb->file_object;
|
|
|
|
list_add_tail(&cb->list, &dev->write_waiting_list.list);
|
|
|
|
} else {
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "message does not complete, so add amthif cb to write list.\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
list_add_tail(&cb->list, &dev->write_list.list);
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
list_add_tail(&cb->list, &dev->write_list.list);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-11-02 03:17:18 +08:00
|
|
|
/**
|
|
|
|
* mei_amthif_write - write amthif data to amthif client
|
|
|
|
*
|
|
|
|
* @dev: the device structure
|
|
|
|
* @cb: mei call back struct
|
|
|
|
*
|
|
|
|
* returns 0 on success, <0 on failure.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
int mei_amthif_write(struct mei_device *dev, struct mei_cl_cb *cb)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (!dev || !cb)
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
ret = mei_io_cb_alloc_resp_buf(cb, dev->iamthif_mtu);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
2014-02-13 03:41:51 +08:00
|
|
|
cb->fop_type = MEI_FOP_WRITE;
|
2012-11-02 03:17:18 +08:00
|
|
|
|
2012-11-11 23:37:58 +08:00
|
|
|
if (!list_empty(&dev->amthif_cmd_list.list) ||
|
2012-11-02 03:17:18 +08:00
|
|
|
dev->iamthif_state != MEI_IAMTHIF_IDLE) {
|
|
|
|
dev_dbg(&dev->pdev->dev,
|
|
|
|
"amthif state = %d\n", dev->iamthif_state);
|
|
|
|
dev_dbg(&dev->pdev->dev, "AMTHIF: add cb to the wait list\n");
|
2012-11-11 23:37:58 +08:00
|
|
|
list_add_tail(&cb->list, &dev->amthif_cmd_list.list);
|
2012-11-02 03:17:18 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
return mei_amthif_send_cmd(dev, cb);
|
|
|
|
}
|
2012-11-02 03:17:15 +08:00
|
|
|
/**
|
|
|
|
* mei_amthif_run_next_cmd
|
|
|
|
*
|
|
|
|
* @dev: the device structure
|
|
|
|
*
|
|
|
|
* returns 0 on success, <0 on failure.
|
|
|
|
*/
|
|
|
|
void mei_amthif_run_next_cmd(struct mei_device *dev)
|
|
|
|
{
|
2014-08-14 22:22:21 +08:00
|
|
|
struct mei_cl_cb *cb;
|
|
|
|
struct mei_cl_cb *next;
|
2012-11-02 03:17:15 +08:00
|
|
|
int status;
|
|
|
|
|
|
|
|
if (!dev)
|
|
|
|
return;
|
|
|
|
|
|
|
|
dev->iamthif_msg_buf_size = 0;
|
|
|
|
dev->iamthif_msg_buf_index = 0;
|
|
|
|
dev->iamthif_canceled = false;
|
|
|
|
dev->iamthif_ioctl = true;
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_IDLE;
|
|
|
|
dev->iamthif_timer = 0;
|
|
|
|
dev->iamthif_file_object = NULL;
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "complete amthif cmd_list cb.\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2014-08-14 22:22:21 +08:00
|
|
|
list_for_each_entry_safe(cb, next, &dev->amthif_cmd_list.list, list) {
|
|
|
|
list_del(&cb->list);
|
|
|
|
if (!cb->cl)
|
|
|
|
continue;
|
|
|
|
status = mei_amthif_send_cmd(dev, cb);
|
|
|
|
if (status)
|
|
|
|
dev_warn(&dev->pdev->dev, "amthif write failed status = %d\n",
|
2012-11-02 03:17:15 +08:00
|
|
|
status);
|
2014-08-14 22:22:21 +08:00
|
|
|
break;
|
2012-11-02 03:17:15 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-11-11 23:38:02 +08:00
|
|
|
|
|
|
|
unsigned int mei_amthif_poll(struct mei_device *dev,
|
|
|
|
struct file *file, poll_table *wait)
|
|
|
|
{
|
|
|
|
unsigned int mask = 0;
|
2013-07-26 01:15:53 +08:00
|
|
|
|
2012-11-11 23:38:02 +08:00
|
|
|
poll_wait(file, &dev->iamthif_cl.wait, wait);
|
2013-07-26 01:15:53 +08:00
|
|
|
|
2012-11-11 23:38:02 +08:00
|
|
|
mutex_lock(&dev->device_lock);
|
2013-07-26 01:15:53 +08:00
|
|
|
if (!mei_cl_is_connected(&dev->iamthif_cl)) {
|
|
|
|
|
|
|
|
mask = POLLERR;
|
|
|
|
|
|
|
|
} else if (dev->iamthif_state == MEI_IAMTHIF_READ_COMPLETE &&
|
|
|
|
dev->iamthif_file_object == file) {
|
|
|
|
|
2012-11-11 23:38:02 +08:00
|
|
|
mask |= (POLLIN | POLLRDNORM);
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "run next amthif cb\n");
|
2012-11-11 23:38:02 +08:00
|
|
|
mei_amthif_run_next_cmd(dev);
|
|
|
|
}
|
2013-07-26 01:15:53 +08:00
|
|
|
mutex_unlock(&dev->device_lock);
|
|
|
|
|
2012-11-11 23:38:02 +08:00
|
|
|
return mask;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
2012-11-02 03:17:15 +08:00
|
|
|
/**
|
2014-02-19 23:35:48 +08:00
|
|
|
* mei_amthif_irq_write - write iamthif command in irq thread context.
|
2012-11-02 03:17:15 +08:00
|
|
|
*
|
|
|
|
* @dev: the device structure.
|
|
|
|
* @cb_pos: callback block.
|
|
|
|
* @cl: private data of the file object.
|
|
|
|
* @cmpl_list: complete list.
|
|
|
|
*
|
|
|
|
* returns 0, OK; otherwise, error.
|
|
|
|
*/
|
2014-02-19 23:35:48 +08:00
|
|
|
int mei_amthif_irq_write(struct mei_cl *cl, struct mei_cl_cb *cb,
|
|
|
|
struct mei_cl_cb *cmpl_list)
|
2012-11-02 03:17:15 +08:00
|
|
|
{
|
2013-05-12 20:34:46 +08:00
|
|
|
struct mei_device *dev = cl->dev;
|
2012-12-26 01:06:10 +08:00
|
|
|
struct mei_msg_hdr mei_hdr;
|
2012-11-18 21:13:17 +08:00
|
|
|
size_t len = dev->iamthif_msg_buf_size - dev->iamthif_msg_buf_index;
|
2013-03-12 00:27:02 +08:00
|
|
|
u32 msg_slots = mei_data2slots(len);
|
2014-02-19 23:35:48 +08:00
|
|
|
int slots;
|
2013-09-17 04:44:43 +08:00
|
|
|
int rets;
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2013-09-17 04:44:44 +08:00
|
|
|
rets = mei_cl_flow_ctrl_creds(cl);
|
|
|
|
if (rets < 0)
|
|
|
|
return rets;
|
|
|
|
|
|
|
|
if (rets == 0) {
|
|
|
|
cl_dbg(dev, cl, "No flow control credentials: not sending.\n");
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-12-26 01:06:10 +08:00
|
|
|
mei_hdr.host_addr = cl->host_client_id;
|
|
|
|
mei_hdr.me_addr = cl->me_client_id;
|
|
|
|
mei_hdr.reserved = 0;
|
2013-12-17 21:56:56 +08:00
|
|
|
mei_hdr.internal = 0;
|
2012-11-18 21:13:17 +08:00
|
|
|
|
2014-02-19 23:35:48 +08:00
|
|
|
slots = mei_hbuf_empty_slots(dev);
|
|
|
|
|
|
|
|
if (slots >= msg_slots) {
|
2012-12-26 01:06:10 +08:00
|
|
|
mei_hdr.length = len;
|
|
|
|
mei_hdr.msg_complete = 1;
|
2012-11-18 21:13:17 +08:00
|
|
|
/* Split the message only if we can write the whole host buffer */
|
2014-02-19 23:35:48 +08:00
|
|
|
} else if (slots == dev->hbuf_depth) {
|
|
|
|
msg_slots = slots;
|
|
|
|
len = (slots * sizeof(u32)) - sizeof(struct mei_msg_hdr);
|
2012-12-26 01:06:10 +08:00
|
|
|
mei_hdr.length = len;
|
|
|
|
mei_hdr.msg_complete = 0;
|
2012-11-18 21:13:17 +08:00
|
|
|
} else {
|
|
|
|
/* wait for next time the host buffer is empty */
|
|
|
|
return 0;
|
|
|
|
}
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2012-12-26 01:06:10 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, MEI_HDR_FMT, MEI_HDR_PRM(&mei_hdr));
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2013-09-17 04:44:43 +08:00
|
|
|
rets = mei_write_message(dev, &mei_hdr,
|
|
|
|
dev->iamthif_msg_buf + dev->iamthif_msg_buf_index);
|
|
|
|
if (rets) {
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_IDLE;
|
|
|
|
cl->status = rets;
|
|
|
|
list_del(&cb->list);
|
|
|
|
return rets;
|
2012-11-18 21:13:17 +08:00
|
|
|
}
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2013-01-09 05:07:14 +08:00
|
|
|
if (mei_cl_flow_ctrl_reduce(cl))
|
2013-09-17 04:44:43 +08:00
|
|
|
return -EIO;
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2012-12-26 01:06:10 +08:00
|
|
|
dev->iamthif_msg_buf_index += mei_hdr.length;
|
2012-11-18 21:13:17 +08:00
|
|
|
cl->status = 0;
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2012-12-26 01:06:10 +08:00
|
|
|
if (mei_hdr.msg_complete) {
|
2012-11-18 21:13:17 +08:00
|
|
|
dev->iamthif_state = MEI_IAMTHIF_FLOW_CONTROL;
|
|
|
|
dev->iamthif_flow_control_pending = true;
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
/* save iamthif cb sent to amthif client */
|
2012-11-18 21:13:17 +08:00
|
|
|
cb->buf_idx = dev->iamthif_msg_buf_index;
|
|
|
|
dev->iamthif_current_cb = cb;
|
|
|
|
|
|
|
|
list_move_tail(&cb->list, &dev->write_waiting_list.list);
|
2012-11-02 03:17:15 +08:00
|
|
|
}
|
|
|
|
|
2012-11-18 21:13:17 +08:00
|
|
|
|
2012-11-02 03:17:15 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* mei_amthif_irq_read_message - read routine after ISR to
|
2013-01-09 05:07:21 +08:00
|
|
|
* handle the read amthif message
|
2012-11-02 03:17:15 +08:00
|
|
|
*
|
|
|
|
* @dev: the device structure
|
2013-01-09 05:07:21 +08:00
|
|
|
* @mei_hdr: header of amthif message
|
2013-04-20 02:16:53 +08:00
|
|
|
* @complete_list: An instance of our list structure
|
2012-11-02 03:17:15 +08:00
|
|
|
*
|
|
|
|
* returns 0 on success, <0 on failure.
|
|
|
|
*/
|
2013-04-20 02:16:53 +08:00
|
|
|
int mei_amthif_irq_read_msg(struct mei_device *dev,
|
|
|
|
struct mei_msg_hdr *mei_hdr,
|
|
|
|
struct mei_cl_cb *complete_list)
|
2012-11-02 03:17:15 +08:00
|
|
|
{
|
|
|
|
struct mei_cl_cb *cb;
|
|
|
|
unsigned char *buffer;
|
|
|
|
|
|
|
|
BUG_ON(mei_hdr->me_addr != dev->iamthif_cl.me_client_id);
|
|
|
|
BUG_ON(dev->iamthif_state != MEI_IAMTHIF_READING);
|
|
|
|
|
|
|
|
buffer = dev->iamthif_msg_buf + dev->iamthif_msg_buf_index;
|
|
|
|
BUG_ON(dev->iamthif_mtu < dev->iamthif_msg_buf_index + mei_hdr->length);
|
|
|
|
|
|
|
|
mei_read_slots(dev, buffer, mei_hdr->length);
|
|
|
|
|
|
|
|
dev->iamthif_msg_buf_index += mei_hdr->length;
|
|
|
|
|
|
|
|
if (!mei_hdr->msg_complete)
|
|
|
|
return 0;
|
|
|
|
|
2013-04-20 02:16:53 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "amthif_message_buffer_index =%d\n",
|
2012-11-02 03:17:15 +08:00
|
|
|
mei_hdr->length);
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "completed amthif read.\n ");
|
2012-11-02 03:17:15 +08:00
|
|
|
if (!dev->iamthif_current_cb)
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
cb = dev->iamthif_current_cb;
|
|
|
|
dev->iamthif_current_cb = NULL;
|
|
|
|
|
2012-11-11 23:37:59 +08:00
|
|
|
if (!cb->cl)
|
2012-11-02 03:17:15 +08:00
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
dev->iamthif_stall_timer = 0;
|
|
|
|
cb->buf_idx = dev->iamthif_msg_buf_index;
|
|
|
|
cb->read_time = jiffies;
|
2014-08-14 22:22:21 +08:00
|
|
|
if (dev->iamthif_ioctl) {
|
2012-11-02 03:17:15 +08:00
|
|
|
/* found the iamthif cb */
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "complete the amthif read cb.\n ");
|
|
|
|
dev_dbg(&dev->pdev->dev, "add the amthif read cb to complete.\n ");
|
2012-11-02 03:17:15 +08:00
|
|
|
list_add_tail(&cb->list, &complete_list->list);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* mei_amthif_irq_read - prepares to read amthif data.
|
|
|
|
*
|
|
|
|
* @dev: the device structure.
|
|
|
|
* @slots: free slots.
|
|
|
|
*
|
|
|
|
* returns 0, OK; otherwise, error.
|
|
|
|
*/
|
|
|
|
int mei_amthif_irq_read(struct mei_device *dev, s32 *slots)
|
|
|
|
{
|
2013-03-12 00:27:02 +08:00
|
|
|
u32 msg_slots = mei_data2slots(sizeof(struct hbm_flow_control));
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2013-03-12 00:27:02 +08:00
|
|
|
if (*slots < msg_slots)
|
2012-11-02 03:17:15 +08:00
|
|
|
return -EMSGSIZE;
|
2013-03-12 00:27:02 +08:00
|
|
|
|
|
|
|
*slots -= msg_slots;
|
|
|
|
|
2012-12-26 01:06:11 +08:00
|
|
|
if (mei_hbm_cl_flow_control_req(dev, &dev->iamthif_cl)) {
|
2012-11-02 03:17:15 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "iamthif flow control failed\n");
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
dev_dbg(&dev->pdev->dev, "iamthif flow control success\n");
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_READING;
|
|
|
|
dev->iamthif_flow_control_pending = false;
|
|
|
|
dev->iamthif_msg_buf_index = 0;
|
|
|
|
dev->iamthif_msg_buf_size = 0;
|
|
|
|
dev->iamthif_stall_timer = MEI_IAMTHIF_STALL_TIMER;
|
2013-02-06 20:06:43 +08:00
|
|
|
dev->hbuf_is_ready = mei_hbuf_is_ready(dev);
|
2012-11-02 03:17:15 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* mei_amthif_complete - complete amthif callback.
|
|
|
|
*
|
|
|
|
* @dev: the device structure.
|
|
|
|
* @cb_pos: callback block.
|
|
|
|
*/
|
|
|
|
void mei_amthif_complete(struct mei_device *dev, struct mei_cl_cb *cb)
|
|
|
|
{
|
|
|
|
if (dev->iamthif_canceled != 1) {
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_READ_COMPLETE;
|
|
|
|
dev->iamthif_stall_timer = 0;
|
|
|
|
memcpy(cb->response_buffer.data,
|
|
|
|
dev->iamthif_msg_buf,
|
|
|
|
dev->iamthif_msg_buf_index);
|
2012-11-11 23:37:58 +08:00
|
|
|
list_add_tail(&cb->list, &dev->amthif_rd_complete_list.list);
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "amthif read completed\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
dev->iamthif_timer = jiffies;
|
|
|
|
dev_dbg(&dev->pdev->dev, "dev->iamthif_timer = %ld\n",
|
|
|
|
dev->iamthif_timer);
|
|
|
|
} else {
|
|
|
|
mei_amthif_run_next_cmd(dev);
|
|
|
|
}
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "completing amthif call back.\n");
|
2012-11-02 03:17:15 +08:00
|
|
|
wake_up_interruptible(&dev->iamthif_cl.wait);
|
|
|
|
}
|
|
|
|
|
2012-11-11 23:38:01 +08:00
|
|
|
/**
|
|
|
|
* mei_clear_list - removes all callbacks associated with file
|
|
|
|
* from mei_cb_list
|
|
|
|
*
|
|
|
|
* @dev: device structure.
|
|
|
|
* @file: file structure
|
|
|
|
* @mei_cb_list: callbacks list
|
|
|
|
*
|
|
|
|
* mei_clear_list is called to clear resources associated with file
|
|
|
|
* when application calls close function or Ctrl-C was pressed
|
|
|
|
*
|
|
|
|
* returns true if callback removed from the list, false otherwise
|
|
|
|
*/
|
|
|
|
static bool mei_clear_list(struct mei_device *dev,
|
|
|
|
const struct file *file, struct list_head *mei_cb_list)
|
|
|
|
{
|
|
|
|
struct mei_cl_cb *cb_pos = NULL;
|
|
|
|
struct mei_cl_cb *cb_next = NULL;
|
|
|
|
bool removed = false;
|
|
|
|
|
|
|
|
/* list all list member */
|
|
|
|
list_for_each_entry_safe(cb_pos, cb_next, mei_cb_list, list) {
|
|
|
|
/* check if list member associated with a file */
|
|
|
|
if (file == cb_pos->file_object) {
|
|
|
|
/* remove member from the list */
|
|
|
|
list_del(&cb_pos->list);
|
|
|
|
/* check if cb equal to current iamthif cb */
|
|
|
|
if (dev->iamthif_current_cb == cb_pos) {
|
|
|
|
dev->iamthif_current_cb = NULL;
|
|
|
|
/* send flow control to iamthif client */
|
2012-12-26 01:06:11 +08:00
|
|
|
mei_hbm_cl_flow_control_req(dev,
|
|
|
|
&dev->iamthif_cl);
|
2012-11-11 23:38:01 +08:00
|
|
|
}
|
|
|
|
/* free all allocated buffers */
|
|
|
|
mei_io_cb_free(cb_pos);
|
|
|
|
cb_pos = NULL;
|
|
|
|
removed = true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return removed;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* mei_clear_lists - removes all callbacks associated with file
|
|
|
|
*
|
|
|
|
* @dev: device structure
|
|
|
|
* @file: file structure
|
|
|
|
*
|
|
|
|
* mei_clear_lists is called to clear resources associated with file
|
|
|
|
* when application calls close function or Ctrl-C was pressed
|
|
|
|
*
|
|
|
|
* returns true if callback removed from the list, false otherwise
|
|
|
|
*/
|
|
|
|
static bool mei_clear_lists(struct mei_device *dev, struct file *file)
|
|
|
|
{
|
|
|
|
bool removed = false;
|
|
|
|
|
|
|
|
/* remove callbacks associated with a file */
|
|
|
|
mei_clear_list(dev, file, &dev->amthif_cmd_list.list);
|
|
|
|
if (mei_clear_list(dev, file, &dev->amthif_rd_complete_list.list))
|
|
|
|
removed = true;
|
2012-11-02 03:17:15 +08:00
|
|
|
|
2012-11-11 23:38:01 +08:00
|
|
|
mei_clear_list(dev, file, &dev->ctrl_rd_list.list);
|
|
|
|
|
|
|
|
if (mei_clear_list(dev, file, &dev->ctrl_wr_list.list))
|
|
|
|
removed = true;
|
|
|
|
|
|
|
|
if (mei_clear_list(dev, file, &dev->write_waiting_list.list))
|
|
|
|
removed = true;
|
|
|
|
|
|
|
|
if (mei_clear_list(dev, file, &dev->write_list.list))
|
|
|
|
removed = true;
|
|
|
|
|
|
|
|
/* check if iamthif_current_cb not NULL */
|
|
|
|
if (dev->iamthif_current_cb && !removed) {
|
|
|
|
/* check file and iamthif current cb association */
|
|
|
|
if (dev->iamthif_current_cb->file_object == file) {
|
|
|
|
/* remove cb */
|
|
|
|
mei_io_cb_free(dev->iamthif_current_cb);
|
|
|
|
dev->iamthif_current_cb = NULL;
|
|
|
|
removed = true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return removed;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* mei_amthif_release - the release function
|
|
|
|
*
|
2013-04-05 00:05:05 +08:00
|
|
|
* @dev: device structure
|
2012-11-11 23:38:01 +08:00
|
|
|
* @file: pointer to file structure
|
|
|
|
*
|
|
|
|
* returns 0 on success, <0 on error
|
|
|
|
*/
|
|
|
|
int mei_amthif_release(struct mei_device *dev, struct file *file)
|
|
|
|
{
|
2013-09-17 04:44:47 +08:00
|
|
|
if (dev->iamthif_open_count > 0)
|
|
|
|
dev->iamthif_open_count--;
|
2012-11-11 23:38:01 +08:00
|
|
|
|
|
|
|
if (dev->iamthif_file_object == file &&
|
|
|
|
dev->iamthif_state != MEI_IAMTHIF_IDLE) {
|
|
|
|
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "amthif canceled iamthif state %d\n",
|
2012-11-11 23:38:01 +08:00
|
|
|
dev->iamthif_state);
|
|
|
|
dev->iamthif_canceled = true;
|
|
|
|
if (dev->iamthif_state == MEI_IAMTHIF_READ_COMPLETE) {
|
2013-01-09 05:07:21 +08:00
|
|
|
dev_dbg(&dev->pdev->dev, "run next amthif iamthif cb\n");
|
2012-11-11 23:38:01 +08:00
|
|
|
mei_amthif_run_next_cmd(dev);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (mei_clear_lists(dev, file))
|
|
|
|
dev->iamthif_state = MEI_IAMTHIF_IDLE;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|