hbm.c 22.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 *
 * 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.
 *
 */

17
#include <linux/export.h>
18 19 20 21
#include <linux/pci.h>
#include <linux/sched.h>
#include <linux/wait.h>
#include <linux/mei.h>
22
#include <linux/pm_runtime.h>
23 24

#include "mei_dev.h"
25
#include "hbm.h"
26
#include "client.h"
27

28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61
static const char *mei_cl_conn_status_str(enum mei_cl_connect_status status)
{
#define MEI_CL_CS(status) case MEI_CL_CONN_##status: return #status
	switch (status) {
	MEI_CL_CS(SUCCESS);
	MEI_CL_CS(NOT_FOUND);
	MEI_CL_CS(ALREADY_STARTED);
	MEI_CL_CS(OUT_OF_RESOURCES);
	MEI_CL_CS(MESSAGE_SMALL);
	default: return "unknown";
	}
#undef MEI_CL_CCS
}

/**
 * mei_cl_conn_status_to_errno - convert client connect response
 * status to error code
 *
 * @status: client connect response status
 *
 * returns corresponding error code
 */
static int mei_cl_conn_status_to_errno(enum mei_cl_connect_status status)
{
	switch (status) {
	case MEI_CL_CONN_SUCCESS:          return 0;
	case MEI_CL_CONN_NOT_FOUND:        return -ENOTTY;
	case MEI_CL_CONN_ALREADY_STARTED:  return -EBUSY;
	case MEI_CL_CONN_OUT_OF_RESOURCES: return -EBUSY;
	case MEI_CL_CONN_MESSAGE_SMALL:    return -EINVAL;
	default:                           return -EINVAL;
	}
}

62 63 64 65 66
/**
 * mei_hbm_me_cl_allocate - allocates storage for me clients
 *
 * @dev: the device structure
 *
67
 * returns 0 on success -ENOMEM on allocation failure
68
 */
69
static int mei_hbm_me_cl_allocate(struct mei_device *dev)
70 71 72 73
{
	struct mei_me_client *clients;
	int b;

74 75 76 77
	dev->me_clients_num = 0;
	dev->me_client_presentation_num = 0;
	dev->me_client_index = 0;

78 79 80 81
	/* count how many ME clients we have */
	for_each_set_bit(b, dev->me_clients_map, MEI_CLIENTS_MAX)
		dev->me_clients_num++;

82
	if (dev->me_clients_num == 0)
83
		return 0;
84 85 86 87

	kfree(dev->me_clients);
	dev->me_clients = NULL;

88
	dev_dbg(&dev->pdev->dev, "memory allocation for ME clients size=%ld.\n",
89 90 91 92 93 94
		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_err(&dev->pdev->dev, "memory allocation for ME clients failed.\n");
95
		return -ENOMEM;
96 97
	}
	dev->me_clients = clients;
98
	return 0;
99 100
}

101 102
/**
 * mei_hbm_cl_hdr - construct client hbm header
103
 *
104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121
 * @cl: - client
 * @hbm_cmd: host bus message command
 * @buf: buffer for cl header
 * @len: buffer length
 */
static inline
void mei_hbm_cl_hdr(struct mei_cl *cl, u8 hbm_cmd, void *buf, size_t len)
{
	struct mei_hbm_cl_cmd *cmd = buf;

	memset(cmd, 0, len);

	cmd->hbm_cmd = hbm_cmd;
	cmd->host_addr = cl->host_client_id;
	cmd->me_addr = cl->me_client_id;
}

/**
122
 * mei_hbm_cl_addr_equal - tells if they have the same address
123
 *
124 125
 * @cl: - client
 * @buf: buffer with cl header
126
 *
127
 * returns true if addresses are the same
128 129 130 131 132 133 134 135 136 137
 */
static inline
bool mei_hbm_cl_addr_equal(struct mei_cl *cl, void *buf)
{
	struct mei_hbm_cl_cmd *cmd = buf;
	return cl->host_client_id == cmd->host_addr &&
		cl->me_client_id == cmd->me_addr;
}


138 139 140 141 142 143 144 145 146 147 148
/**
 * mei_hbm_idle - set hbm to idle state
 *
 * @dev: the device structure
 */
