mei: compact code for mei bus message creation
1. replace boilerplate code for filling up the bus message header with a common wrapper function 2. shorten variable names and use temporal variables to save some screen space Signed-off-by: Tomas Winkler <tomas.winkler@intel.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
2c9e9fdc0b
commit
5bd6471441
|
@ -43,6 +43,7 @@ const char *mei_dev_state_str(int state)
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* mei_io_list_flush - removes list entry belonging to cl.
|
* mei_io_list_flush - removes list entry belonging to cl.
|
||||||
*
|
*
|
||||||
|
@ -331,25 +332,20 @@ void mei_reset(struct mei_device *dev, int interrupts_enabled)
|
||||||
void mei_host_start_message(struct mei_device *dev)
|
void mei_host_start_message(struct mei_device *dev)
|
||||||
{
|
{
|
||||||
struct mei_msg_hdr *mei_hdr;
|
struct mei_msg_hdr *mei_hdr;
|
||||||
struct hbm_host_version_request *host_start_req;
|
struct hbm_host_version_request *start_req;
|
||||||
|
const size_t len = sizeof(struct hbm_host_version_request);
|
||||||
|
|
||||||
|
mei_hdr = mei_hbm_hdr(&dev->wr_msg_buf[0], len);
|
||||||
|
|
||||||
/* host start message */
|
/* host start message */
|
||||||
mei_hdr = (struct mei_msg_hdr *) &dev->wr_msg_buf[0];
|
start_req = (struct hbm_host_version_request *)&dev->wr_msg_buf[1];
|
||||||
mei_hdr->host_addr = 0;
|
memset(start_req, 0, len);
|
||||||
mei_hdr->me_addr = 0;
|
start_req->hbm_cmd = HOST_START_REQ_CMD;
|
||||||
mei_hdr->length = sizeof(struct hbm_host_version_request);
|
start_req->host_version.major_version = HBM_MAJOR_VERSION;
|
||||||
mei_hdr->msg_complete = 1;
|
start_req->host_version.minor_version = HBM_MINOR_VERSION;
|
||||||
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;
|
dev->recvd_msg = false;
|
||||||
if (mei_write_message(dev, mei_hdr, (unsigned char *)host_start_req,
|
if (mei_write_message(dev, mei_hdr, (unsigned char *)start_req, len)) {
|
||||||
mei_hdr->length)) {
|
|
||||||
dev_dbg(&dev->pdev->dev, "write send version message to FW fail.\n");
|
dev_dbg(&dev->pdev->dev, "write send version message to FW fail.\n");
|
||||||
dev->dev_state = MEI_DEV_RESETING;
|
dev->dev_state = MEI_DEV_RESETING;
|
||||||
mei_reset(dev, 1);
|
mei_reset(dev, 1);
|
||||||
|
@ -369,20 +365,16 @@ void mei_host_start_message(struct mei_device *dev)
|
||||||
void mei_host_enum_clients_message(struct mei_device *dev)
|
void mei_host_enum_clients_message(struct mei_device *dev)
|
||||||
{
|
{
|
||||||
struct mei_msg_hdr *mei_hdr;
|
struct mei_msg_hdr *mei_hdr;
|
||||||
struct hbm_host_enum_request *host_enum_req;
|
struct hbm_host_enum_request *enum_req;
|
||||||
mei_hdr = (struct mei_msg_hdr *) &dev->wr_msg_buf[0];
|
const size_t len = sizeof(struct hbm_host_enum_request);
|
||||||
/* enumerate clients */
|
/* enumerate clients */
|
||||||
mei_hdr->host_addr = 0;
|
mei_hdr = mei_hbm_hdr(&dev->wr_msg_buf[0], len);
|
||||||
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];
|
enum_req = (struct hbm_host_enum_request *) &dev->wr_msg_buf[1];
|
||||||
memset(host_enum_req, 0, sizeof(struct hbm_host_enum_request));
|
memset(enum_req, 0, sizeof(struct hbm_host_enum_request));
|
||||||
host_enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
|
enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
|
||||||
if (mei_write_message(dev, mei_hdr, (unsigned char *)host_enum_req,
|
|
||||||
mei_hdr->length)) {
|
if (mei_write_message(dev, mei_hdr, (unsigned char *)enum_req, len)) {
|
||||||
dev->dev_state = MEI_DEV_RESETING;
|
dev->dev_state = MEI_DEV_RESETING;
|
||||||
dev_dbg(&dev->pdev->dev, "write send enumeration request message to FW fail.\n");
|
dev_dbg(&dev->pdev->dev, "write send enumeration request message to FW fail.\n");
|
||||||
mei_reset(dev, 1);
|
mei_reset(dev, 1);
|
||||||
|
@ -443,33 +435,31 @@ void mei_allocate_me_clients_storage(struct mei_device *dev)
|
||||||
*/
|
*/
|
||||||
int mei_host_client_properties(struct mei_device *dev)
|
int mei_host_client_properties(struct mei_device *dev)
|
||||||
{
|
{
|
||||||
struct mei_msg_hdr *mei_header;
|
|
||||||
struct hbm_props_request *host_cli_req;
|
struct mei_msg_hdr *mei_hdr;
|
||||||
|
struct hbm_props_request *prop_req;
|
||||||
|
const size_t len = sizeof(struct hbm_props_request);
|
||||||
|
|
||||||
int b;
|
int b;
|
||||||
u8 client_num = dev->me_client_presentation_num;
|
u8 client_num = dev->me_client_presentation_num;
|
||||||
|
|
||||||
|
prop_req = (struct hbm_props_request *)&dev->wr_msg_buf[1];
|
||||||
|
|
||||||
b = dev->me_client_index;
|
b = dev->me_client_index;
|
||||||
b = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX, b);
|
b = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX, b);
|
||||||
if (b < MEI_CLIENTS_MAX) {
|
if (b < MEI_CLIENTS_MAX) {
|
||||||
dev->me_clients[client_num].client_id = b;
|
dev->me_clients[client_num].client_id = b;
|
||||||
dev->me_clients[client_num].mei_flow_ctrl_creds = 0;
|
dev->me_clients[client_num].mei_flow_ctrl_creds = 0;
|
||||||
mei_header = (struct mei_msg_hdr *)&dev->wr_msg_buf[0];
|
mei_hdr = mei_hbm_hdr(&dev->wr_msg_buf[0], len);
|
||||||
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));
|
memset(prop_req, 0, sizeof(struct hbm_props_request));
|
||||||
|
|
||||||
host_cli_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
|
prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
|
||||||
host_cli_req->address = b;
|
prop_req->address = b;
|
||||||
|
|
||||||
if (mei_write_message(dev, mei_header,
|
if (mei_write_message(dev, mei_hdr,
|
||||||
(unsigned char *)host_cli_req,
|
(unsigned char *)prop_req, len)) {
|
||||||
mei_header->length)) {
|
|
||||||
dev->dev_state = MEI_DEV_RESETING;
|
dev->dev_state = MEI_DEV_RESETING;
|
||||||
dev_dbg(&dev->pdev->dev, "write send enumeration request message to FW fail.\n");
|
dev_dbg(&dev->pdev->dev, "write send enumeration request message to FW fail.\n");
|
||||||
mei_reset(dev, 1);
|
mei_reset(dev, 1);
|
||||||
|
|
|
@ -292,28 +292,23 @@ int mei_flow_ctrl_reduce(struct mei_device *dev, struct mei_cl *cl)
|
||||||
int mei_send_flow_control(struct mei_device *dev, struct mei_cl *cl)
|
int mei_send_flow_control(struct mei_device *dev, struct mei_cl *cl)
|
||||||
{
|
{
|
||||||
struct mei_msg_hdr *mei_hdr;
|
struct mei_msg_hdr *mei_hdr;
|
||||||
struct hbm_flow_control *mei_flow_control;
|
struct hbm_flow_control *flow_ctrl;
|
||||||
|
const size_t len = sizeof(struct hbm_flow_control);
|
||||||
|
|
||||||
mei_hdr = (struct mei_msg_hdr *) &dev->wr_msg_buf[0];
|
mei_hdr = mei_hbm_hdr(&dev->wr_msg_buf[0], len);
|
||||||
mei_hdr->host_addr = 0;
|
|
||||||
mei_hdr->me_addr = 0;
|
|
||||||
mei_hdr->length = sizeof(struct hbm_flow_control);
|
|
||||||
mei_hdr->msg_complete = 1;
|
|
||||||
mei_hdr->reserved = 0;
|
|
||||||
|
|
||||||
mei_flow_control = (struct hbm_flow_control *) &dev->wr_msg_buf[1];
|
flow_ctrl = (struct hbm_flow_control *)&dev->wr_msg_buf[1];
|
||||||
memset(mei_flow_control, 0, sizeof(*mei_flow_control));
|
memset(flow_ctrl, 0, len);
|
||||||
mei_flow_control->host_addr = cl->host_client_id;
|
flow_ctrl->hbm_cmd = MEI_FLOW_CONTROL_CMD;
|
||||||
mei_flow_control->me_addr = cl->me_client_id;
|
flow_ctrl->host_addr = cl->host_client_id;
|
||||||
mei_flow_control->hbm_cmd = MEI_FLOW_CONTROL_CMD;
|
flow_ctrl->me_addr = cl->me_client_id;
|
||||||
memset(mei_flow_control->reserved, 0,
|
/* FIXME: reserved !? */
|
||||||
sizeof(mei_flow_control->reserved));
|
memset(flow_ctrl->reserved, 0, sizeof(flow_ctrl->reserved));
|
||||||
dev_dbg(&dev->pdev->dev, "sending flow control host client = %d, ME client = %d\n",
|
dev_dbg(&dev->pdev->dev, "sending flow control host client = %d, ME client = %d\n",
|
||||||
cl->host_client_id, cl->me_client_id);
|
cl->host_client_id, cl->me_client_id);
|
||||||
|
|
||||||
return mei_write_message(dev, mei_hdr,
|
return mei_write_message(dev, mei_hdr,
|
||||||
(unsigned char *) mei_flow_control,
|
(unsigned char *) flow_ctrl, len);
|
||||||
sizeof(struct hbm_flow_control));
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -353,23 +348,18 @@ int mei_disconnect(struct mei_device *dev, struct mei_cl *cl)
|
||||||
{
|
{
|
||||||
struct mei_msg_hdr *mei_hdr;
|
struct mei_msg_hdr *mei_hdr;
|
||||||
struct hbm_client_connect_request *req;
|
struct hbm_client_connect_request *req;
|
||||||
|
const size_t len = sizeof(struct hbm_client_connect_request);
|
||||||
|
|
||||||
mei_hdr = (struct mei_msg_hdr *) &dev->wr_msg_buf[0];
|
mei_hdr = mei_hbm_hdr(&dev->wr_msg_buf[0], len);
|
||||||
mei_hdr->host_addr = 0;
|
|
||||||
mei_hdr->me_addr = 0;
|
|
||||||
mei_hdr->length = sizeof(struct hbm_client_connect_request);
|
|
||||||
mei_hdr->msg_complete = 1;
|
|
||||||
mei_hdr->reserved = 0;
|
|
||||||
|
|
||||||
req = (struct hbm_client_connect_request *)&dev->wr_msg_buf[1];
|
req = (struct hbm_client_connect_request *)&dev->wr_msg_buf[1];
|
||||||
memset(req, 0, sizeof(*req));
|
memset(req, 0, len);
|
||||||
|
req->hbm_cmd = CLIENT_DISCONNECT_REQ_CMD;
|
||||||
req->host_addr = cl->host_client_id;
|
req->host_addr = cl->host_client_id;
|
||||||
req->me_addr = cl->me_client_id;
|
req->me_addr = cl->me_client_id;
|
||||||
req->hbm_cmd = CLIENT_DISCONNECT_REQ_CMD;
|
|
||||||
req->reserved = 0;
|
req->reserved = 0;
|
||||||
|
|
||||||
return mei_write_message(dev, mei_hdr, (unsigned char *)req,
|
return mei_write_message(dev, mei_hdr, (unsigned char *)req, len);
|
||||||
sizeof(struct hbm_client_connect_request));
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -383,23 +373,16 @@ int mei_disconnect(struct mei_device *dev, struct mei_cl *cl)
|
||||||
int mei_connect(struct mei_device *dev, struct mei_cl *cl)
|
int mei_connect(struct mei_device *dev, struct mei_cl *cl)
|
||||||
{
|
{
|
||||||
struct mei_msg_hdr *mei_hdr;
|
struct mei_msg_hdr *mei_hdr;
|
||||||
struct hbm_client_connect_request *mei_cli_connect;
|
struct hbm_client_connect_request *req;
|
||||||
|
const size_t len = sizeof(struct hbm_client_connect_request);
|
||||||
|
|
||||||
mei_hdr = (struct mei_msg_hdr *) &dev->wr_msg_buf[0];
|
mei_hdr = mei_hbm_hdr(&dev->wr_msg_buf[0], len);
|
||||||
mei_hdr->host_addr = 0;
|
|
||||||
mei_hdr->me_addr = 0;
|
|
||||||
mei_hdr->length = sizeof(struct hbm_client_connect_request);
|
|
||||||
mei_hdr->msg_complete = 1;
|
|
||||||
mei_hdr->reserved = 0;
|
|
||||||
|
|
||||||
mei_cli_connect =
|
req = (struct hbm_client_connect_request *) &dev->wr_msg_buf[1];
|
||||||
(struct hbm_client_connect_request *) &dev->wr_msg_buf[1];
|
req->hbm_cmd = CLIENT_CONNECT_REQ_CMD;
|
||||||
mei_cli_connect->host_addr = cl->host_client_id;
|
req->host_addr = cl->host_client_id;
|
||||||
mei_cli_connect->me_addr = cl->me_client_id;
|
req->me_addr = cl->me_client_id;
|
||||||
mei_cli_connect->hbm_cmd = CLIENT_CONNECT_REQ_CMD;
|
req->reserved = 0;
|
||||||
mei_cli_connect->reserved = 0;
|
|
||||||
|
|
||||||
return mei_write_message(dev, mei_hdr,
|
return mei_write_message(dev, mei_hdr, (unsigned char *) req, len);
|
||||||
(unsigned char *) mei_cli_connect,
|
|
||||||
sizeof(struct hbm_client_connect_request));
|
|
||||||
}
|
}
|
||||||
|
|
|
@ -429,39 +429,30 @@ static int same_disconn_addr(struct mei_cl *cl,
|
||||||
static void mei_client_disconnect_request(struct mei_device *dev,
|
static void mei_client_disconnect_request(struct mei_device *dev,
|
||||||
struct hbm_client_connect_request *disconnect_req)
|
struct hbm_client_connect_request *disconnect_req)
|
||||||
{
|
{
|
||||||
struct mei_msg_hdr *mei_hdr;
|
|
||||||
struct hbm_client_connect_response *disconnect_res;
|
struct hbm_client_connect_response *disconnect_res;
|
||||||
struct mei_cl *cl_pos = NULL;
|
struct mei_cl *pos, *next;
|
||||||
struct mei_cl *cl_next = NULL;
|
const size_t len = sizeof(struct hbm_client_connect_response);
|
||||||
|
|
||||||
list_for_each_entry_safe(cl_pos, cl_next, &dev->file_list, link) {
|
list_for_each_entry_safe(pos, next, &dev->file_list, link) {
|
||||||
if (same_disconn_addr(cl_pos, disconnect_req)) {
|
if (same_disconn_addr(pos, disconnect_req)) {
|
||||||
dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
|
dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
|
||||||
disconnect_req->host_addr,
|
disconnect_req->host_addr,
|
||||||
disconnect_req->me_addr);
|
disconnect_req->me_addr);
|
||||||
cl_pos->state = MEI_FILE_DISCONNECTED;
|
pos->state = MEI_FILE_DISCONNECTED;
|
||||||
cl_pos->timer_count = 0;
|
pos->timer_count = 0;
|
||||||
if (cl_pos == &dev->wd_cl)
|
if (pos == &dev->wd_cl)
|
||||||
dev->wd_pending = false;
|
dev->wd_pending = false;
|
||||||
else if (cl_pos == &dev->iamthif_cl)
|
else if (pos == &dev->iamthif_cl)
|
||||||
dev->iamthif_timer = 0;
|
dev->iamthif_timer = 0;
|
||||||
|
|
||||||
/* prepare disconnect response */
|
/* prepare disconnect response */
|
||||||
mei_hdr =
|
(void)mei_hbm_hdr(&dev->ext_msg_buf[0], len);
|
||||||
(struct mei_msg_hdr *) &dev->ext_msg_buf[0];
|
|
||||||
mei_hdr->host_addr = 0;
|
|
||||||
mei_hdr->me_addr = 0;
|
|
||||||
mei_hdr->length =
|
|
||||||
sizeof(struct hbm_client_connect_response);
|
|
||||||
mei_hdr->msg_complete = 1;
|
|
||||||
mei_hdr->reserved = 0;
|
|
||||||
|
|
||||||
disconnect_res =
|
disconnect_res =
|
||||||
(struct hbm_client_connect_response *)
|
(struct hbm_client_connect_response *)
|
||||||
&dev->ext_msg_buf[1];
|
&dev->ext_msg_buf[1];
|
||||||
disconnect_res->host_addr = cl_pos->host_client_id;
|
|
||||||
disconnect_res->me_addr = cl_pos->me_client_id;
|
|
||||||
disconnect_res->hbm_cmd = CLIENT_DISCONNECT_RES_CMD;
|
disconnect_res->hbm_cmd = CLIENT_DISCONNECT_RES_CMD;
|
||||||
|
disconnect_res->host_addr = pos->host_client_id;
|
||||||
|
disconnect_res->me_addr = pos->me_client_id;
|
||||||
disconnect_res->status = 0;
|
disconnect_res->status = 0;
|
||||||
dev->extra_write_index = 2;
|
dev->extra_write_index = 2;
|
||||||
break;
|
break;
|
||||||
|
@ -469,7 +460,6 @@ static void mei_client_disconnect_request(struct mei_device *dev,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* mei_irq_thread_read_bus_message - bottom half read routine after ISR to
|
* mei_irq_thread_read_bus_message - bottom half read routine after ISR to
|
||||||
* handle the read bus message cmd processing.
|
* handle the read bus message cmd processing.
|
||||||
|
@ -488,7 +478,7 @@ static void mei_irq_thread_read_bus_message(struct mei_device *dev,
|
||||||
struct hbm_flow_control *flow_control;
|
struct hbm_flow_control *flow_control;
|
||||||
struct hbm_props_response *props_res;
|
struct hbm_props_response *props_res;
|
||||||
struct hbm_host_enum_response *enum_res;
|
struct hbm_host_enum_response *enum_res;
|
||||||
struct hbm_host_stop_request *host_stop_req;
|
struct hbm_host_stop_request *stop_req;
|
||||||
int res;
|
int res;
|
||||||
|
|
||||||
|
|
||||||
|
@ -514,26 +504,20 @@ static void mei_irq_thread_read_bus_message(struct mei_device *dev,
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
|
u32 *buf = dev->wr_msg_buf;
|
||||||
|
const size_t len = sizeof(struct hbm_host_stop_request);
|
||||||
|
|
||||||
dev->version = version_res->me_max_version;
|
dev->version = version_res->me_max_version;
|
||||||
|
|
||||||
/* send stop message */
|
/* send stop message */
|
||||||
mei_hdr = (struct mei_msg_hdr *)&dev->wr_msg_buf[0];
|
mei_hdr = mei_hbm_hdr(&buf[0], len);
|
||||||
mei_hdr->host_addr = 0;
|
stop_req = (struct hbm_host_stop_request *)&buf[1];
|
||||||
mei_hdr->me_addr = 0;
|
memset(stop_req, 0, len);
|
||||||
mei_hdr->length = sizeof(struct hbm_host_stop_request);
|
stop_req->hbm_cmd = HOST_STOP_REQ_CMD;
|
||||||
mei_hdr->msg_complete = 1;
|
stop_req->reason = DRIVER_STOP_REQUEST;
|
||||||
mei_hdr->reserved = 0;
|
|
||||||
|
|
||||||
host_stop_req = (struct hbm_host_stop_request *)
|
|
||||||
&dev->wr_msg_buf[1];
|
|
||||||
|
|
||||||
memset(host_stop_req,
|
|
||||||
0,
|
|
||||||
sizeof(struct hbm_host_stop_request));
|
|
||||||
host_stop_req->hbm_cmd = HOST_STOP_REQ_CMD;
|
|
||||||
host_stop_req->reason = DRIVER_STOP_REQUEST;
|
|
||||||
mei_write_message(dev, mei_hdr,
|
mei_write_message(dev, mei_hdr,
|
||||||
(unsigned char *) (host_stop_req),
|
(unsigned char *)stop_req, len);
|
||||||
mei_hdr->length);
|
|
||||||
dev_dbg(&dev->pdev->dev, "version mismatch.\n");
|
dev_dbg(&dev->pdev->dev, "version mismatch.\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
@ -543,16 +527,14 @@ static void mei_irq_thread_read_bus_message(struct mei_device *dev,
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case CLIENT_CONNECT_RES_CMD:
|
case CLIENT_CONNECT_RES_CMD:
|
||||||
connect_res =
|
connect_res = (struct hbm_client_connect_response *) mei_msg;
|
||||||
(struct hbm_client_connect_response *) mei_msg;
|
|
||||||
mei_client_connect_response(dev, connect_res);
|
mei_client_connect_response(dev, connect_res);
|
||||||
dev_dbg(&dev->pdev->dev, "client connect response message received.\n");
|
dev_dbg(&dev->pdev->dev, "client connect response message received.\n");
|
||||||
wake_up(&dev->wait_recvd_msg);
|
wake_up(&dev->wait_recvd_msg);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case CLIENT_DISCONNECT_RES_CMD:
|
case CLIENT_DISCONNECT_RES_CMD:
|
||||||
disconnect_res =
|
disconnect_res = (struct hbm_client_connect_response *) mei_msg;
|
||||||
(struct hbm_client_connect_response *) mei_msg;
|
|
||||||
mei_client_disconnect_response(dev, disconnect_res);
|
mei_client_disconnect_response(dev, disconnect_res);
|
||||||
dev_dbg(&dev->pdev->dev, "client disconnect response message received.\n");
|
dev_dbg(&dev->pdev->dev, "client disconnect response message received.\n");
|
||||||
wake_up(&dev->wait_recvd_msg);
|
wake_up(&dev->wait_recvd_msg);
|
||||||
|
@ -658,23 +640,21 @@ static void mei_irq_thread_read_bus_message(struct mei_device *dev,
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case ME_STOP_REQ_CMD:
|
case ME_STOP_REQ_CMD:
|
||||||
/* prepare stop request */
|
{
|
||||||
mei_hdr = (struct mei_msg_hdr *) &dev->ext_msg_buf[0];
|
/* prepare stop request: sent in next interrupt event */
|
||||||
mei_hdr->host_addr = 0;
|
|
||||||
mei_hdr->me_addr = 0;
|
u32 *buf = dev->ext_msg_buf;
|
||||||
mei_hdr->length = sizeof(struct hbm_host_stop_request);
|
const size_t len = sizeof(struct hbm_host_stop_request);
|
||||||
mei_hdr->msg_complete = 1;
|
|
||||||
mei_hdr->reserved = 0;
|
mei_hdr = mei_hbm_hdr(&buf[0], len);
|
||||||
host_stop_req =
|
stop_req = (struct hbm_host_stop_request *)&buf[1];
|
||||||
(struct hbm_host_stop_request *) &dev->ext_msg_buf[1];
|
memset(stop_req, 0, len);
|
||||||
memset(host_stop_req, 0, sizeof(struct hbm_host_stop_request));
|
stop_req->hbm_cmd = HOST_STOP_REQ_CMD;
|
||||||
host_stop_req->hbm_cmd = HOST_STOP_REQ_CMD;
|
stop_req->reason = DRIVER_STOP_REQUEST;
|
||||||
host_stop_req->reason = DRIVER_STOP_REQUEST;
|
|
||||||
host_stop_req->reserved[0] = 0;
|
|
||||||
host_stop_req->reserved[1] = 0;
|
|
||||||
dev->extra_write_index = 2;
|
dev->extra_write_index = 2;
|
||||||
break;
|
break;
|
||||||
|
}
|
||||||
default:
|
default:
|
||||||
BUG();
|
BUG();
|
||||||
break;
|
break;
|
||||||
|
|
|
@ -491,4 +491,15 @@ void mei_csr_clear_his(struct mei_device *dev);
|
||||||
void mei_enable_interrupts(struct mei_device *dev);
|
void mei_enable_interrupts(struct mei_device *dev);
|
||||||
void mei_disable_interrupts(struct mei_device *dev);
|
void mei_disable_interrupts(struct mei_device *dev);
|
||||||
|
|
||||||
|
static inline struct mei_msg_hdr *mei_hbm_hdr(u32 *buf, size_t length)
|
||||||
|
{
|
||||||
|
struct mei_msg_hdr *hdr = (struct mei_msg_hdr *)buf;
|
||||||
|
hdr->host_addr = 0;
|
||||||
|
hdr->me_addr = 0;
|
||||||
|
hdr->length = length;
|
||||||
|
hdr->msg_complete = 1;
|
||||||
|
hdr->reserved = 0;
|
||||||
|
return hdr;
|
||||||
|
}
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
Loading…
Reference in New Issue