hbm.c 21.1 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"
24
#include "client.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
/**
 * 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 已提交
147 148 149 150 151 152 153 154 155
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 ||
156
			dev->hbm_state >= MEI_HBM_STARTED,
157
			mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
T
Tomas Winkler 已提交
158 159 160 161
	mutex_lock(&dev->device_lock);

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

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

182
	mei_hbm_hdr(mei_hdr, len);
183 184

	/* host start message */
185
	start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
186 187 188 189 190
	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 已提交
191
	dev->hbm_state = MEI_HBM_IDLE;
192 193 194 195 196
	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;
197
	}
198

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

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

218
	/* enumerate clients */
219
	mei_hbm_hdr(mei_hdr, len);
220

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

225 226 227 228 229
	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;
230
	}
T
Tomas Winkler 已提交
231
	dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
232
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
233
	return 0;
234 235
}

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

244
static int mei_hbm_prop_req(struct mei_device *dev)
245 246
{

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

	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 已提交
261
		dev->hbm_state = MEI_HBM_STARTED;
262 263 264 265 266 267 268 269
		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;

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

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


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

279 280 281 282 283
	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;
284 285 286 287 288 289 290 291
	}

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

	return 0;
}

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

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

316
/**
317
 * mei_hbm_cl_flow_control_req - sends flow control request.
318 319
 *
 * @dev: the device structure
320
 * @cl: client info
321 322 323
 *
 * This function returns -EIO on write failure
 */
324
int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
325
{
326
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
327 328
	const size_t len = sizeof(struct hbm_flow_control);

329 330
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
331 332 333 334

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

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

338
/**
339
 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
340
 *
341
 * @dev: the device structure
342
 * @flow: flow control.
343 344
 *
 * return 0 on success, < 0 otherwise
345
 */
346
static int mei_hbm_add_single_flow_creds(struct mei_device *dev,
347 348
				  struct hbm_flow_control *flow)
{
349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367
	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 */
368
	}
369 370

	return 0;
371 372 373 374 375 376 377 378 379 380 381
}

/**
 * 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)
{
382
	struct mei_cl *cl;
383 384 385 386 387 388 389 390

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

	/* normal connection */
391
	list_for_each_entry(cl, &dev->file_list, link) {
392 393 394 395 396 397 398 399 400 401 402 403
		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;
		}
	}
}


404
/**
405
 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
406 407
 *
 * @dev: the device structure
408
 * @cl: a client to disconnect from
409 410 411
 *
 * This function returns -EIO on write failure
 */
412
int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
413
{
414
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
415 416
	const size_t len = sizeof(struct hbm_client_connect_request);

417 418
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
419

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

T
Tomas Winkler 已提交
423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441
/**
 * 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);
}

442 443 444 445 446 447 448 449 450 451
/**
 * 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;
452
	struct mei_cl_cb *cb, *next;
453

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

457 458
	list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
		cl = cb->cl;
459

460 461 462
		/* this should not happen */
		if (WARN_ON(!cl)) {
			list_del(&cb->list);
463 464 465 466
			return;
		}

		if (mei_hbm_cl_addr_equal(cl, rs)) {
467
			list_del(&cb->list);
468
			if (rs->status == MEI_CL_DISCONN_SUCCESS)
469 470 471 472 473 474 475 476 477
				cl->state = MEI_FILE_DISCONNECTED;

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

478
/**
479
 * mei_hbm_cl_connect_req - send connection request to specific me client
480 481
 *
 * @dev: the device structure
482
 * @cl: a client to connect to
483
 *
484
 * returns -EIO on write failure
485
 */
486
int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
487
{
488
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
489 490
	const size_t len = sizeof(struct hbm_client_connect_request);

491 492
	mei_hbm_hdr(mei_hdr, len);
	mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
493

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

497
/**
498
 * mei_hbm_cl_connect_res - connect response from the ME
499 500 501 502 503 504 505 506 507
 *
 * @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;
508
	struct mei_cl_cb *cb, *next;
509

510 511 512
	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));
513

514
	cl = NULL;
515

516
	list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
517

518 519 520 521 522 523
		cl = cb->cl;
		/* this should not happen */
		if (WARN_ON(!cl)) {
			list_del_init(&cb->list);
			continue;
		}
524

525 526
		if (cb->fop_type !=  MEI_FOP_CONNECT)
			continue;
527

528 529 530
		if (mei_hbm_cl_addr_equal(cl, rs)) {
			list_del(&cb->list);
			break;
531 532
		}
	}
533 534 535 536 537 538 539 540 541 542

	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);
543 544 545
}


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

561
	list_for_each_entry(cl, &dev->file_list, link) {
562
		if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
563 564 565
			dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
					disconnect_req->host_addr,
					disconnect_req->me_addr);
566 567
			cl->state = MEI_FILE_DISCONNECTED;
			cl->timer_count = 0;
568

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

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


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

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

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

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

		dev->init_clients_timer = 0;

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

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

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

665 666 667 668 669
		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;
670
		}
671

672 673 674 675 676
		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;
677 678
		}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

		break;

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

		dev->init_clients_timer = 0;

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

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

		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;

776 777 778
		break;

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

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

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

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

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

	}
815
	return 0;
816 817
}