void mei_hbm_idle(struct mei_device *dev)
{
	dev->init_clients_timer = 0;
	dev->hbm_state = MEI_HBM_IDLE;
}

T
Tomas Winkler 已提交
149 150 151 152 153 154 155 156 157
int mei_hbm_start_wait(struct mei_device *dev)
{
	int ret;
	if (dev->hbm_state > MEI_HBM_START)
		return 0;

	mutex_unlock(&dev->device_lock);
	ret = wait_event_interruptible_timeout(dev->wait_recvd_msg,
			dev->hbm_state == MEI_HBM_IDLE ||
158
			dev->hbm_state >= MEI_HBM_STARTED,
159
			mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
T
Tomas Winkler 已提交
160 161 162 163
	mutex_lock(&dev->device_lock);

	if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
		dev->hbm_state = MEI_HBM_IDLE;
M
Masanari Iida 已提交
164
		dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
165
		return -ETIME;
T
Tomas Winkler 已提交
166 167 168 169
	}
	return 0;
}

170
/**
171
 * mei_hbm_start_req - sends start request message.
172 173
 *
 * @dev: the device structure
174 175
 *
 * returns 0 on success and < 0 on failure
176
 */
T
Tomas Winkler 已提交
177
int mei_hbm_start_req(struct mei_device *dev)
178
{
179
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
180 181
	struct hbm_host_version_request *start_req;
	const size_t len = sizeof(struct hbm_host_version_request);
182
	int ret;
183

184
	mei_hbm_hdr(mei_hdr, len);
185 186

	/* host start message */
187
	start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
188 189 190 191 192
	memset(start_req, 0, len);
	start_req->hbm_cmd = HOST_START_REQ_CMD;
	start_req->host_version.major_version = HBM_MAJOR_VERSION;
	start_req->host_version.minor_version = HBM_MINOR_VERSION;

T
Tomas Winkler 已提交
193
	dev->hbm_state = MEI_HBM_IDLE;
194 195 196 197 198
	ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
	if (ret) {
		dev_err(&dev->pdev->dev, "version message write failed: ret = %d\n",
			ret);
		return ret;
199
	}
200

T
Tomas Winkler 已提交
201
	dev->hbm_state = MEI_HBM_START;
202
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
T
Tomas Winkler 已提交
203
	return 0;
204 205
}

T
Tomas Winkler 已提交
206
/*
207
 * mei_hbm_enum_clients_req - sends enumeration client request message.
208 209 210
 *
 * @dev: the device structure
 *
211
 * returns 0 on success and < 0 on failure
212
 */
213
static int mei_hbm_enum_clients_req(struct mei_device *dev)
214
{
215
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
216 217
	struct hbm_host_enum_request *enum_req;
	const size_t len = sizeof(struct hbm_host_enum_request);
218 219
	int ret;

220
	/* enumerate clients */
221
	mei_hbm_hdr(mei_hdr, len);
222

223 224
	enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
	memset(enum_req, 0, len);
225 226
	enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;

227 228 229 230 231
	ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
	if (ret) {
		dev_err(&dev->pdev->dev, "enumeration request write failed: ret = %d.\n",
			ret);
		return ret;
232
	}
T
Tomas Winkler 已提交
233
	dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
234
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
235
	return 0;
236 237
}

238
/**
239
 * mei_hbm_prop_req - request property for a single client
240 241 242
 *
 * @dev: the device structure
 *
243
 * returns 0 on success and < 0 on failure
244
 */
245

246
static int mei_hbm_prop_req(struct mei_device *dev)
247 248
{

249
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
250 251 252
	struct hbm_props_request *prop_req;
	const size_t len = sizeof(struct hbm_props_request);
	unsigned long next_client_index;
253
	unsigned long client_num;
254
	int ret;
255 256 257 258 259 260 261 262

	client_num = dev->me_client_presentation_num;

	next_client_index = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX,
					  dev->me_client_index);

	/* We got all client properties */
	if (next_client_index == MEI_CLIENTS_MAX) {
T
Tomas Winkler 已提交
263
		dev->hbm_state = MEI_HBM_STARTED;
264 265 266 267 268 269 270 271
		schedule_work(&dev->init_work);

		return 0;
	}

	dev->me_clients[client_num].client_id = next_client_index;
	dev->me_clients[client_num].mei_flow_ctrl_creds = 0;

