hbm.c 21.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 *
 * Intel Management Engine Interface (Intel MEI) Linux driver
 * Copyright (c) 2003-2012, Intel Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 */

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

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

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

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

62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79
/**
 * 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;
}

/**
 * mei_hbm_reset - reset hbm counters and book keeping data structurs
 *
 * @dev: the device structure
 */
void mei_hbm_reset(struct mei_device *dev)
{
80 81
	struct mei_me_client *me_cl, *next;

82 83 84
	dev->me_client_presentation_num = 0;
	dev->me_client_index = 0;

85 86 87 88
	list_for_each_entry_safe(me_cl, next, &dev->me_clients, list) {
		list_del(&me_cl->list);
		kfree(me_cl);
	}
89 90 91 92

	mei_hbm_idle(dev);
}

93 94
/**
 * mei_hbm_cl_hdr - construct client hbm header
95
 *
96
 * @cl: client
97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112
 * @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;
}

113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132
/**
 * mei_hbm_cl_write - write simple hbm client message
 *
 * @dev: the device structure
 * @cl: client
 * @hbm_cmd: host bus message command
 * @len: buffer length
 */
static inline
int mei_hbm_cl_write(struct mei_device *dev,
		     struct mei_cl *cl, u8 hbm_cmd, size_t len)
{
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;

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

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

133
/**
134
 * mei_hbm_cl_addr_equal - tells if they have the same address
135
 *
136 137
 * @cl: - client
 * @buf: buffer with cl header
138
 *
139
 * returns true if addresses are the same
140 141 142 143 144 145 146 147 148 149
 */
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;
}


T
Tomas Winkler 已提交
150 151 152 153 154 155 156 157 158
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 ||
159
			dev->hbm_state >= MEI_HBM_STARTED,
160
			mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
T
Tomas Winkler 已提交
161 162 163 164
	mutex_lock(&dev->device_lock);

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

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

185 186
	mei_hbm_reset(dev);

187
	mei_hbm_hdr(mei_hdr, len);
188 189

	/* host start message */
190
	start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
191 192 193 194 195
	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 已提交
196
	dev->hbm_state = MEI_HBM_IDLE;
197 198 199 200 201
	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;
202
	}
203

T
Tomas Winkler 已提交
204
	dev->hbm_state = MEI_HBM_START;
205
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
T
Tomas Winkler 已提交
206
	return 0;
207 208
}

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

223
	/* enumerate clients */
224
	mei_hbm_hdr(mei_hdr, len);
225

226 227
	enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
	memset(enum_req, 0, len);
228 229
	enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;

230 231 232 233 234
	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;
235
	}
T
Tomas Winkler 已提交
236
	dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
237
	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
238
	return 0;
239 240
}

241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266
/*
 * mei_hbm_me_cl_add - add new me client to the list
 *
 * @dev: the device structure
 * @res: hbm property response
 *
 * returns 0 on success and -ENOMEM on allocation failure
 */

static int mei_hbm_me_cl_add(struct mei_device *dev,
			     struct hbm_props_response *res)
{
	struct mei_me_client *me_cl;

	me_cl = kzalloc(sizeof(struct mei_me_client), GFP_KERNEL);
	if (!me_cl)
		return -ENOMEM;

	me_cl->props = res->client_properties;
	me_cl->client_id = res->me_addr;
	me_cl->mei_flow_ctrl_creds = 0;

	list_add(&me_cl->list, &dev->me_clients);
	return 0;
}

267
/**
268
 * mei_hbm_prop_req - request property for a single client
269 270 271
 *
 * @dev: the device structure
 *
272
 * returns 0 on success and < 0 on failure
273
 */
274

275
static int mei_hbm_prop_req(struct mei_device *dev)
276 277
{

278
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
279 280 281
	struct hbm_props_request *prop_req;
	const size_t len = sizeof(struct hbm_props_request);
	unsigned long next_client_index;
282
	int ret;
283 284 285 286 287 288

	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 已提交
289
		dev->hbm_state = MEI_HBM_STARTED;
290 291 292 293 294
		schedule_work(&dev->init_work);

		return 0;
	}

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

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

	prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
