hbm.c 21.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
/*
 *
 * 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/mei.h>

#include "mei_dev.h"
23
#include "hbm.h"
T
Tomas Winkler 已提交
24
#include "hw-me.h"
25

26 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
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;
	}
}

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

72 73 74 75
	dev->me_clients_num = 0;
	dev->me_client_presentation_num = 0;
	dev->me_client_index = 0;

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

80
	if (dev->me_clients_num == 0)
81
		return 0;
82 83 84 85

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

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

99 100
/**
 * mei_hbm_cl_hdr - construct client hbm header
101
 *
102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119
 * @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;
}

/**
120
 * mei_hbm_cl_addr_equal - tells if they have the same address
121
 *
122 123
 * @cl: - client
 * @buf: buffer with cl header
124
 *
125
 * returns true if addresses are the same
126 127 128 129 130 131 132 133 134 135
 */
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;
}


136 137 138 139 140 141 142 143 144 145 146 147
/**
 * is_treat_specially_client - checks if the message belongs
 * to the file private data.
 *
 * @cl: private data of the file object
 * @rs: connect response bus message
 *
 */
static bool is_treat_specially_client(struct mei_cl *cl,
		struct hbm_client_connect_response *rs)
{
	if (mei_hbm_cl_addr_equal(cl, rs)) {
148
		if (rs->status == MEI_CL_CONN_SUCCESS)
149
			cl->state = MEI_FILE_CONNECTED;
150
		else
151
			cl->state = MEI_FILE_DISCONNECTED;
152
		cl->status = mei_cl_conn_status_to_errno(rs->status);
153 154 155 156 157 158 159
		cl->timer_count = 0;

		return true;
	}
	return false;
}

160 161 162 163 164 165 166 167 168 169 170
/**
 * 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 已提交
171 172 173 174 175 176 177 178 179
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 ||
180
			dev->hbm_state >= MEI_HBM_STARTED,
181
			mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
T
Tomas Winkler 已提交
182 183 184 185
	mutex_lock(&dev->device_lock);

	if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
		dev->hbm_state = MEI_HBM_IDLE;
M
Masanari Iida 已提交
186
		dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
T
Tomas Winkler 已提交
187 188 189 190 191
		return -ETIMEDOUT;
	}
	return 0;
}

192
/**
193
 * mei_hbm_start_req - sends start request message.
194 195
 *
 * @dev: the device structure
196 197
 *
 * returns 0 on success and < 0 on failure
198
 */
T
Tomas Winkler 已提交
199
int mei_hbm_start_req(struct mei_device *dev)
200
{
201
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
202 203
	struct hbm_host_version_request *start_req;
	const size_t len = sizeof(struct hbm_host_version_request);
204
	int ret;
205

206
	mei_hbm_hdr(mei_hdr, len);
207 208

	/* host start message */
209
	start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
210 211 212 213 214
	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 已提交
215
	dev->hbm_state = MEI_HBM_IDLE;
216 217 218 219 220
	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;
221
	}
222

T
Tomas Winkler 已提交
223
	dev->hbm_state = MEI_HBM_START;
224
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
T
Tomas Winkler 已提交
225
	return 0;
226 227
}

T
Tomas Winkler 已提交
228
/*
229
 * mei_hbm_enum_clients_req - sends enumeration client request message.
230 231 232
 *
 * @dev: the device structure
 *
233
 * returns 0 on success and < 0 on failure
234
 */
235
static int mei_hbm_enum_clients_req(struct mei_device *dev)
236
{
237
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
238 239
	struct hbm_host_enum_request *enum_req;
	const size_t len = sizeof(struct hbm_host_enum_request);
240 241
	int ret;

242
	/* enumerate clients */
243
	mei_hbm_hdr(mei_hdr, len);
244

245 246
	enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
	memset(enum_req, 0, len);
247 248
	enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;

249 250 251 252 253
	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;
254
	}
T
Tomas Winkler 已提交
255
	dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
256
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
257
	return 0;
258 259
}

260
/**
261
 * mei_hbm_prop_req - request property for a single client
262 263 264
 *
 * @dev: the device structure
 *
265
 * returns 0 on success and < 0 on failure
266
 */
267

268
static int mei_hbm_prop_req(struct mei_device *dev)
269 270
{

271
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
272 273 274
	struct hbm_props_request *prop_req;
	const size_t len = sizeof(struct hbm_props_request);
	unsigned long next_client_index;
275
	unsigned long client_num;
276
	int ret;
277 278 279 280 281 282 283 284

	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 已提交
285
		dev->hbm_state = MEI_HBM_STARTED;
286 287 288 289 290 291 292 293
		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;

294 295
	mei_hbm_hdr(mei_hdr, len);
	prop_req = (struct hbm_props_request *)dev->wr_msg.data;
296 297 298 299 300 301 302

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


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

303 304 305 306 307
	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;
308 309 310 311 312 313 314 315
	}

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

	return 0;
}