272 273
	mei_hbm_hdr(mei_hdr, len);
	prop_req = (struct hbm_props_request *)dev->wr_msg.data;
274 275 276 277 278 279 280

	memset(prop_req, 0, sizeof(struct hbm_props_request));


	prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
	prop_req->address = next_client_index;

281 282 283 284 285
	ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
	if (ret) {
		dev_err(&dev->pdev->dev, "properties request write failed: ret = %d\n",
			ret);
		return ret;
286 287 288 289 290 291 292 293
	}

	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
	dev->me_client_index = next_client_index;

	return 0;
}

294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321
/*
 * mei_hbm_pg - sends pg command
 *
 * @dev: the device structure
 * @pg_cmd: the pg command code
 *
 * This function returns -EIO on write failure
 */
int mei_hbm_pg(struct mei_device *dev, u8 pg_cmd)
{
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
	struct hbm_power_gate *req;
	const size_t len = sizeof(struct hbm_power_gate);
	int ret;

	mei_hbm_hdr(mei_hdr, len);

	req = (struct hbm_power_gate *)dev->wr_msg.data;
	memset(req, 0, len);
	req->hbm_cmd = pg_cmd;

	ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
	if (ret)
		dev_err(&dev->pdev->dev, "power gate command write failed.\n");
	return ret;
}
EXPORT_SYMBOL_GPL(mei_hbm_pg);

322
/**
T
Tomas Winkler 已提交
323
 * mei_hbm_stop_req - send stop request message
324 325
 *
 * @dev - mei device
T
Tomas Winkler 已提交
326 327 328
 * @cl: client info
 *
 * This function returns -EIO on write failure
329
 */
T
Tomas Winkler 已提交
330
static int mei_hbm_stop_req(struct mei_device *dev)
331
{
T
Tomas Winkler 已提交
332
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
333
	struct hbm_host_stop_request *req =
T
Tomas Winkler 已提交
334
			(struct hbm_host_stop_request *)dev->wr_msg.data;
335 336 337 338 339 340 341
	const size_t len = sizeof(struct hbm_host_stop_request);

	mei_hbm_hdr(mei_hdr, len);

	memset(req, 0, len);
	req->hbm_cmd = HOST_STOP_REQ_CMD;
	req->reason = DRIVER_STOP_REQUEST;
T
Tomas Winkler 已提交
342 343

	return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
344 345
}

346
/**
347
 * mei_hbm_cl_flow_control_req - sends flow control request.
348 349
 *
 * @dev: the device structure
350
 * @cl: client info
351 352 353
 *
 * This function returns -EIO on write failure
 */
354
int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
355
{
356
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
357 358
	const size_t len = sizeof(struct hbm_flow_control);

359 360
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
361

362
	cl_dbg(dev, cl, "sending flow control\n");
363

364
	return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
365 366
}

367
/**
368
 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
369
 *
370
 * @dev: the device structure
371
 * @flow: flow control.
372 373
 *
 * return 0 on success, < 0 otherwise
374
 */
375
static int mei_hbm_add_single_flow_creds(struct mei_device *dev,
376 377
				  struct hbm_flow_control *flow)
{
378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396
	struct mei_me_client *me_cl;
	int id;

	id = mei_me_cl_by_id(dev, flow->me_addr);
	if (id < 0) {
		dev_err(&dev->pdev->dev, "no such me client %d\n",
			flow->me_addr);
		return id;
	}

	me_cl = &dev->me_clients[id];
	if (me_cl->props.single_recv_buf) {
		me_cl->mei_flow_ctrl_creds++;
		dev_dbg(&dev->pdev->dev, "recv flow ctrl msg ME %d (single).\n",
		    flow->me_addr);
		dev_dbg(&dev->pdev->dev, "flow control credentials =%d.\n",
		    me_cl->mei_flow_ctrl_creds);
	} else {
		BUG();	/* error in flow control */
397
	}
398 399

