hbm.c 20.0 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
/**
 * mei_hbm_me_cl_allocate - allocates storage for me clients
 *
 * @dev: the device structure
 *
31
 * returns 0 on success -ENOMEM on allocation failure
32
 */
33
static int mei_hbm_me_cl_allocate(struct mei_device *dev)
34 35 36 37
{
	struct mei_me_client *clients;
	int b;

38 39 40 41
	dev->me_clients_num = 0;
	dev->me_client_presentation_num = 0;
	dev->me_client_index = 0;

42 43 44 45
	/* count how many ME clients we have */
	for_each_set_bit(b, dev->me_clients_map, MEI_CLIENTS_MAX)
		dev->me_clients_num++;

46
	if (dev->me_clients_num == 0)
47
		return 0;
48 49 50 51

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

52
	dev_dbg(&dev->pdev->dev, "memory allocation for ME clients size=%ld.\n",
53 54 55 56 57 58
		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");
59
		return -ENOMEM;
60 61
	}
	dev->me_clients = clients;
62
	return 0;
63 64
}

65 66
/**
 * mei_hbm_cl_hdr - construct client hbm header
67
 *
68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101
 * @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;
}

/**
 * same_disconn_addr - tells if they have the same address
 *
 * @file: private data of the file object.
 * @disconn: disconnection request.
 *
 * returns true if addres are same
 */
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;
}


102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128
/**
 * 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)) {
		if (!rs->status) {
			cl->state = MEI_FILE_CONNECTED;
			cl->status = 0;

		} else {
			cl->state = MEI_FILE_DISCONNECTED;
			cl->status = -ENODEV;
		}
		cl->timer_count = 0;

		return true;
	}
	return false;
}

T
Tomas Winkler 已提交
129 130 131 132 133 134 135 136 137
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 ||
138
			dev->hbm_state >= MEI_HBM_STARTED,
T
Tomas Winkler 已提交
139 140 141 142 143
			mei_secs_to_jiffies(MEI_INTEROP_TIMEOUT));
	mutex_lock(&dev->device_lock);

	if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
		dev->hbm_state = MEI_HBM_IDLE;
M
Masanari Iida 已提交
144
		dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
T
Tomas Winkler 已提交
145 146 147 148 149
		return -ETIMEDOUT;
	}
	return 0;
}

150
/**
151
 * mei_hbm_start_req - sends start request message.
152 153
 *
 * @dev: the device structure
154 155
 *
 * returns 0 on success and < 0 on failure
156
 */
T
Tomas Winkler 已提交
157
int mei_hbm_start_req(struct mei_device *dev)
158
{
159
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
160 161
	struct hbm_host_version_request *start_req;
	const size_t len = sizeof(struct hbm_host_version_request);
162
	int ret;
163

164
	mei_hbm_hdr(mei_hdr, len);
165 166

	/* host start message */
167
	start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
168 169 170 171 172
	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 已提交
173
	dev->hbm_state = MEI_HBM_IDLE;
174 175 176 177 178
	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;
179
	}
180

T
Tomas Winkler 已提交
181
	dev->hbm_state = MEI_HBM_START;
182
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
T
Tomas Winkler 已提交
183
	return 0;
184 185
}

T
Tomas Winkler 已提交
186
/*
187
 * mei_hbm_enum_clients_req - sends enumeration client request message.
188 189 190
 *
 * @dev: the device structure
 *
191
 * returns 0 on success and < 0 on failure
192
 */
193
static int mei_hbm_enum_clients_req(struct mei_device *dev)
194
{
195
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
196 197
	struct hbm_host_enum_request *enum_req;
	const size_t len = sizeof(struct hbm_host_enum_request);
198 199
	int ret;

200
	/* enumerate clients */
201
	mei_hbm_hdr(mei_hdr, len);
202

203 204
	enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
	memset(enum_req, 0, len);
205 206
	enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;

207 208 209 210 211
	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;
212
	}
T
Tomas Winkler 已提交
213
	dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
214
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
215
	return 0;
216 217
}

218
/**
219
 * mei_hbm_prop_req - request property for a single client
220 221 222
 *
 * @dev: the device structure
 *
223
 * returns 0 on success and < 0 on failure
224
 */
225