316
/**
T
Tomas Winkler 已提交
317
 * mei_hbm_stop_req - send stop request message
318 319
 *
 * @dev - mei device
T
Tomas Winkler 已提交
320 321 322
 * @cl: client info
 *
 * This function returns -EIO on write failure
323
 */
T
Tomas Winkler 已提交
324
static int mei_hbm_stop_req(struct mei_device *dev)
325
{
T
Tomas Winkler 已提交
326
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
327
	struct hbm_host_stop_request *req =
T
Tomas Winkler 已提交
328
			(struct hbm_host_stop_request *)dev->wr_msg.data;
329 330 331 332 333 334 335
	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 已提交
336 337

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

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

353 354
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
355 356 357 358

	dev_dbg(&dev->pdev->dev, "sending flow control host client = %d, ME client = %d\n",
		cl->host_client_id, cl->me_client_id);

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

362
/**
363
 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
364
 *
365
 * @dev: the device structure
366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421
 * @flow: flow control.
 */
static void mei_hbm_add_single_flow_creds(struct mei_device *dev,
				  struct hbm_flow_control *flow)
{
	struct mei_me_client *client;
	int i;

	for (i = 0; i < dev->me_clients_num; i++) {
		client = &dev->me_clients[i];
		if (client && flow->me_addr == client->client_id) {
			if (client->props.single_recv_buf) {
				client->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",
				    client->mei_flow_ctrl_creds);
			} else {
				BUG();	/* error in flow control */
			}
		}
	}
}

/**
 * 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)
{
	struct mei_cl *cl = NULL;
	struct mei_cl *next = NULL;

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

	/* normal connection */
	list_for_each_entry_safe(cl, next, &dev->file_list, link) {
		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;
		}
	}
}


422
/**
423
 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
424 425
 *
 * @dev: the device structure
426
 * @cl: a client to disconnect from
427 428 429
 *
 * This function returns -EIO on write failure
 */
430
int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
431
{
432
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
433 434
	const size_t len = sizeof(struct hbm_client_connect_request);

435 436
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
437

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

T
Tomas Winkler 已提交
441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459
/**
 * 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);
}

460 461 462 463 464 465 466 467 468 469 470 471
/**
 * 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;
	struct mei_cl_cb *pos = NULL, *next = NULL;

472 473
	dev_dbg(&dev->pdev->dev, "hbm: disconnect response cl:host=%02d me=%02d status=%d\n",
			rs->me_addr, rs->host_addr, rs->status);
474 475 476 477 478 479 480 481 482 483 484 485

	list_for_each_entry_safe(pos, next, &dev->ctrl_rd_list.list, list) {
		cl = pos->cl;

		if (!cl) {
			list_del(&pos->list);
			return;
		}

		dev_dbg(&dev->pdev->dev, "list_for_each_entry_safe in ctrl_rd_list.\n");
		if (mei_hbm_cl_addr_equal(cl, rs)) {
			list_del(&pos->list);
486
			if (rs->status == MEI_CL_DISCONN_SUCCESS)
487 488 489 490 491 492 493 494 495
				cl->state = MEI_FILE_DISCONNECTED;

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

496
/**
497
 * mei_hbm_cl_connect_req - send connection request to specific me client
498 499
 *
 * @dev: the device structure
500
 * @cl: a client to connect to
501
 *
502
 * returns -EIO on write failure
503
 */
504
int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
505
{
506
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
507 508
	const size_t len = sizeof(struct hbm_client_connect_request);

509 510
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
511

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

515
/**
516
 * mei_hbm_cl_connect_res - connect response from the ME
517 518 519 520 521 522 523 524 525 526 527
 *
 * @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;
	struct mei_cl_cb *pos = NULL, *next = NULL;

528 529 530
	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));
531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551

	/* if WD or iamthif client treat specially */

	if (is_treat_specially_client(&dev->wd_cl, rs)) {
		dev_dbg(&dev->pdev->dev, "successfully connected to WD client.\n");
		mei_watchdog_register(dev);

		return;
	}

	if (is_treat_specially_client(&dev->iamthif_cl, rs)) {
		dev->iamthif_state = MEI_IAMTHIF_IDLE;
		return;
	}
	list_for_each_entry_safe(pos, next, &dev->ctrl_rd_list.list, list) {

		cl = pos->cl;
		if (!cl) {
			list_del(&pos->list);
			return;
		}
552
		if (pos->fop_type == MEI_FOP_CONNECT) {
553 554 555 556 557 558 559 560 561 562
			if (is_treat_specially_client(cl, rs)) {
				list_del(&pos->list);
				cl->timer_count = 0;
				break;
			}
		}
	}
}


563
/**
564 565
 * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
 *  host sends disconnect response
566 567
 *
 * @dev: the device structure.
568
 * @disconnect_req: disconnect request bus message from the me
T
Tomas Winkler 已提交
569 570
 *
 * returns -ENOMEM on allocation failure
571
 */
T
Tomas Winkler 已提交
572
static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
573 574
		struct hbm_client_connect_request *disconnect_req)
{
575
	struct mei_cl *cl, *next;
T
Tomas Winkler 已提交
576
	struct mei_cl_cb *cb;
577

578 579
	list_for_each_entry_safe(cl, next, &dev->file_list, link) {
		if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
580 581 582
			dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
					disconnect_req->host_addr,
					disconnect_req->me_addr);
583 584 585
			cl->state = MEI_FILE_DISCONNECTED;
			cl->timer_count = 0;
			if (cl == &dev->wd_cl)
586
				dev->wd_pending = false;
587
			else if (cl == &dev->iamthif_cl)
588 589
				dev->iamthif_timer = 0;

T
Tomas Winkler 已提交
590 591 592 593 594 595 596
			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);