	return 0;
400 401 402 403 404 405 406 407 408 409 410
}

/**
 * mei_hbm_cl_flow_control_res - flow control response from me
 *
 * @dev: the device structure
 * @flow_control: flow control response bus message
 */
static void mei_hbm_cl_flow_control_res(struct mei_device *dev,
		struct hbm_flow_control *flow_control)
{
411
	struct mei_cl *cl;
412 413 414 415 416 417 418 419

	if (!flow_control->host_addr) {
		/* single receive buffer */
		mei_hbm_add_single_flow_creds(dev, flow_control);
		return;
	}

	/* normal connection */
420
	list_for_each_entry(cl, &dev->file_list, link) {
421 422 423 424 425 426 427 428 429 430 431 432
		if (mei_hbm_cl_addr_equal(cl, flow_control)) {
			cl->mei_flow_ctrl_creds++;
			dev_dbg(&dev->pdev->dev, "flow ctrl msg for host %d ME %d.\n",
				flow_control->host_addr, flow_control->me_addr);
			dev_dbg(&dev->pdev->dev, "flow control credentials = %d.\n",
				    cl->mei_flow_ctrl_creds);
				break;
		}
	}
}


433
/**
434
 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
435 436
 *
 * @dev: the device structure
437
 * @cl: a client to disconnect from
438 439 440
 *
 * This function returns -EIO on write failure
 */
441
int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
442
{
443
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
444 445
	const size_t len = sizeof(struct hbm_client_connect_request);

446 447
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
448

449
	return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
450 451
}

T
Tomas Winkler 已提交
452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470
/**
 * mei_hbm_cl_disconnect_rsp - sends disconnect respose to the FW
 *
 * @dev: the device structure
 * @cl: a client to disconnect from
 *
 * This function returns -EIO on write failure
 */
int mei_hbm_cl_disconnect_rsp(struct mei_device *dev, struct mei_cl *cl)
{
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
	const size_t len = sizeof(struct hbm_client_connect_response);

	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_RES_CMD, dev->wr_msg.data, len);

	return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
}

471 472 473 474 475 476 477 478 479 480
/**
 * mei_hbm_cl_disconnect_res - disconnect response from ME
 *
 * @dev: the device structure
 * @rs: disconnect response bus message
 */
static void mei_hbm_cl_disconnect_res(struct mei_device *dev,
		struct hbm_client_connect_response *rs)
{
	struct mei_cl *cl;
481
	struct mei_cl_cb *cb, *next;
482

483 484
	dev_dbg(&dev->pdev->dev, "hbm: disconnect response cl:host=%02d me=%02d status=%d\n",
			rs->me_addr, rs->host_addr, rs->status);
485

486 487
	list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
		cl = cb->cl;
488

489 490 491
		/* this should not happen */
		if (WARN_ON(!cl)) {
			list_del(&cb->list);
492 493 494 495
			return;
		}

		if (mei_hbm_cl_addr_equal(cl, rs)) {
496
			list_del(&cb->list);
497
			if (rs->status == MEI_CL_DISCONN_SUCCESS)
498 499 500 501 502 503 504 505 506
				cl->state = MEI_FILE_DISCONNECTED;

			cl->status = 0;
			cl->timer_count = 0;
			break;
		}
	}
}

507
/**
508
 * mei_hbm_cl_connect_req - send connection request to specific me client
509 510
 *
 * @dev: the device structure
511
 * @cl: a client to connect to
512
 *
513
 * returns -EIO on write failure
514
 */
515
int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
516
{
517
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
518 519
	const size_t len = sizeof(struct hbm_client_connect_request);

520 521
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
522

523
	return mei_write_message(dev, mei_hdr,  dev->wr_msg.data);
524 525
}

526
/**
527
 * mei_hbm_cl_connect_res - connect response from the ME
528 529 530 531 532 533 534 535 536
 *
 * @dev: the device structure
 * @rs: connect response bus message
 */
static void mei_hbm_cl_connect_res(struct mei_device *dev,
		struct hbm_client_connect_response *rs)
{

