mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-28 11:18:45 +07:00
24aadc809f
1. We record host (write) buffer depth during reset so we don't need to query HCSR register later on. The host buffer depth doesn't change after the reset 2. Use mei_hbuf_max_data function to compute payload size in bytes Signed-off-by: Tomas Winkler <tomas.winkler@intel.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
739 lines
19 KiB
C
739 lines
19 KiB
C
/*
|
|
*
|
|
* 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/pci.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/wait.h>
|
|
#include <linux/delay.h>
|
|
|
|
#include "mei_dev.h"
|
|
#include "hw.h"
|
|
#include "interface.h"
|
|
#include <linux/mei.h>
|
|
|
|
const uuid_le mei_amthi_guid = UUID_LE(0x12f80028, 0xb4b7, 0x4b2d, 0xac,
|
|
0xa8, 0x46, 0xe0, 0xff, 0x65,
|
|
0x81, 0x4c);
|
|
|
|
/**
|
|
* mei_io_list_init - Sets up a queue list.
|
|
*
|
|
* @list: An instance io list structure
|
|
* @dev: the device structure
|
|
*/
|
|
void mei_io_list_init(struct mei_io_list *list)
|
|
{
|
|
/* initialize our queue list */
|
|
INIT_LIST_HEAD(&list->mei_cb.cb_list);
|
|
}
|
|
|
|
/**
|
|
* mei_io_list_flush - removes list entry belonging to cl.
|
|
*
|
|
* @list: An instance of our list structure
|
|
* @cl: private data of the file object
|
|
*/
|
|
void mei_io_list_flush(struct mei_io_list *list, struct mei_cl *cl)
|
|
{
|
|
struct mei_cl_cb *pos;
|
|
struct mei_cl_cb *next;
|
|
|
|
list_for_each_entry_safe(pos, next, &list->mei_cb.cb_list, cb_list) {
|
|
if (pos->file_private) {
|
|
struct mei_cl *cl_tmp;
|
|
cl_tmp = (struct mei_cl *)pos->file_private;
|
|
if (mei_cl_cmp_id(cl, cl_tmp))
|
|
list_del(&pos->cb_list);
|
|
}
|
|
}
|
|
}
|
|
/**
|
|
* mei_cl_flush_queues - flushes queue lists belonging to cl.
|
|
*
|
|
* @dev: the device structure
|
|
* @cl: private data of the file object
|
|
*/
|
|
int mei_cl_flush_queues(struct mei_cl *cl)
|
|
{
|
|
if (!cl || !cl->dev)
|
|
return -EINVAL;
|
|
|
|
dev_dbg(&cl->dev->pdev->dev, "remove list entry belonging to cl\n");
|
|
mei_io_list_flush(&cl->dev->read_list, cl);
|
|
mei_io_list_flush(&cl->dev->write_list, cl);
|
|
mei_io_list_flush(&cl->dev->write_waiting_list, cl);
|
|
mei_io_list_flush(&cl->dev->ctrl_wr_list, cl);
|
|
mei_io_list_flush(&cl->dev->ctrl_rd_list, cl);
|
|
mei_io_list_flush(&cl->dev->amthi_cmd_list, cl);
|
|
mei_io_list_flush(&cl->dev->amthi_read_complete_list, cl);
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
* mei_reset_iamthif_params - initializes mei device iamthif
|
|
*
|
|
* @dev: the device structure
|
|
*/
|
|
static void mei_reset_iamthif_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;
|
|
}
|
|
|
|
/**
|
|
* init_mei_device - allocates and initializes the mei device structure
|
|
*
|
|
* @pdev: The pci device structure
|
|
*
|
|
* returns The mei_device_device pointer on success, NULL on failure.
|
|
*/
|
|
struct mei_device *mei_device_init(struct pci_dev *pdev)
|
|
{
|
|
struct mei_device *dev;
|
|
|
|
dev = kzalloc(sizeof(struct mei_device), GFP_KERNEL);
|
|
if (!dev)
|
|
return NULL;
|
|
|
|
/* setup our list array */
|
|
INIT_LIST_HEAD(&dev->file_list);
|
|
INIT_LIST_HEAD(&dev->wd_cl.link);
|
|
INIT_LIST_HEAD(&dev->iamthif_cl.link);
|
|
mutex_init(&dev->device_lock);
|
|
init_waitqueue_head(&dev->wait_recvd_msg);
|
|
init_waitqueue_head(&dev->wait_stop_wd);
|
|
dev->mei_state = MEI_INITIALIZING;
|
|
dev->iamthif_state = MEI_IAMTHIF_IDLE;
|
|
dev->wd_interface_reg = false;
|
|
|
|
|
|
mei_io_list_init(&dev->read_list);
|
|
mei_io_list_init(&dev->write_list);
|
|
mei_io_list_init(&dev->write_waiting_list);
|
|
mei_io_list_init(&dev->ctrl_wr_list);
|
|
mei_io_list_init(&dev->ctrl_rd_list);
|
|
mei_io_list_init(&dev->amthi_cmd_list);
|
|
mei_io_list_init(&dev->amthi_read_complete_list);
|
|
dev->pdev = pdev;
|
|
return dev;
|
|
}
|
|
|
|
/**
|
|
* mei_hw_init - initializes host and fw to start work.
|
|
*
|
|
* @dev: the device structure
|
|
*
|
|
* returns 0 on success, <0 on failure.
|
|
*/
|
|
int mei_hw_init(struct mei_device *dev)
|
|
{
|
|
int err = 0;
|
|
int ret;
|
|
|
|
mutex_lock(&dev->device_lock);
|
|
|
|
dev->host_hw_state = mei_hcsr_read(dev);
|
|
dev->me_hw_state = mei_mecsr_read(dev);
|
|
dev_dbg(&dev->pdev->dev, "host_hw_state = 0x%08x, mestate = 0x%08x.\n",
|
|
dev->host_hw_state, dev->me_hw_state);
|
|
|
|
/* acknowledge interrupt and stop interupts */
|
|
if ((dev->host_hw_state & H_IS) == H_IS)
|
|
mei_reg_write(dev, H_CSR, dev->host_hw_state);
|
|
|
|
/* Doesn't change in runtime */
|
|
dev->hbuf_depth = (dev->host_hw_state & H_CBD) >> 24;
|
|
|
|
dev->recvd_msg = false;
|
|
dev_dbg(&dev->pdev->dev, "reset in start the mei device.\n");
|
|
|
|
mei_reset(dev, 1);
|
|
|
|
dev_dbg(&dev->pdev->dev, "host_hw_state = 0x%08x, me_hw_state = 0x%08x.\n",
|
|
dev->host_hw_state, dev->me_hw_state);
|
|
|
|
/* wait for ME to turn on ME_RDY */
|
|
if (!dev->recvd_msg) {
|
|
mutex_unlock(&dev->device_lock);
|
|
err = wait_event_interruptible_timeout(dev->wait_recvd_msg,
|
|
dev->recvd_msg, MEI_INTEROP_TIMEOUT);
|
|
mutex_lock(&dev->device_lock);
|
|
}
|
|
|
|
if (err <= 0 && !dev->recvd_msg) {
|
|
dev->mei_state = MEI_DISABLED;
|
|
dev_dbg(&dev->pdev->dev,
|
|
"wait_event_interruptible_timeout failed"
|
|
"on wait for ME to turn on ME_RDY.\n");
|
|
ret = -ENODEV;
|
|
goto out;
|
|
}
|
|
|
|
if (!(((dev->host_hw_state & H_RDY) == H_RDY) &&
|
|
((dev->me_hw_state & ME_RDY_HRA) == ME_RDY_HRA))) {
|
|
dev->mei_state = MEI_DISABLED;
|
|
dev_dbg(&dev->pdev->dev,
|
|
"host_hw_state = 0x%08x, me_hw_state = 0x%08x.\n",
|
|
dev->host_hw_state, dev->me_hw_state);
|
|
|
|
if (!(dev->host_hw_state & H_RDY))
|
|
dev_dbg(&dev->pdev->dev, "host turn off H_RDY.\n");
|
|
|
|
if (!(dev->me_hw_state & ME_RDY_HRA))
|
|
dev_dbg(&dev->pdev->dev, "ME turn off ME_RDY.\n");
|
|
|
|
dev_err(&dev->pdev->dev, "link layer initialization failed.\n");
|
|
ret = -ENODEV;
|
|
goto out;
|
|
}
|
|
|
|
if (dev->version.major_version != HBM_MAJOR_VERSION ||
|
|
dev->version.minor_version != HBM_MINOR_VERSION) {
|
|
dev_dbg(&dev->pdev->dev, "MEI start failed.\n");
|
|
ret = -ENODEV;
|
|
goto out;
|
|
}
|
|
|
|
dev->recvd_msg = false;
|
|
dev_dbg(&dev->pdev->dev, "host_hw_state = 0x%08x, me_hw_state = 0x%08x.\n",
|
|
dev->host_hw_state, dev->me_hw_state);
|
|
dev_dbg(&dev->pdev->dev, "ME turn on ME_RDY and host turn on H_RDY.\n");
|
|
dev_dbg(&dev->pdev->dev, "link layer has been established.\n");
|
|
dev_dbg(&dev->pdev->dev, "MEI start success.\n");
|
|
ret = 0;
|
|
|
|
out:
|
|
mutex_unlock(&dev->device_lock);
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* mei_hw_reset - resets fw via mei csr register.
|
|
*
|
|
* @dev: the device structure
|
|
* @interrupts_enabled: if interrupt should be enabled after reset.
|
|
*/
|
|
static void mei_hw_reset(struct mei_device *dev, int interrupts_enabled)
|
|
{
|
|
dev->host_hw_state |= (H_RST | H_IG);
|
|
|
|
if (interrupts_enabled)
|
|
mei_enable_interrupts(dev);
|
|
else
|
|
mei_disable_interrupts(dev);
|
|
}
|
|
|
|
/**
|
|
* mei_reset - resets host and fw.
|
|
*
|
|
* @dev: the device structure
|
|
* @interrupts_enabled: if interrupt should be enabled after reset.
|
|
*/
|
|
void mei_reset(struct mei_device *dev, int interrupts_enabled)
|
|
{
|
|
struct mei_cl *cl_pos = NULL;
|
|
struct mei_cl *cl_next = NULL;
|
|
struct mei_cl_cb *cb_pos = NULL;
|
|
struct mei_cl_cb *cb_next = NULL;
|
|
bool unexpected;
|
|
|
|
if (dev->mei_state == MEI_RECOVERING_FROM_RESET) {
|
|
dev->need_reset = true;
|
|
return;
|
|
}
|
|
|
|
unexpected = (dev->mei_state != MEI_INITIALIZING &&
|
|
dev->mei_state != MEI_DISABLED &&
|
|
dev->mei_state != MEI_POWER_DOWN &&
|
|
dev->mei_state != MEI_POWER_UP);
|
|
|
|
dev->host_hw_state = mei_hcsr_read(dev);
|
|
|
|
dev_dbg(&dev->pdev->dev, "before reset host_hw_state = 0x%08x.\n",
|
|
dev->host_hw_state);
|
|
|
|
mei_hw_reset(dev, interrupts_enabled);
|
|
|
|
dev->host_hw_state &= ~H_RST;
|
|
dev->host_hw_state |= H_IG;
|
|
|
|
mei_hcsr_set(dev);
|
|
|
|
dev_dbg(&dev->pdev->dev, "currently saved host_hw_state = 0x%08x.\n",
|
|
dev->host_hw_state);
|
|
|
|
dev->need_reset = false;
|
|
|
|
if (dev->mei_state != MEI_INITIALIZING) {
|
|
if (dev->mei_state != MEI_DISABLED &&
|
|
dev->mei_state != MEI_POWER_DOWN)
|
|
dev->mei_state = MEI_RESETING;
|
|
|
|
list_for_each_entry_safe(cl_pos,
|
|
cl_next, &dev->file_list, link) {
|
|
cl_pos->state = MEI_FILE_DISCONNECTED;
|
|
cl_pos->mei_flow_ctrl_creds = 0;
|
|
cl_pos->read_cb = NULL;
|
|
cl_pos->timer_count = 0;
|
|
}
|
|
/* remove entry if already in list */
|
|
dev_dbg(&dev->pdev->dev, "list del iamthif and wd file list.\n");
|
|
mei_remove_client_from_file_list(dev,
|
|
dev->wd_cl.host_client_id);
|
|
|
|
mei_remove_client_from_file_list(dev,
|
|
dev->iamthif_cl.host_client_id);
|
|
|
|
mei_reset_iamthif_params(dev);
|
|
dev->wd_due_counter = 0;
|
|
dev->extra_write_index = 0;
|
|
}
|
|
|
|
dev->me_clients_num = 0;
|
|
dev->rd_msg_hdr = 0;
|
|
dev->stop = false;
|
|
dev->wd_pending = false;
|
|
|
|
/* update the state of the registers after reset */
|
|
dev->host_hw_state = mei_hcsr_read(dev);
|
|
dev->me_hw_state = mei_mecsr_read(dev);
|
|
|
|
dev_dbg(&dev->pdev->dev, "after reset host_hw_state = 0x%08x, me_hw_state = 0x%08x.\n",
|
|
dev->host_hw_state, dev->me_hw_state);
|
|
|
|
if (unexpected)
|
|
dev_warn(&dev->pdev->dev, "unexpected reset.\n");
|
|
|
|
/* Wake up all readings so they can be interrupted */
|
|
list_for_each_entry_safe(cl_pos, cl_next, &dev->file_list, link) {
|
|
if (waitqueue_active(&cl_pos->rx_wait)) {
|
|
dev_dbg(&dev->pdev->dev, "Waking up client!\n");
|
|
wake_up_interruptible(&cl_pos->rx_wait);
|
|
}
|
|
}
|
|
/* remove all waiting requests */
|
|
list_for_each_entry_safe(cb_pos, cb_next,
|
|
&dev->write_list.mei_cb.cb_list, cb_list) {
|
|
list_del(&cb_pos->cb_list);
|
|
mei_free_cb_private(cb_pos);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
* host_start_message - mei host sends start message.
|
|
*
|
|
* @dev: the device structure
|
|
*
|
|
* returns none.
|
|
*/
|
|
void mei_host_start_message(struct mei_device *dev)
|
|
{
|
|
struct mei_msg_hdr *mei_hdr;
|
|
struct hbm_host_version_request *host_start_req;
|
|
|
|
/* host start message */
|
|
mei_hdr = (struct mei_msg_hdr *) &dev->wr_msg_buf[0];
|
|
mei_hdr->host_addr = 0;
|
|
mei_hdr->me_addr = 0;
|
|
mei_hdr->length = sizeof(struct hbm_host_version_request);
|
|
mei_hdr->msg_complete = 1;
|
|
mei_hdr->reserved = 0;
|
|
|
|
host_start_req =
|
|
(struct hbm_host_version_request *) &dev->wr_msg_buf[1];
|
|
memset(host_start_req, 0, sizeof(struct hbm_host_version_request));
|
|
host_start_req->hbm_cmd = HOST_START_REQ_CMD;
|
|
host_start_req->host_version.major_version = HBM_MAJOR_VERSION;
|
|
host_start_req->host_version.minor_version = HBM_MINOR_VERSION;
|
|
dev->recvd_msg = false;
|
|
if (mei_write_message(dev, mei_hdr, (unsigned char *)host_start_req,
|
|
mei_hdr->length)) {
|
|
dev_dbg(&dev->pdev->dev, "write send version message to FW fail.\n");
|
|
dev->mei_state = MEI_RESETING;
|
|
mei_reset(dev, 1);
|
|
}
|
|
dev->init_clients_state = MEI_START_MESSAGE;
|
|
dev->init_clients_timer = INIT_CLIENTS_TIMEOUT;
|
|
return ;
|
|
}
|
|
|
|
/**
|
|
* host_enum_clients_message - host sends enumeration client request message.
|
|
*
|
|
* @dev: the device structure
|
|
*
|
|
* returns none.
|
|
*/
|
|
void mei_host_enum_clients_message(struct mei_device *dev)
|
|
{
|
|
struct mei_msg_hdr *mei_hdr;
|
|
struct hbm_host_enum_request *host_enum_req;
|
|
mei_hdr = (struct mei_msg_hdr *) &dev->wr_msg_buf[0];
|
|
/* enumerate clients */
|
|
mei_hdr->host_addr = 0;
|
|
mei_hdr->me_addr = 0;
|
|
mei_hdr->length = sizeof(struct hbm_host_enum_request);
|
|
mei_hdr->msg_complete = 1;
|
|
mei_hdr->reserved = 0;
|
|
|
|
host_enum_req = (struct hbm_host_enum_request *) &dev->wr_msg_buf[1];
|
|
memset(host_enum_req, 0, sizeof(struct hbm_host_enum_request));
|
|
host_enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
|
|
if (mei_write_message(dev, mei_hdr, (unsigned char *)host_enum_req,
|
|
mei_hdr->length)) {
|
|
dev->mei_state = MEI_RESETING;
|
|
dev_dbg(&dev->pdev->dev, "write send enumeration request message to FW fail.\n");
|
|
mei_reset(dev, 1);
|
|
}
|
|
dev->init_clients_state = MEI_ENUM_CLIENTS_MESSAGE;
|
|
dev->init_clients_timer = INIT_CLIENTS_TIMEOUT;
|
|
return;
|
|
}
|
|
|
|
|
|
/**
|
|
* allocate_me_clients_storage - allocates storage for me clients
|
|
*
|
|
* @dev: the device structure
|
|
*
|
|
* returns none.
|
|
*/
|
|
void mei_allocate_me_clients_storage(struct mei_device *dev)
|
|
{
|
|
struct mei_me_client *clients;
|
|
int b;
|
|
|
|
/* count how many ME clients we have */
|
|
for_each_set_bit(b, dev->me_clients_map, MEI_CLIENTS_MAX)
|
|
dev->me_clients_num++;
|
|
|
|
if (dev->me_clients_num <= 0)
|
|
return ;
|
|
|
|
|
|
if (dev->me_clients != NULL) {
|
|
kfree(dev->me_clients);
|
|
dev->me_clients = NULL;
|
|
}
|
|
dev_dbg(&dev->pdev->dev, "memory allocation for ME clients size=%zd.\n",
|
|
dev->me_clients_num * sizeof(struct mei_me_client));
|
|
/* allocate storage for ME clients representation */
|
|
clients = kcalloc(dev->me_clients_num,
|
|
sizeof(struct mei_me_client), GFP_KERNEL);
|
|
if (!clients) {
|
|
dev_dbg(&dev->pdev->dev, "memory allocation for ME clients failed.\n");
|
|
dev->mei_state = MEI_RESETING;
|
|
mei_reset(dev, 1);
|
|
return ;
|
|
}
|
|
dev->me_clients = clients;
|
|
return ;
|
|
}
|
|
/**
|
|
* host_client_properties - reads properties for client
|
|
*
|
|
* @dev: the device structure
|
|
*
|
|
* returns:
|
|
* < 0 - Error.
|
|
* = 0 - no more clients.
|
|
* = 1 - still have clients to send properties request.
|
|
*/
|
|
int mei_host_client_properties(struct mei_device *dev)
|
|
{
|
|
struct mei_msg_hdr *mei_header;
|
|
struct hbm_props_request *host_cli_req;
|
|
int b;
|
|
u8 client_num = dev->me_client_presentation_num;
|
|
|
|
b = dev->me_client_index;
|
|
b = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX, b);
|
|
if (b < MEI_CLIENTS_MAX) {
|
|
dev->me_clients[client_num].client_id = b;
|
|
dev->me_clients[client_num].mei_flow_ctrl_creds = 0;
|
|
mei_header = (struct mei_msg_hdr *)&dev->wr_msg_buf[0];
|
|
mei_header->host_addr = 0;
|
|
mei_header->me_addr = 0;
|
|
mei_header->length = sizeof(struct hbm_props_request);
|
|
mei_header->msg_complete = 1;
|
|
mei_header->reserved = 0;
|
|
|
|
host_cli_req = (struct hbm_props_request *)&dev->wr_msg_buf[1];
|
|
|
|
memset(host_cli_req, 0, sizeof(struct hbm_props_request));
|
|
|
|
host_cli_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
|
|
host_cli_req->address = b;
|
|
|
|
if (mei_write_message(dev, mei_header,
|
|
(unsigned char *)host_cli_req,
|
|
mei_header->length)) {
|
|
dev->mei_state = MEI_RESETING;
|
|
dev_dbg(&dev->pdev->dev, "write send enumeration request message to FW fail.\n");
|
|
mei_reset(dev, 1);
|
|
return -EIO;
|
|
}
|
|
|
|
dev->init_clients_timer = INIT_CLIENTS_TIMEOUT;
|
|
dev->me_client_index = b;
|
|
return 1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* mei_init_file_private - initializes private file structure.
|
|
*
|
|
* @priv: private file structure to be initialized
|
|
* @file: the file structure
|
|
*/
|
|
void mei_cl_init(struct mei_cl *priv, struct mei_device *dev)
|
|
{
|
|
memset(priv, 0, sizeof(struct mei_cl));
|
|
init_waitqueue_head(&priv->wait);
|
|
init_waitqueue_head(&priv->rx_wait);
|
|
init_waitqueue_head(&priv->tx_wait);
|
|
INIT_LIST_HEAD(&priv->link);
|
|
priv->reading_state = MEI_IDLE;
|
|
priv->writing_state = MEI_IDLE;
|
|
priv->dev = dev;
|
|
}
|
|
|
|
int mei_find_me_client_index(const struct mei_device *dev, uuid_le cuuid)
|
|
{
|
|
int i, res = -1;
|
|
|
|
for (i = 0; i < dev->me_clients_num; ++i)
|
|
if (uuid_le_cmp(cuuid,
|
|
dev->me_clients[i].props.protocol_name) == 0) {
|
|
res = i;
|
|
break;
|
|
}
|
|
|
|
return res;
|
|
}
|
|
|
|
|
|
/**
|
|
* mei_find_me_client_update_filext - searches for ME client guid
|
|
* sets client_id in mei_file_private if found
|
|
* @dev: the device structure
|
|
* @priv: private file structure to set client_id in
|
|
* @cguid: searched guid of ME client
|
|
* @client_id: id of host client to be set in file private structure
|
|
*
|
|
* returns ME client index
|
|
*/
|
|
u8 mei_find_me_client_update_filext(struct mei_device *dev, struct mei_cl *priv,
|
|
const uuid_le *cguid, u8 client_id)
|
|
{
|
|
int i;
|
|
|
|
if (!dev || !priv || !cguid)
|
|
return 0;
|
|
|
|
/* check for valid client id */
|
|
i = mei_find_me_client_index(dev, *cguid);
|
|
if (i >= 0) {
|
|
priv->me_client_id = dev->me_clients[i].client_id;
|
|
priv->state = MEI_FILE_CONNECTING;
|
|
priv->host_client_id = client_id;
|
|
|
|
list_add_tail(&priv->link, &dev->file_list);
|
|
return (u8)i;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* host_init_iamthif - mei initialization iamthif client.
|
|
*
|
|
* @dev: the device structure
|
|
*
|
|
*/
|
|
void mei_host_init_iamthif(struct mei_device *dev)
|
|
{
|
|
u8 i;
|
|
unsigned char *msg_buf;
|
|
|
|
mei_cl_init(&dev->iamthif_cl, dev);
|
|
dev->iamthif_cl.state = MEI_FILE_DISCONNECTED;
|
|
|
|
/* find ME amthi client */
|
|
i = mei_find_me_client_update_filext(dev, &dev->iamthif_cl,
|
|
&mei_amthi_guid, MEI_IAMTHIF_HOST_CLIENT_ID);
|
|
if (dev->iamthif_cl.state != MEI_FILE_CONNECTING) {
|
|
dev_dbg(&dev->pdev->dev, "failed to find iamthif client.\n");
|
|
return;
|
|
}
|
|
|
|
/* Assign iamthif_mtu to the value received from ME */
|
|
|
|
dev->iamthif_mtu = dev->me_clients[i].props.max_msg_length;
|
|
dev_dbg(&dev->pdev->dev, "IAMTHIF_MTU = %d\n",
|
|
dev->me_clients[i].props.max_msg_length);
|
|
|
|
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) {
|
|
dev_dbg(&dev->pdev->dev, "memory allocation for ME message buffer failed.\n");
|
|
return;
|
|
}
|
|
|
|
dev->iamthif_msg_buf = msg_buf;
|
|
|
|
if (mei_connect(dev, &dev->iamthif_cl)) {
|
|
dev_dbg(&dev->pdev->dev, "Failed to connect to AMTHI client\n");
|
|
dev->iamthif_cl.state = MEI_FILE_DISCONNECTED;
|
|
dev->iamthif_cl.host_client_id = 0;
|
|
} else {
|
|
dev->iamthif_cl.timer_count = CONNECT_TIMEOUT;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* mei_alloc_file_private - allocates a private file structure and sets it up.
|
|
* @file: the file structure
|
|
*
|
|
* returns The allocated file or NULL on failure
|
|
*/
|
|
struct mei_cl *mei_cl_allocate(struct mei_device *dev)
|
|
{
|
|
struct mei_cl *cl;
|
|
|
|
cl = kmalloc(sizeof(struct mei_cl), GFP_KERNEL);
|
|
if (!cl)
|
|
return NULL;
|
|
|
|
mei_cl_init(cl, dev);
|
|
|
|
return cl;
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
* mei_disconnect_host_client - sends disconnect message to fw from host client.
|
|
*
|
|
* @dev: the device structure
|
|
* @cl: private data of the file object
|
|
*
|
|
* Locking: called under "dev->device_lock" lock
|
|
*
|
|
* returns 0 on success, <0 on failure.
|
|
*/
|
|
int mei_disconnect_host_client(struct mei_device *dev, struct mei_cl *cl)
|
|
{
|
|
int rets, err;
|
|
long timeout = 15; /* 15 seconds */
|
|
struct mei_cl_cb *cb;
|
|
|
|
if (!dev || !cl)
|
|
return -ENODEV;
|
|
|
|
if (cl->state != MEI_FILE_DISCONNECTING)
|
|
return 0;
|
|
|
|
cb = kzalloc(sizeof(struct mei_cl_cb), GFP_KERNEL);
|
|
if (!cb)
|
|
return -ENOMEM;
|
|
|
|
INIT_LIST_HEAD(&cb->cb_list);
|
|
cb->file_private = cl;
|
|
cb->major_file_operations = MEI_CLOSE;
|
|
if (dev->mei_host_buffer_is_empty) {
|
|
dev->mei_host_buffer_is_empty = false;
|
|
if (mei_disconnect(dev, cl)) {
|
|
rets = -ENODEV;
|
|
dev_dbg(&dev->pdev->dev, "failed to call mei_disconnect.\n");
|
|
goto free;
|
|
}
|
|
mdelay(10); /* Wait for hardware disconnection ready */
|
|
list_add_tail(&cb->cb_list, &dev->ctrl_rd_list.mei_cb.cb_list);
|
|
} else {
|
|
dev_dbg(&dev->pdev->dev, "add disconnect cb to control write list\n");
|
|
list_add_tail(&cb->cb_list,
|
|
&dev->ctrl_wr_list.mei_cb.cb_list);
|
|
}
|
|
mutex_unlock(&dev->device_lock);
|
|
|
|
err = wait_event_timeout(dev->wait_recvd_msg,
|
|
(MEI_FILE_DISCONNECTED == cl->state),
|
|
timeout * HZ);
|
|
|
|
mutex_lock(&dev->device_lock);
|
|
if (MEI_FILE_DISCONNECTED == cl->state) {
|
|
rets = 0;
|
|
dev_dbg(&dev->pdev->dev, "successfully disconnected from FW client.\n");
|
|
} else {
|
|
rets = -ENODEV;
|
|
if (MEI_FILE_DISCONNECTED != cl->state)
|
|
dev_dbg(&dev->pdev->dev, "wrong status client disconnect.\n");
|
|
|
|
if (err)
|
|
dev_dbg(&dev->pdev->dev,
|
|
"wait failed disconnect err=%08x\n",
|
|
err);
|
|
|
|
dev_dbg(&dev->pdev->dev, "failed to disconnect from FW client.\n");
|
|
}
|
|
|
|
mei_io_list_flush(&dev->ctrl_rd_list, cl);
|
|
mei_io_list_flush(&dev->ctrl_wr_list, cl);
|
|
free:
|
|
mei_free_cb_private(cb);
|
|
return rets;
|
|
}
|
|
|
|
/**
|
|
* mei_remove_client_from_file_list -
|
|
* removes file private data from device file list
|
|
*
|
|
* @dev: the device structure
|
|
* @host_client_id: host client id to be removed
|
|
*/
|
|
void mei_remove_client_from_file_list(struct mei_device *dev,
|
|
u8 host_client_id)
|
|
{
|
|
struct mei_cl *cl_pos = NULL;
|
|
struct mei_cl *cl_next = NULL;
|
|
list_for_each_entry_safe(cl_pos, cl_next, &dev->file_list, link) {
|
|
if (host_client_id == cl_pos->host_client_id) {
|
|
dev_dbg(&dev->pdev->dev, "remove host client = %d, ME client = %d\n",
|
|
cl_pos->host_client_id,
|
|
cl_pos->me_client_id);
|
|
list_del_init(&cl_pos->link);
|
|
break;
|
|
}
|
|
}
|
|
}
|