hbm.c 21.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
 * @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;
}

/**
86
 * mei_hbm_cl_addr_equal - tells if they have the same address
87
 *
88 89
 * @cl: - client
 * @buf: buffer with cl header
90
 *
91
 * returns true if addresses are the same
92 93 94 95 96 97 98 99 100 101
 */
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;
}

129 130 131 132 133 134 135 136 137 138 139
/**
 * 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 已提交
140 141 142 143 144 145 146 147 148
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 ||
149
			dev->hbm_state >= MEI_HBM_STARTED,
150
			mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
T
Tomas Winkler 已提交
151 152 153 154
	mutex_lock(&dev->device_lock);

	if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
		dev->hbm_state = MEI_HBM_IDLE;
M
Masanari Iida 已提交
155
		dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
T
Tomas Winkler 已提交
156 157 158 159 160
		return -ETIMEDOUT;
	}
	return 0;
}

161
/**
162
 * mei_hbm_start_req - sends start request message.
163 164
 *
 * @dev: the device structure
165 166
 *
 * returns 0 on success and < 0 on failure
167
 */
T
Tomas Winkler 已提交
168
int mei_hbm_start_req(struct mei_device *dev)
169
{
170
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
171 172
	struct hbm_host_version_request *start_req;
	const size_t len = sizeof(struct hbm_host_version_request);
173
	int ret;
174

175
	mei_hbm_hdr(mei_hdr, len);
176 177

	/* host start message */
178
	start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
179 180 181 182 183
	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 已提交
184
	dev->hbm_state = MEI_HBM_IDLE;
185 186 187 188 189
	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;
190
	}
191

T
Tomas Winkler 已提交
192
	dev->hbm_state = MEI_HBM_START;
193
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
T
Tomas Winkler 已提交
194
	return 0;
195 196
}

T
Tomas Winkler 已提交
197
/*
198
 * mei_hbm_enum_clients_req - sends enumeration client request message.
199 200 201
 *
 * @dev: the device structure
 *
202
 * returns 0 on success and < 0 on failure
203
 */
204
static int mei_hbm_enum_clients_req(struct mei_device *dev)
205
{
206
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
207 208
	struct hbm_host_enum_request *enum_req;
	const size_t len = sizeof(struct hbm_host_enum_request);
209 210
	int ret;

211
	/* enumerate clients */
212
	mei_hbm_hdr(mei_hdr, len);
213

214 215
	enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
	memset(enum_req, 0, len);
216 217
	enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;

218 219 220 221 222
	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;
223
	}
T
Tomas Winkler 已提交
224
	dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
225
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
226
	return 0;
227 228
}

229
/**
230
 * mei_hbm_prop_req - request property for a single client
231 232 233
 *
 * @dev: the device structure
 *
234
 * returns 0 on success and < 0 on failure
235
 */
236

237
static int mei_hbm_prop_req(struct mei_device *dev)
238 239
{

240
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
241 242 243
	struct hbm_props_request *prop_req;
	const size_t len = sizeof(struct hbm_props_request);
	unsigned long next_client_index;
244
	unsigned long client_num;
245
	int ret;
246 247 248 249 250 251 252 253

	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 已提交
254
		dev->hbm_state = MEI_HBM_STARTED;
255 256 257 258 259 260 261 262
		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;

263 264
	mei_hbm_hdr(mei_hdr, len);
	prop_req = (struct hbm_props_request *)dev->wr_msg.data;
265 266 267 268 269 270 271

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


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

272 273 274 275 276
	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;
277 278 279 280 281 282 283 284
	}

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

	return 0;
}

285
/**
T
Tomas Winkler 已提交
286
 * mei_hbm_stop_req - send stop request message
287 288
 *
 * @dev - mei device
T
Tomas Winkler 已提交
289 290 291
 * @cl: client info
 *
 * This function returns -EIO on write failure
292
 */
T
Tomas Winkler 已提交
293
static int mei_hbm_stop_req(struct mei_device *dev)
294
{
T
Tomas Winkler 已提交
295
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
296
	struct hbm_host_stop_request *req =
T
Tomas Winkler 已提交
297
			(struct hbm_host_stop_request *)dev->wr_msg.data;
298 299 300 301 302 303 304
	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 已提交
305 306

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

309
/**
310
 * mei_hbm_cl_flow_control_req - sends flow control request.
311 312
 *
 * @dev: the device structure
313
 * @cl: client info
314 315 316
 *
 * This function returns -EIO on write failure
 */
317
int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
318
{
319
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
320 321
	const size_t len = sizeof(struct hbm_flow_control);

322 323
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
324 325 326 327

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

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

331
/**
332
 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
333
 *
334
 * @dev: the device structure
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 377 378 379 380 381 382 383 384 385 386 387 388 389 390
 * @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;
		}
	}
}


391
/**
392
 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
393 394
 *
 * @dev: the device structure
395
 * @cl: a client to disconnect from
396 397 398
 *
 * This function returns -EIO on write failure
 */
399
int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
400
{
401
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
402 403
	const size_t len = sizeof(struct hbm_client_connect_request);

404 405
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
406

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

T
Tomas Winkler 已提交
410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428
/**
 * 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);
}

429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470
/**
 * 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;
		}
	}
}

471
/**
472
 * mei_hbm_cl_connect_req - send connection request to specific me client
473 474
 *
 * @dev: the device structure
475
 * @cl: a client to connect to
476
 *
477
 * returns -EIO on write failure
478
 */
479
int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
480
{
481
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
482 483
	const size_t len = sizeof(struct hbm_client_connect_request);

484 485
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
486

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

490
/**
491
 * mei_hbm_cl_connect_res - connect response from the ME
492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531
 *
 * @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;
		}
532
		if (pos->fop_type == MEI_FOP_CONNECT) {
533 534 535 536 537 538 539 540 541 542 543
			if (is_treat_specially_client(cl, rs)) {
				list_del(&pos->list);
				cl->status = 0;
				cl->timer_count = 0;
				break;
			}
		}
	}
}


544
/**
545 546
 * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
 *  host sends disconnect response
547 548
 *
 * @dev: the device structure.
549
 * @disconnect_req: disconnect request bus message from the me
T
Tomas Winkler 已提交
550 551
 *
 * returns -ENOMEM on allocation failure
552
 */
T
Tomas Winkler 已提交
553
static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
554 555
		struct hbm_client_connect_request *disconnect_req)
{
556
	struct mei_cl *cl, *next;
T
Tomas Winkler 已提交
557
	struct mei_cl_cb *cb;
558

559 560
	list_for_each_entry_safe(cl, next, &dev->file_list, link) {
		if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
561 562 563
			dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
					disconnect_req->host_addr,
					disconnect_req->me_addr);
564 565 566
			cl->state = MEI_FILE_DISCONNECTED;
			cl->timer_count = 0;
			if (cl == &dev->wd_cl)
567
				dev->wd_pending = false;
568
			else if (cl == &dev->iamthif_cl)
569 570
				dev->iamthif_timer = 0;

T
Tomas Winkler 已提交
571 572 573 574 575 576 577
			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);

578 579 580
			break;
		}
	}
T
Tomas Winkler 已提交
581
	return 0;
582 583 584
}