226
static int mei_hbm_prop_req(struct mei_device *dev)
227 228
{

229
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
230 231 232
	struct hbm_props_request *prop_req;
	const size_t len = sizeof(struct hbm_props_request);
	unsigned long next_client_index;
233
	unsigned long client_num;
234
	int ret;
235 236 237 238 239 240 241 242

	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 已提交
243
		dev->hbm_state = MEI_HBM_STARTED;
244 245 246 247 248 249 250 251
		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;

252 253
	mei_hbm_hdr(mei_hdr, len);
	prop_req = (struct hbm_props_request *)dev->wr_msg.data;
254 255 256 257 258 259 260

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


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

261 262 263 264 265
	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;
266 267 268 269 270 271 272 273
	}

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

	return 0;
}

274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294
/**
 * mei_hbm_stop_req_prepare - perpare stop request message
 *
 * @dev - mei device
 * @mei_hdr - mei message header
 * @data - hbm message body buffer
 */
static void mei_hbm_stop_req_prepare(struct mei_device *dev,
		struct mei_msg_hdr *mei_hdr, unsigned char *data)
{
	struct hbm_host_stop_request *req =
			(struct hbm_host_stop_request *)data;
	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;
}

295
/**
296
 * mei_hbm_cl_flow_control_req - sends flow control requst.
297 298
 *
 * @dev: the device structure
299
 * @cl: client info
300 301 302
 *
 * This function returns -EIO on write failure
 */
303
int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
304
{
305
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
306 307
	const size_t len = sizeof(struct hbm_flow_control);

308 309
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
310 311 312 313

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

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

317
/**
318
 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
319
 *
320
 * @dev: the device structure
321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376
 * @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;
		}
	}
}


377
/**
378
 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
379 380
 *
 * @dev: the device structure
381
 * @cl: a client to disconnect from
382 383 384
 *
 * This function returns -EIO on write failure
 */
385
int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
386
{
387
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
388 389
	const size_t len = sizeof(struct hbm_client_connect_request);

390 391
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
392

393
	return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
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 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437
/**
 * 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;

	dev_dbg(&dev->pdev->dev,
			"disconnect_response:\n"
			"ME Client = %d\n"
			"Host Client = %d\n"
			"Status = %d\n",
			rs->me_addr,
			rs->host_addr,
			rs->status);

	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);
			if (!rs->status)
				cl->state = MEI_FILE_DISCONNECTED;

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

438
/**
439
 * mei_hbm_cl_connect_req - send connection request to specific me client
440 441
 *
 * @dev: the device structure
442
 * @cl: a client to connect to
443
 *
444
 * returns -EIO on write failure
445
 */
446
int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
447
{
448
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
449 450
	const size_t len = sizeof(struct hbm_client_connect_request);

451 452
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
453

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

457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510
/**
 * mei_hbm_cl_connect_res - connect resposne from the ME
 *
 * @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;

	dev_dbg(&dev->pdev->dev,
			"connect_response:\n"
			"ME Client = %d\n"
			"Host Client = %d\n"
			"Status = %d\n",
			rs->me_addr,
			rs->host_addr,
			rs->status);

	/* 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;
		}
		if (pos->fop_type == MEI_FOP_IOCTL) {
			if (is_treat_specially_client(cl, rs)) {
				list_del(&pos->list);
				cl->status = 0;
				cl->timer_count = 0;
				break;
			}
		}
	}
}


511
/**
512
 * mei_hbm_fw_disconnect_req - disconnect request initiated by me
513
 *  host sends disoconnect response
514 515
 *
 * @dev: the device structure.
516
 * @disconnect_req: disconnect request bus message from the me
517
 */
518
static void mei_hbm_fw_disconnect_req(struct mei_device *dev,
519 520
		struct hbm_client_connect_request *disconnect_req)
{
521
	struct mei_cl *cl, *next;
522 523
	const size_t len = sizeof(struct hbm_client_connect_response);

524 525
	list_for_each_entry_safe(cl, next, &dev->file_list, link) {
		if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
526 527 528
			dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
					disconnect_req->host_addr,
					disconnect_req->me_addr);
529 530 531
			cl->state = MEI_FILE_DISCONNECTED;
			cl->timer_count = 0;
			if (cl == &dev->wd_cl)
532
				dev->wd_pending = false;
533
			else if (cl == &dev->iamthif_cl)
534 535 536
				dev->iamthif_timer = 0;

			/* prepare disconnect response */
537
			mei_hbm_hdr(&dev->wr_ext_msg.hdr, len);
538
			mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_RES_CMD,
539
					 dev->wr_ext_msg.data, len);
540 541 542 543 544 545
			break;
		}
	}
}