597 598 599
			break;
		}
	}
T
Tomas Winkler 已提交
600
	return 0;
601 602 603
}


T
Tomas Winkler 已提交
604 605 606 607 608 609 610 611 612 613 614 615 616 617
/**
 * 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);
}

618 619 620 621 622 623
/**
 * 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
624 625
 *
 * returns 0 on success and < 0 on failure
626
 */
627
int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643
{
	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;

644 645 646 647 648 649 650 651
	/* 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;
	}

652 653
	switch (mei_msg->hbm_cmd) {
	case HOST_START_RES_CMD:
654 655 656 657
		dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");

		dev->init_clients_timer = 0;

658
		version_res = (struct hbm_host_version_response *)mei_msg;
T
Tomas Winkler 已提交
659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675

		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)) {
676
			dev_warn(&dev->pdev->dev, "hbm: start: version mismatch - stopping the driver.\n");
677

678
			dev->hbm_state = MEI_HBM_STOPPED;
T
Tomas Winkler 已提交
679
			if (mei_hbm_stop_req(dev)) {
680 681 682 683 684
				dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
				return -EIO;
			}
			break;
		}
T
Tomas Winkler 已提交
685

686 687 688 689 690
		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;
691
		}
692

693 694 695 696 697
		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;
698 699
		}

T
Tomas Winkler 已提交
700
		wake_up_interruptible(&dev->wait_recvd_msg);
701 702 703
		break;

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

706
		connect_res = (struct hbm_client_connect_response *) mei_msg;
707
		mei_hbm_cl_connect_res(dev, connect_res);
708 709 710 711
		wake_up(&dev->wait_recvd_msg);
		break;

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

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

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

722
		flow_control = (struct hbm_flow_control *) mei_msg;
723
		mei_hbm_cl_flow_control_res(dev, flow_control);
724 725 726
		break;

	case HOST_CLIENT_PROPERTIES_RES_CMD:
727 728 729 730 731 732 733 734 735
		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;
		}

736 737 738
		props_res = (struct hbm_props_response *)mei_msg;
		me_client = &dev->me_clients[dev->me_client_presentation_num];

739 740 741 742
		if (props_res->status) {
			dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
				props_res->status);
			return -EPROTO;
743 744 745
		}

		if (me_client->client_id != props_res->address) {
746 747 748
			dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
				me_client->client_id, props_res->address);
			return -EPROTO;
749 750 751
		}

		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
T
Tomas Winkler 已提交
752
		    dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
753 754 755
			dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
				dev->dev_state, dev->hbm_state);
			return -EPROTO;
756 757 758 759 760 761
		}

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

762
		/* request property for the next client */
763 764
		if (mei_hbm_prop_req(dev))
			return -EIO;
765 766 767 768

		break;

	case HOST_ENUM_RES_CMD:
769 770 771 772
		dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");

		dev->init_clients_timer = 0;

773
		enum_res = (struct hbm_host_enum_response *) mei_msg;
774 775 776 777
		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));
778 779 780 781 782 783

		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;
784
		}
785 786 787 788 789 790 791 792 793 794 795 796

		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;

797 798 799
		break;

	case HOST_STOP_RES_CMD:
800 801 802 803 804 805 806 807 808
		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 已提交
809

810
		dev->dev_state = MEI_DEV_POWER_DOWN;
811 812 813
		dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
		/* force the reset */
		return -EPROTO;
814 815 816
		break;

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

819
		disconnect_req = (struct hbm_client_connect_request *)mei_msg;
820
		mei_hbm_fw_disconnect_req(dev, disconnect_req);
821 822 823
		break;

	case ME_STOP_REQ_CMD:
824 825
		dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
		dev->hbm_state = MEI_HBM_STOPPED;
T
Tomas Winkler 已提交
826 827 828 829
		if (mei_hbm_stop_req(dev)) {
			dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
			return -EIO;
		}
830 831 832 833 834 835
		break;
	default:
		BUG();
		break;

	}
836
	return 0;
837 838
}