301
	prop_req->me_addr = next_client_index;
302

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 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343
/*
 * mei_hbm_pg - sends pg command
 *
 * @dev: the device structure
 * @pg_cmd: the pg command code
 *
 * This function returns -EIO on write failure
 */
int mei_hbm_pg(struct mei_device *dev, u8 pg_cmd)
{
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
	struct hbm_power_gate *req;
	const size_t len = sizeof(struct hbm_power_gate);
	int ret;

	mei_hbm_hdr(mei_hdr, len);

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

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

344
/**
T
Tomas Winkler 已提交
345
 * mei_hbm_stop_req - send stop request message
346 347
 *
 * @dev - mei device
T
Tomas Winkler 已提交
348 349 350
 * @cl: client info
 *
 * This function returns -EIO on write failure
351
 */
T
Tomas Winkler 已提交
352
static int mei_hbm_stop_req(struct mei_device *dev)
353
{
T
Tomas Winkler 已提交
354
	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
355
	struct hbm_host_stop_request *req =
T
Tomas Winkler 已提交
356
			(struct hbm_host_stop_request *)dev->wr_msg.data;
357 358 359 360 361 362 363
	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 已提交
364 365

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

368
/**
369
 * mei_hbm_cl_flow_control_req - sends flow control request.
370 371
 *
 * @dev: the device structure
372
 * @cl: client info
373 374 375
 *
 * This function returns -EIO on write failure
 */
376
int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
377 378
{
	const size_t len = sizeof(struct hbm_flow_control);
379
	cl_dbg(dev, cl, "sending flow control\n");
380
	return mei_hbm_cl_write(dev, cl, MEI_FLOW_CONTROL_CMD, len);
381 382
}

383
/**
384
 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
385
 *
386
 * @dev: the device structure
387
 * @flow: flow control.
388 389
 *
 * return 0 on success, < 0 otherwise
390
 */
391
static int mei_hbm_add_single_flow_creds(struct mei_device *dev,
392 393
				  struct hbm_flow_control *flow)
{
394 395
	struct mei_me_client *me_cl;

396 397
	me_cl = mei_me_cl_by_id(dev, flow->me_addr);
	if (!me_cl) {
398 399
		dev_err(&dev->pdev->dev, "no such me client %d\n",
			flow->me_addr);
400
		return -ENOENT;
401 402
	}

403 404 405 406 407 408
	if (WARN_ON(me_cl->props.single_recv_buf == 0))
		return -EINVAL;

	me_cl->mei_flow_ctrl_creds++;
	dev_dbg(&dev->pdev->dev, "recv flow ctrl msg ME %d (single) creds = %d.\n",
	    flow->me_addr, me_cl->mei_flow_ctrl_creds);
409 410

	return 0;
411 412 413 414 415 416 417 418 419 420 421
}

/**
 * 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)
{
422
	struct mei_cl *cl;
423 424 425 426 427 428 429 430

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

	/* normal connection */
431
	list_for_each_entry(cl, &dev->file_list, link) {
432 433
		if (mei_hbm_cl_addr_equal(cl, flow_control)) {
			cl->mei_flow_ctrl_creds++;
434 435 436 437
			dev_dbg(&dev->pdev->dev, "flow ctrl msg for host %d ME %d creds %d.\n",
				flow_control->host_addr, flow_control->me_addr,
				cl->mei_flow_ctrl_creds);
			break;
438 439 440 441 442
		}
	}
}


443
/**
444
 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
445 446
 *
 * @dev: the device structure
447
 * @cl: a client to disconnect from
448 449 450
 *
 * This function returns -EIO on write failure
 */
451
int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
452 453
{
	const size_t len = sizeof(struct hbm_client_connect_request);
454
	return mei_hbm_cl_write(dev, cl, CLIENT_DISCONNECT_REQ_CMD, len);
455 456
}

T
Tomas Winkler 已提交
457 458 459 460 461 462 463 464 465 466 467
/**
 * 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)
{
	const size_t len = sizeof(struct hbm_client_connect_response);
468
	return mei_hbm_cl_write(dev, cl, CLIENT_DISCONNECT_RES_CMD, len);
T
Tomas Winkler 已提交
469 470
}

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

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

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

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

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

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

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

521
/**
522
 * mei_hbm_cl_connect_res - connect response from the ME
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;
532
	struct mei_cl_cb *cb, *next;
533

534 535 536
	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));
537

538
	cl = NULL;
539

540
	list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
541

542 543 544 545 546 547
		cl = cb->cl;
		/* this should not happen */
		if (WARN_ON(!cl)) {
			list_del_init(&cb->list);
			continue;
		}
548

549 550
		if (cb->fop_type !=  MEI_FOP_CONNECT)
			continue;
551

552 553 554
		if (mei_hbm_cl_addr_equal(cl, rs)) {
			list_del(&cb->list);
			break;
555 556
		}
	}