T
Tomas Winkler 已提交
546 547 548 549 550 551 552 553 554 555 556 557 558 559
/**
 * 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);
}

560 561 562 563 564 565
/**
 * 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
566 567
 *
 * returns 0 on success and < 0 on failure
568
 */
569
int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587
{
	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;

	switch (mei_msg->hbm_cmd) {
	case HOST_START_RES_CMD:
588 589 590 591
		dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");

		dev->init_clients_timer = 0;

592
		version_res = (struct hbm_host_version_response *)mei_msg;
T
Tomas Winkler 已提交
593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609

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

612
			dev->hbm_state = MEI_HBM_STOPPED;
613 614
			mei_hbm_stop_req_prepare(dev, &dev->wr_msg.hdr,
						dev->wr_msg.data);
615 616 617 618 619 620 621
			if (mei_write_message(dev, &dev->wr_msg.hdr,
					dev->wr_msg.data)) {
				dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
				return -EIO;
			}
			break;
		}
T
Tomas Winkler 已提交
622

623 624 625 626 627
		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;
628
		}
629

630 631 632 633 634
		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;
635 636
		}

T
Tomas Winkler 已提交
637
		wake_up_interruptible(&dev->wait_recvd_msg);
638 639 640
		break;

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

643
		connect_res = (struct hbm_client_connect_response *) mei_msg;
644
		mei_hbm_cl_connect_res(dev, connect_res);
645 646 647 648
		wake_up(&dev->wait_recvd_msg);
		break;

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

651
		disconnect_res = (struct hbm_client_connect_response *) mei_msg;
652
		mei_hbm_cl_disconnect_res(dev, disconnect_res);
653 654 655 656
		wake_up(&dev->wait_recvd_msg);
		break;

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

659
		flow_control = (struct hbm_flow_control *) mei_msg;
660
		mei_hbm_cl_flow_control_res(dev, flow_control);
661 662 663
		break;

	case HOST_CLIENT_PROPERTIES_RES_CMD:
664 665 666 667 668 669 670 671 672
		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;
		}

673 674 675
		props_res = (struct hbm_props_response *)mei_msg;
		me_client = &dev->me_clients[dev->me_client_presentation_num];

676 677 678 679
		if (props_res->status) {
			dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
				props_res->status);
			return -EPROTO;
680 681 682
		}

		if (me_client->client_id != props_res->address) {
683 684 685
			dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
				me_client->client_id, props_res->address);
			return -EPROTO;
686 687 688
		}

		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
T
Tomas Winkler 已提交
689
		    dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
690 691 692
			dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
				dev->dev_state, dev->hbm_state);
			return -EPROTO;
693 694 695 696 697 698
		}

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

699
		/* request property for the next client */
700 701
		if (mei_hbm_prop_req(dev))
			return -EIO;
702 703 704 705

		break;

	case HOST_ENUM_RES_CMD:
706 707 708 709
		dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");

		dev->init_clients_timer = 0;

710
		enum_res = (struct hbm_host_enum_response *) mei_msg;
711 712 713 714
		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));
715 716 717 718 719 720

		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;
721
		}
722 723 724 725 726 727 728 729 730 731 732 733

		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;

734 735 736
		break;

	case HOST_STOP_RES_CMD:
737 738 739 740 741 742 743 744 745
		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 已提交
746

747
		dev->dev_state = MEI_DEV_DISABLED;
748 749 750
		dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
		/* force the reset */
		return -EPROTO;
751 752 753
		break;

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

756
		disconnect_req = (struct hbm_client_connect_request *)mei_msg;
757
		mei_hbm_fw_disconnect_req(dev, disconnect_req);
758 759 760
		break;

	case ME_STOP_REQ_CMD:
761
		dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
762

763
		dev->hbm_state = MEI_HBM_STOPPED;
764 765
		mei_hbm_stop_req_prepare(dev, &dev->wr_ext_msg.hdr,
					dev->wr_ext_msg.data);
766 767 768 769 770 771
		break;
	default:
		BUG();
		break;

	}
772
	return 0;
773 774
}