	struct mei_cl *cl;
537
	struct mei_cl_cb *cb, *next;
538

539 540 541
	dev_dbg(&dev->pdev->dev, "hbm: connect response cl:host=%02d me=%02d status=%s\n",
			rs->me_addr, rs->host_addr,
			mei_cl_conn_status_str(rs->status));
542

543
	cl = NULL;
544

545
	list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
546

547 548 549 550 551 552
		cl = cb->cl;
		/* this should not happen */
		if (WARN_ON(!cl)) {
			list_del_init(&cb->list);
			continue;
		}
553

554 555
		if (cb->fop_type !=  MEI_FOP_CONNECT)
			continue;
556

557 558 559
		if (mei_hbm_cl_addr_equal(cl, rs)) {
			list_del(&cb->list);
			break;
560 561
		}
	}
562 563 564 565 566 567 568 569 570 571

	if (!cl)
		return;

	cl->timer_count = 0;
	if (rs->status == MEI_CL_CONN_SUCCESS)
		cl->state = MEI_FILE_CONNECTED;
	else
		cl->state = MEI_FILE_DISCONNECTED;
	cl->status = mei_cl_conn_status_to_errno(rs->status);
572 573 574
}


575
/**
576 577
 * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
 *  host sends disconnect response
578 579
 *
 * @dev: the device structure.
580
 * @disconnect_req: disconnect request bus message from the me
T
Tomas Winkler 已提交
581 582
 *
 * returns -ENOMEM on allocation failure
583
 */
T
Tomas Winkler 已提交
584
static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
585 586
		struct hbm_client_connect_request *disconnect_req)
{
587
	struct mei_cl *cl;
T
Tomas Winkler 已提交
588
	struct mei_cl_cb *cb;
589

590
	list_for_each_entry(cl, &dev->file_list, link) {
591
		if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
592 593 594
			dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
					disconnect_req->host_addr,
					disconnect_req->me_addr);
595 596
			cl->state = MEI_FILE_DISCONNECTED;
			cl->timer_count = 0;
597

T
Tomas Winkler 已提交
598 599 600 601 602 603 604
			cb = mei_io_cb_init(cl, NULL);
			if (!cb)
				return -ENOMEM;
			cb->fop_type = MEI_FOP_DISCONNECT_RSP;
			cl_dbg(dev, cl, "add disconnect response as first\n");
			list_add(&cb->list, &dev->ctrl_wr_list.list);

605 606 607
			break;
		}
	}
T
Tomas Winkler 已提交
608
	return 0;
609 610 611
}


T
Tomas Winkler 已提交
612 613 614 615 616 617 618 619 620 621 622 623 624 625
/**
 * mei_hbm_version_is_supported - checks whether the driver can
 *     support the hbm version of the device
 *
 * @dev: the device structure
 * returns true if driver can support hbm version of the device
 */
bool mei_hbm_version_is_supported(struct mei_device *dev)
{
	return	(dev->version.major_version < HBM_MAJOR_VERSION) ||
		(dev->version.major_version == HBM_MAJOR_VERSION &&
		 dev->version.minor_version <= HBM_MINOR_VERSION);
}

626 627 628 629 630 631
/**
 * mei_hbm_dispatch - bottom half read routine after ISR to
 * handle the read bus message cmd processing.
 *
 * @dev: the device structure
 * @mei_hdr: header of bus message
632 633
 *
 * returns 0 on success and < 0 on failure
634
 */