557 558 559 560 561 562 563 564 565 566

	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);
567 568 569
}


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

585
	list_for_each_entry(cl, &dev->file_list, link) {
586
		if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
587 588 589
			dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
					disconnect_req->host_addr,
					disconnect_req->me_addr);
590 591
			cl->state = MEI_FILE_DISCONNECTED;
			cl->timer_count = 0;
592

T
Tomas Winkler 已提交
593 594 595 596 597 598 599
			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);

600 601 602
			break;
		}
	}
T
Tomas Winkler 已提交
603
	return 0;
604 605 606
}


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

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

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

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

		dev->init_clients_timer = 0;

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

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

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

688 689 690 691 692
		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;
693
		}
694

695 696 697 698 699
		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;
700 701
		}

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

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

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

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

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

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

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

728 729
	case MEI_PG_ISOLATION_ENTRY_RES_CMD:
		dev_dbg(&dev->pdev->dev, "power gate isolation entry response received\n");
730
		dev->pg_event = MEI_PG_EVENT_RECEIVED;
731 732 733 734 735 736
		if (waitqueue_active(&dev->wait_pg))
			wake_up(&dev->wait_pg);
		break;

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

749
	case HOST_CLIENT_PROPERTIES_RES_CMD:
750 751 752 753
		dev_dbg(&dev->pdev->dev, "hbm: properties response: message received.\n");

		dev->init_clients_timer = 0;

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

761 762
		props_res = (struct hbm_props_response *)mei_msg;

763 764 765 766
		if (props_res->status) {
			dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
				props_res->status);
			return -EPROTO;
767 768
		}

769
		mei_hbm_me_cl_add(dev, props_res);
770 771 772 773

		dev->me_client_index++;
		dev->me_client_presentation_num++;

774
		/* request property for the next client */
775 776
		if (mei_hbm_prop_req(dev))
			return -EIO;
777 778 779 780

		break;

	case HOST_ENUM_RES_CMD:
781 782 783 784
		dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");

		dev->init_clients_timer = 0;

785
		enum_res = (struct hbm_host_enum_response *) mei_msg;
786 787 788
		BUILD_BUG_ON(sizeof(dev->me_clients_map)
				< sizeof(enum_res->valid_addresses));
		memcpy(dev->me_clients_map, enum_res->valid_addresses,
789
				sizeof(enum_res->valid_addresses));
790 791 792 793 794 795

		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;
796
		}
797 798 799 800 801 802 803

		dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;

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

804 805 806
		break;

	case HOST_STOP_RES_CMD:
807 808 809 810 811 812 813 814 815
		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 已提交
816

817
		dev->dev_state = MEI_DEV_POWER_DOWN;
818 819 820
		dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
		/* force the reset */
		return -EPROTO;
821 822 823
		break;

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

826
		disconnect_req = (struct hbm_client_connect_request *)mei_msg;
827
		mei_hbm_fw_disconnect_req(dev, disconnect_req);
828 829 830
		break;

	case ME_STOP_REQ_CMD:
831 832
		dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
		dev->hbm_state = MEI_HBM_STOPPED;
T
Tomas Winkler 已提交
833 834 835 836
		if (mei_hbm_stop_req(dev)) {
			dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
			return -EIO;
		}
837 838 839 840 841 842
		break;
	default:
		BUG();
		break;

	}
843
	return 0;
844 845
}