T
Tomas Winkler 已提交
585 586 587 588 589 590 591 592 593 594 595 596 597 598
/**
 * 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);
}

599 600 601 602 603 604
/**
 * 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
605 606
 *
 * returns 0 on success and < 0 on failure
607
 */
608
int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624
{
	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;

625 626 627 628 629 630 631 632
	/* 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;
	}

633 634
	switch (mei_msg->hbm_cmd) {
	case HOST_START_RES_CMD:
635 636 637 638
		dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");

		dev->init_clients_timer = 0;

639
		version_res = (struct hbm_host_version_response *)mei_msg;
T
Tomas Winkler 已提交
640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656

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

659
			dev->hbm_state = MEI_HBM_STOPPED;
T
Tomas Winkler 已提交
660
			if (mei_hbm_stop_req(dev)) {
661 662 663 664 665
				dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
				return -EIO;
			}
			break;
		}
T
Tomas Winkler 已提交
666

667 668 669 670 671
		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;
672
		}
673

674 675 676 677 678
		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;
679 680
		}

T
Tomas Winkler 已提交
681
		wake_up_interruptible(&dev->wait_recvd_msg);
682 683 684
		break;

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

687
		connect_res = (struct hbm_client_connect_response *) mei_msg;
688
		mei_hbm_cl_connect_res(dev, connect_res);
689 690 691 692
		wake_up(&dev->wait_recvd_msg);
		break;

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

695
		disconnect_res = (struct hbm_client_connect_response *) mei_msg;
696
		mei_hbm_cl_disconnect_res(dev, disconnect_res);
697 698 699 700
		wake_up(&dev->wait_recvd_msg);
		break;

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

703
		flow_control = (struct hbm_flow_control *) mei_msg;
704
		mei_hbm_cl_flow_control_res(dev, flow_control);
705 706 707
		break;

	case HOST_CLIENT_PROPERTIES_RES_CMD:
708 709 710 711 712 713 714 715 716
		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;
		}

717 718 719
		props_res = (struct hbm_props_response *)mei_msg;
		me_client = &dev->me_clients[dev->me_client_presentation_num];

720 721 722 723
		if (props_res->status) {
			dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
				props_res->status);
			return -EPROTO;
724 725 726
		}

		if (me_client->client_id != props_res->address) {
727 728 729
			dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
				me_client->client_id, props_res->address);
			return -EPROTO;
730 731 732
		}

		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
T
Tomas Winkler 已提交
733
		    dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
734 735 736
			dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
				dev->dev_state, dev->hbm_state);
			return -EPROTO;
737 738 739 740 741 742
		}

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

743
		/* request property for the next client */
744 745
		if (mei_hbm_prop_req(dev))
			return -EIO;
746 747 748 749

		break;

	case HOST_ENUM_RES_CMD:
750 751 752 753
		dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");

		dev->init_clients_timer = 0;

754
		enum_res = (struct hbm_host_enum_response *) mei_msg;
755 756 757 758
		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));
759 760 761 762 763 764

		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;
765
		}
766 767 768 769 770 771 772 773 774 775 776 777

		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;

778 779 780
		break;

	case HOST_STOP_RES_CMD:
781 782 783 784 785 786 787 788 789
		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 已提交
790

791
		dev->dev_state = MEI_DEV_POWER_DOWN;
792 793 794
		dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
		/* force the reset */
		return -EPROTO;
795 796 797
		break;

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

800
		disconnect_req = (struct hbm_client_connect_request *)mei_msg;
801
		mei_hbm_fw_disconnect_req(dev, disconnect_req);
802 803 804
		break;

	case ME_STOP_REQ_CMD:
805 806
		dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
		dev->hbm_state = MEI_HBM_STOPPED;
T
Tomas Winkler 已提交
807 808 809 810
		if (mei_hbm_stop_req(dev)) {
			dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
			return -EIO;
		}
811 812 813 814 815 816
		break;
	default:
		BUG();
		break;

	}
817
	return 0;
818 819
}