635
int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651
{
	struct mei_bus_message *mei_msg;
	struct mei_me_client *me_client;
	struct hbm_host_version_response *version_res;
	struct hbm_client_connect_response *connect_res;
	struct hbm_client_connect_response *disconnect_res;
	struct hbm_client_connect_request *disconnect_req;
	struct hbm_flow_control *flow_control;
	struct hbm_props_response *props_res;
	struct hbm_host_enum_response *enum_res;

	/* read the message to our buffer */
	BUG_ON(hdr->length >= sizeof(dev->rd_msg_buf));
	mei_read_slots(dev, dev->rd_msg_buf, hdr->length);
	mei_msg = (struct mei_bus_message *)dev->rd_msg_buf;

652 653 654 655 656 657 658 659
	/* ignore spurious message and prevent reset nesting
	 * hbm is put to idle during system reset
	 */
	if (dev->hbm_state == MEI_HBM_IDLE) {
		dev_dbg(&dev->pdev->dev, "hbm: state is idle ignore spurious messages\n");
		return 0;
	}

660 661
	switch (mei_msg->hbm_cmd) {
	case HOST_START_RES_CMD:
662 663 664 665
		dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");

		dev->init_clients_timer = 0;

666
		version_res = (struct hbm_host_version_response *)mei_msg;
T
Tomas Winkler 已提交
667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683

		dev_dbg(&dev->pdev->dev, "HBM VERSION: DRIVER=%02d:%02d DEVICE=%02d:%02d\n",
				HBM_MAJOR_VERSION, HBM_MINOR_VERSION,
				version_res->me_max_version.major_version,
				version_res->me_max_version.minor_version);

		if (version_res->host_version_supported) {
			dev->version.major_version = HBM_MAJOR_VERSION;
			dev->version.minor_version = HBM_MINOR_VERSION;
		} else {
			dev->version.major_version =
				version_res->me_max_version.major_version;
			dev->version.minor_version =
				version_res->me_max_version.minor_version;
		}

		if (!mei_hbm_version_is_supported(dev)) {
684
			dev_warn(&dev->pdev->dev, "hbm: start: version mismatch - stopping the driver.\n");
685

686
			dev->hbm_state = MEI_HBM_STOPPED;
T
Tomas Winkler 已提交
687
			if (mei_hbm_stop_req(dev)) {
688 689 690 691 692
				dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
				return -EIO;
			}
			break;
		}
T
Tomas Winkler 已提交
693

694 695 696 697 698
		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
		    dev->hbm_state != MEI_HBM_START) {
			dev_err(&dev->pdev->dev, "hbm: start: state mismatch, [%d, %d]\n",
				dev->dev_state, dev->hbm_state);
			return -EPROTO;
699
		}
700

701 702 703 704 705
		dev->hbm_state = MEI_HBM_STARTED;

		if (mei_hbm_enum_clients_req(dev)) {
			dev_err(&dev->pdev->dev, "hbm: start: failed to send enumeration request\n");
			return -EIO;
706 707
		}

T
Tomas Winkler 已提交
708
		wake_up_interruptible(&dev->wait_recvd_msg);
709 710 711
		break;

	case CLIENT_CONNECT_RES_CMD:
712 713
		dev_dbg(&dev->pdev->dev, "hbm: client connect response: message received.\n");

714
		connect_res = (struct hbm_client_connect_response *) mei_msg;
715
		mei_hbm_cl_connect_res(dev, connect_res);
716 717 718 719
		wake_up(&dev->wait_recvd_msg);
		break;

	case CLIENT_DISCONNECT_RES_CMD:
720 721
		dev_dbg(&dev->pdev->dev, "hbm: client disconnect response: message received.\n");

722
		disconnect_res = (struct hbm_client_connect_response *) mei_msg;
723
		mei_hbm_cl_disconnect_res(dev, disconnect_res);
724 725 726 727
		wake_up(&dev->wait_recvd_msg);
		break;

	case MEI_FLOW_CONTROL_CMD:
728 729
		dev_dbg(&dev->pdev->dev, "hbm: client flow control response: message received.\n");

730
		flow_control = (struct hbm_flow_control *) mei_msg;
731
		mei_hbm_cl_flow_control_res(dev, flow_control);
732 733
		break;

734 735
	case MEI_PG_ISOLATION_ENTRY_RES_CMD:
		dev_dbg(&dev->pdev->dev, "power gate isolation entry response received\n");
736
		dev->pg_event = MEI_PG_EVENT_RECEIVED;
737 738 739 740 741 742
		if (waitqueue_active(&dev->wait_pg))
			wake_up(&dev->wait_pg);
		break;

	case MEI_PG_ISOLATION_EXIT_REQ_CMD:
		dev_dbg(&dev->pdev->dev, "power gate isolation exit request received\n");
743
		dev->pg_event = MEI_PG_EVENT_RECEIVED;
744 745
		if (waitqueue_active(&dev->wait_pg))
			wake_up(&dev->wait_pg);
746 747 748 749 750 751 752
		else
			/*
			* If the driver is not waiting on this then
			* this is HW initiated exit from PG.
			* Start runtime pm resume sequence to exit from PG.
			*/
			pm_request_resume(&dev->pdev->dev);
753 754
		break;

755
	case HOST_CLIENT_PROPERTIES_RES_CMD:
756 757 758 759 760 761 762 763 764
		dev_dbg(&dev->pdev->dev, "hbm: properties response: message received.\n");

		dev->init_clients_timer = 0;

		if (dev->me_clients == NULL) {
			dev_err(&dev->pdev->dev, "hbm: properties response: mei_clients not allocated\n");
			return -EPROTO;
		}

765 766 767
		props_res = (struct hbm_props_response *)mei_msg;
		me_client = &dev->me_clients[dev->me_client_presentation_num];

768 769 770 771
		if (props_res->status) {
			dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
				props_res->status);
			return -EPROTO;
772 773 774
		}

		if (me_client->client_id != props_res->address) {
775 776 777
			dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
				me_client->client_id, props_res->address);
			return -EPROTO;
778 779 780
		}

		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
T
Tomas Winkler 已提交
781
		    dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
782 783 784
			dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
				dev->dev_state, dev->hbm_state);
			return -EPROTO;
785 786 787 788 789 790
		}

		me_client->props = props_res->client_properties;
		dev->me_client_index++;
		dev->me_client_presentation_num++;

791
		/* request property for the next client */
792 793
		if (mei_hbm_prop_req(dev))
			return -EIO;
794 795 796 797

		break;

	case HOST_ENUM_RES_CMD:
798 799 800 801
		dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");

		dev->init_clients_timer = 0;

802
		enum_res = (struct hbm_host_enum_response *) mei_msg;
803 804 805 806
		BUILD_BUG_ON(sizeof(dev->me_clients_map)
				< sizeof(enum_res->valid_addresses));
		memcpy(dev->me_clients_map, enum_res->valid_addresses,
			sizeof(enum_res->valid_addresses));
807 808 809 810 811 812

		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
		    dev->hbm_state != MEI_HBM_ENUM_CLIENTS) {
			dev_err(&dev->pdev->dev, "hbm: enumeration response: state mismatch, [%d, %d]\n",
				dev->dev_state, dev->hbm_state);
			return -EPROTO;
813
		}
814 815 816 817 818 819 820 821 822 823 824 825

		if (mei_hbm_me_cl_allocate(dev)) {
			dev_err(&dev->pdev->dev, "hbm: enumeration response: cannot allocate clients array\n");
			return -ENOMEM;
		}

		dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;

		/* first property request */
		if (mei_hbm_prop_req(dev))
			return -EIO;

826 827 828
		break;

	case HOST_STOP_RES_CMD:
829 830 831 832 833 834 835 836 837
		dev_dbg(&dev->pdev->dev, "hbm: stop response: message received\n");

		dev->init_clients_timer = 0;

		if (dev->hbm_state != MEI_HBM_STOPPED) {
			dev_err(&dev->pdev->dev, "hbm: stop response: state mismatch, [%d, %d]\n",
				dev->dev_state, dev->hbm_state);
			return -EPROTO;
		}
T
Tomas Winkler 已提交
838

839
		dev->dev_state = MEI_DEV_POWER_DOWN;
840 841 842
		dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
		/* force the reset */
		return -EPROTO;
843 844 845
		break;

	case CLIENT_DISCONNECT_REQ_CMD:
846 847
		dev_dbg(&dev->pdev->dev, "hbm: disconnect request: message received\n");

848
		disconnect_req = (struct hbm_client_connect_request *)mei_msg;
849
		mei_hbm_fw_disconnect_req(dev, disconnect_req);
850 851 852
		break;

	case ME_STOP_REQ_CMD:
853 854
		dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
		dev->hbm_state = MEI_HBM_STOPPED;
T
Tomas Winkler 已提交
855 856 857 858
		if (mei_hbm_stop_req(dev)) {
			dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
			return -EIO;
		}
859 860 861 862 863 864
		break;
	default:
		BUG();
		break;

	}
865
	return 0;
866 867
}