xref: /openbmc/linux/drivers/misc/mei/hbm.c (revision 8c0b9ee8)
1 /*
2  *
3  * Intel Management Engine Interface (Intel MEI) Linux driver
4  * Copyright (c) 2003-2012, Intel Corporation.
5  *
6  * This program is free software; you can redistribute it and/or modify it
7  * under the terms and conditions of the GNU General Public License,
8  * version 2, as published by the Free Software Foundation.
9  *
10  * This program is distributed in the hope it will be useful, but WITHOUT
11  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
13  * more details.
14  *
15  */
16 
17 #include <linux/export.h>
18 #include <linux/sched.h>
19 #include <linux/wait.h>
20 #include <linux/pm_runtime.h>
21 #include <linux/slab.h>
22 
23 #include <linux/mei.h>
24 
25 #include "mei_dev.h"
26 #include "hbm.h"
27 #include "client.h"
28 
29 static const char *mei_hbm_status_str(enum mei_hbm_status status)
30 {
31 #define MEI_HBM_STATUS(status) case MEI_HBMS_##status: return #status
32 	switch (status) {
33 	MEI_HBM_STATUS(SUCCESS);
34 	MEI_HBM_STATUS(CLIENT_NOT_FOUND);
35 	MEI_HBM_STATUS(ALREADY_EXISTS);
36 	MEI_HBM_STATUS(REJECTED);
37 	MEI_HBM_STATUS(INVALID_PARAMETER);
38 	MEI_HBM_STATUS(NOT_ALLOWED);
39 	MEI_HBM_STATUS(ALREADY_STARTED);
40 	MEI_HBM_STATUS(NOT_STARTED);
41 	default: return "unknown";
42 	}
43 #undef MEI_HBM_STATUS
44 };
45 
46 static const char *mei_cl_conn_status_str(enum mei_cl_connect_status status)
47 {
48 #define MEI_CL_CS(status) case MEI_CL_CONN_##status: return #status
49 	switch (status) {
50 	MEI_CL_CS(SUCCESS);
51 	MEI_CL_CS(NOT_FOUND);
52 	MEI_CL_CS(ALREADY_STARTED);
53 	MEI_CL_CS(OUT_OF_RESOURCES);
54 	MEI_CL_CS(MESSAGE_SMALL);
55 	default: return "unknown";
56 	}
57 #undef MEI_CL_CCS
58 }
59 
60 const char *mei_hbm_state_str(enum mei_hbm_state state)
61 {
62 #define MEI_HBM_STATE(state) case MEI_HBM_##state: return #state
63 	switch (state) {
64 	MEI_HBM_STATE(IDLE);
65 	MEI_HBM_STATE(STARTING);
66 	MEI_HBM_STATE(STARTED);
67 	MEI_HBM_STATE(ENUM_CLIENTS);
68 	MEI_HBM_STATE(CLIENT_PROPERTIES);
69 	MEI_HBM_STATE(STOPPED);
70 	default:
71 		return "unknown";
72 	}
73 #undef MEI_HBM_STATE
74 }
75 
76 /**
77  * mei_cl_conn_status_to_errno - convert client connect response
78  * status to error code
79  *
80  * @status: client connect response status
81  *
82  * Return: corresponding error code
83  */
84 static int mei_cl_conn_status_to_errno(enum mei_cl_connect_status status)
85 {
86 	switch (status) {
87 	case MEI_CL_CONN_SUCCESS:          return 0;
88 	case MEI_CL_CONN_NOT_FOUND:        return -ENOTTY;
89 	case MEI_CL_CONN_ALREADY_STARTED:  return -EBUSY;
90 	case MEI_CL_CONN_OUT_OF_RESOURCES: return -EBUSY;
91 	case MEI_CL_CONN_MESSAGE_SMALL:    return -EINVAL;
92 	default:                           return -EINVAL;
93 	}
94 }
95 
96 /**
97  * mei_hbm_idle - set hbm to idle state
98  *
99  * @dev: the device structure
100  */
101 void mei_hbm_idle(struct mei_device *dev)
102 {
103 	dev->init_clients_timer = 0;
104 	dev->hbm_state = MEI_HBM_IDLE;
105 }
106 
107 /**
108  * mei_hbm_reset - reset hbm counters and book keeping data structurs
109  *
110  * @dev: the device structure
111  */
112 void mei_hbm_reset(struct mei_device *dev)
113 {
114 	dev->me_client_index = 0;
115 
116 	mei_me_cl_rm_all(dev);
117 
118 	mei_hbm_idle(dev);
119 }
120 
121 /**
122  * mei_hbm_hdr - construct hbm header
123  *
124  * @hdr: hbm header
125  * @length: payload length
126  */
127 
128 static inline void mei_hbm_hdr(struct mei_msg_hdr *hdr, size_t length)
129 {
130 	hdr->host_addr = 0;
131 	hdr->me_addr = 0;
132 	hdr->length = length;
133 	hdr->msg_complete = 1;
134 	hdr->reserved = 0;
135 }
136 
137 /**
138  * mei_hbm_cl_hdr - construct client hbm header
139  *
140  * @cl: client
141  * @hbm_cmd: host bus message command
142  * @buf: buffer for cl header
143  * @len: buffer length
144  */
145 static inline
146 void mei_hbm_cl_hdr(struct mei_cl *cl, u8 hbm_cmd, void *buf, size_t len)
147 {
148 	struct mei_hbm_cl_cmd *cmd = buf;
149 
150 	memset(cmd, 0, len);
151 
152 	cmd->hbm_cmd = hbm_cmd;
153 	cmd->host_addr = cl->host_client_id;
154 	cmd->me_addr = cl->me_client_id;
155 }
156 
157 /**
158  * mei_hbm_cl_write - write simple hbm client message
159  *
160  * @dev: the device structure
161  * @cl: client
162  * @hbm_cmd: host bus message command
163  * @len: buffer length
164  *
165  * Return: 0 on success, <0 on failure.
166  */
167 static inline
168 int mei_hbm_cl_write(struct mei_device *dev,
169 		     struct mei_cl *cl, u8 hbm_cmd, size_t len)
170 {
171 	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
172 
173 	mei_hbm_hdr(mei_hdr, len);
174 	mei_hbm_cl_hdr(cl, hbm_cmd, dev->wr_msg.data, len);
175 
176 	return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
177 }
178 
179 /**
180  * mei_hbm_cl_addr_equal - check if the client's and
181  *	the message address match
182  *
183  * @cl: client
184  * @cmd: hbm client message
185  *
186  * Return: true if addresses are the same
187  */
188 static inline
189 bool mei_hbm_cl_addr_equal(struct mei_cl *cl, struct mei_hbm_cl_cmd *cmd)
190 {
191 	return cl->host_client_id == cmd->host_addr &&
192 		cl->me_client_id == cmd->me_addr;
193 }
194 
195 /**
196  * mei_hbm_cl_find_by_cmd - find recipient client
197  *
198  * @dev: the device structure
199  * @buf: a buffer with hbm cl command
200  *
201  * Return: the recipient client or NULL if not found
202  */
203 static inline
204 struct mei_cl *mei_hbm_cl_find_by_cmd(struct mei_device *dev, void *buf)
205 {
206 	struct mei_hbm_cl_cmd *cmd = (struct mei_hbm_cl_cmd *)buf;
207 	struct mei_cl *cl;
208 
209 	list_for_each_entry(cl, &dev->file_list, link)
210 		if (mei_hbm_cl_addr_equal(cl, cmd))
211 			return cl;
212 	return NULL;
213 }
214 
215 
216 /**
217  * mei_hbm_start_wait - wait for start response message.
218  *
219  * @dev: the device structure
220  *
221  * Return: 0 on success and < 0 on failure
222  */
223 int mei_hbm_start_wait(struct mei_device *dev)
224 {
225 	int ret;
226 
227 	if (dev->hbm_state > MEI_HBM_STARTING)
228 		return 0;
229 
230 	mutex_unlock(&dev->device_lock);
231 	ret = wait_event_timeout(dev->wait_hbm_start,
232 			dev->hbm_state != MEI_HBM_STARTING,
233 			mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
234 	mutex_lock(&dev->device_lock);
235 
236 	if (ret == 0 && (dev->hbm_state <= MEI_HBM_STARTING)) {
237 		dev->hbm_state = MEI_HBM_IDLE;
238 		dev_err(dev->dev, "waiting for mei start failed\n");
239 		return -ETIME;
240 	}
241 	return 0;
242 }
243 
244 /**
245  * mei_hbm_start_req - sends start request message.
246  *
247  * @dev: the device structure
248  *
249  * Return: 0 on success and < 0 on failure
250  */
251 int mei_hbm_start_req(struct mei_device *dev)
252 {
253 	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
254 	struct hbm_host_version_request *start_req;
255 	const size_t len = sizeof(struct hbm_host_version_request);
256 	int ret;
257 
258 	mei_hbm_reset(dev);
259 
260 	mei_hbm_hdr(mei_hdr, len);
261 
262 	/* host start message */
263 	start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
264 	memset(start_req, 0, len);
265 	start_req->hbm_cmd = HOST_START_REQ_CMD;
266 	start_req->host_version.major_version = HBM_MAJOR_VERSION;
267 	start_req->host_version.minor_version = HBM_MINOR_VERSION;
268 
269 	dev->hbm_state = MEI_HBM_IDLE;
270 	ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
271 	if (ret) {
272 		dev_err(dev->dev, "version message write failed: ret = %d\n",
273 			ret);
274 		return ret;
275 	}
276 
277 	dev->hbm_state = MEI_HBM_STARTING;
278 	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
279 	return 0;
280 }
281 
282 /*
283  * mei_hbm_enum_clients_req - sends enumeration client request message.
284  *
285  * @dev: the device structure
286  *
287  * Return: 0 on success and < 0 on failure
288  */
289 static int mei_hbm_enum_clients_req(struct mei_device *dev)
290 {
291 	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
292 	struct hbm_host_enum_request *enum_req;
293 	const size_t len = sizeof(struct hbm_host_enum_request);
294 	int ret;
295 
296 	/* enumerate clients */
297 	mei_hbm_hdr(mei_hdr, len);
298 
299 	enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
300 	memset(enum_req, 0, len);
301 	enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
302 
303 	ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
304 	if (ret) {
305 		dev_err(dev->dev, "enumeration request write failed: ret = %d.\n",
306 			ret);
307 		return ret;
308 	}
309 	dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
310 	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
311 	return 0;
312 }
313 
314 /*
315  * mei_hbm_me_cl_add - add new me client to the list
316  *
317  * @dev: the device structure
318  * @res: hbm property response
319  *
320  * Return: 0 on success and -ENOMEM on allocation failure
321  */
322 
323 static int mei_hbm_me_cl_add(struct mei_device *dev,
324 			     struct hbm_props_response *res)
325 {
326 	struct mei_me_client *me_cl;
327 	const uuid_le *uuid = &res->client_properties.protocol_name;
328 
329 	mei_me_cl_rm_by_uuid(dev, uuid);
330 
331 	me_cl = kzalloc(sizeof(struct mei_me_client), GFP_KERNEL);
332 	if (!me_cl)
333 		return -ENOMEM;
334 
335 	mei_me_cl_init(me_cl);
336 
337 	me_cl->props = res->client_properties;
338 	me_cl->client_id = res->me_addr;
339 	me_cl->mei_flow_ctrl_creds = 0;
340 
341 	list_add(&me_cl->list, &dev->me_clients);
342 	return 0;
343 }
344 
345 /**
346  * mei_hbm_prop_req - request property for a single client
347  *
348  * @dev: the device structure
349  *
350  * Return: 0 on success and < 0 on failure
351  */
352 
353 static int mei_hbm_prop_req(struct mei_device *dev)
354 {
355 
356 	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
357 	struct hbm_props_request *prop_req;
358 	const size_t len = sizeof(struct hbm_props_request);
359 	unsigned long next_client_index;
360 	int ret;
361 
362 	next_client_index = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX,
363 					  dev->me_client_index);
364 
365 	/* We got all client properties */
366 	if (next_client_index == MEI_CLIENTS_MAX) {
367 		dev->hbm_state = MEI_HBM_STARTED;
368 		schedule_work(&dev->init_work);
369 
370 		return 0;
371 	}
372 
373 	mei_hbm_hdr(mei_hdr, len);
374 	prop_req = (struct hbm_props_request *)dev->wr_msg.data;
375 
376 	memset(prop_req, 0, sizeof(struct hbm_props_request));
377 
378 	prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
379 	prop_req->me_addr = next_client_index;
380 
381 	ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
382 	if (ret) {
383 		dev_err(dev->dev, "properties request write failed: ret = %d\n",
384 			ret);
385 		return ret;
386 	}
387 
388 	dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
389 	dev->me_client_index = next_client_index;
390 
391 	return 0;
392 }
393 
394 /*
395  * mei_hbm_pg - sends pg command
396  *
397  * @dev: the device structure
398  * @pg_cmd: the pg command code
399  *
400  * Return: -EIO on write failure
401  *         -EOPNOTSUPP if the operation is not supported by the protocol
402  */
403 int mei_hbm_pg(struct mei_device *dev, u8 pg_cmd)
404 {
405 	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
406 	struct hbm_power_gate *req;
407 	const size_t len = sizeof(struct hbm_power_gate);
408 	int ret;
409 
410 	if (!dev->hbm_f_pg_supported)
411 		return -EOPNOTSUPP;
412 
413 	mei_hbm_hdr(mei_hdr, len);
414 
415 	req = (struct hbm_power_gate *)dev->wr_msg.data;
416 	memset(req, 0, len);
417 	req->hbm_cmd = pg_cmd;
418 
419 	ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
420 	if (ret)
421 		dev_err(dev->dev, "power gate command write failed.\n");
422 	return ret;
423 }
424 EXPORT_SYMBOL_GPL(mei_hbm_pg);
425 
426 /**
427  * mei_hbm_stop_req - send stop request message
428  *
429  * @dev: mei device
430  *
431  * Return: -EIO on write failure
432  */
433 static int mei_hbm_stop_req(struct mei_device *dev)
434 {
435 	struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
436 	struct hbm_host_stop_request *req =
437 			(struct hbm_host_stop_request *)dev->wr_msg.data;
438 	const size_t len = sizeof(struct hbm_host_stop_request);
439 
440 	mei_hbm_hdr(mei_hdr, len);
441 
442 	memset(req, 0, len);
443 	req->hbm_cmd = HOST_STOP_REQ_CMD;
444 	req->reason = DRIVER_STOP_REQUEST;
445 
446 	return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
447 }
448 
449 /**
450  * mei_hbm_cl_flow_control_req - sends flow control request.
451  *
452  * @dev: the device structure
453  * @cl: client info
454  *
455  * Return: -EIO on write failure
456  */
457 int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
458 {
459 	const size_t len = sizeof(struct hbm_flow_control);
460 
461 	cl_dbg(dev, cl, "sending flow control\n");
462 	return mei_hbm_cl_write(dev, cl, MEI_FLOW_CONTROL_CMD, len);
463 }
464 
465 /**
466  * mei_hbm_add_single_flow_creds - adds single buffer credentials.
467  *
468  * @dev: the device structure
469  * @flow: flow control.
470  *
471  * Return: 0 on success, < 0 otherwise
472  */
473 static int mei_hbm_add_single_flow_creds(struct mei_device *dev,
474 				  struct hbm_flow_control *flow)
475 {
476 	struct mei_me_client *me_cl;
477 	int rets;
478 
479 	me_cl = mei_me_cl_by_id(dev, flow->me_addr);
480 	if (!me_cl) {
481 		dev_err(dev->dev, "no such me client %d\n",
482 			flow->me_addr);
483 		return -ENOENT;
484 	}
485 
486 	if (WARN_ON(me_cl->props.single_recv_buf == 0)) {
487 		rets = -EINVAL;
488 		goto out;
489 	}
490 
491 	me_cl->mei_flow_ctrl_creds++;
492 	dev_dbg(dev->dev, "recv flow ctrl msg ME %d (single) creds = %d.\n",
493 	    flow->me_addr, me_cl->mei_flow_ctrl_creds);
494 
495 	rets = 0;
496 out:
497 	mei_me_cl_put(me_cl);
498 	return rets;
499 }
500 
501 /**
502  * mei_hbm_cl_flow_control_res - flow control response from me
503  *
504  * @dev: the device structure
505  * @flow_control: flow control response bus message
506  */
507 static void mei_hbm_cl_flow_control_res(struct mei_device *dev,
508 					struct hbm_flow_control *flow_control)
509 {
510 	struct mei_cl *cl;
511 
512 	if (!flow_control->host_addr) {
513 		/* single receive buffer */
514 		mei_hbm_add_single_flow_creds(dev, flow_control);
515 		return;
516 	}
517 
518 	cl = mei_hbm_cl_find_by_cmd(dev, flow_control);
519 	if (cl) {
520 		cl->mei_flow_ctrl_creds++;
521 		cl_dbg(dev, cl, "flow control creds = %d.\n",
522 				cl->mei_flow_ctrl_creds);
523 	}
524 }
525 
526 
527 /**
528  * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
529  *
530  * @dev: the device structure
531  * @cl: a client to disconnect from
532  *
533  * Return: -EIO on write failure
534  */
535 int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
536 {
537 	const size_t len = sizeof(struct hbm_client_connect_request);
538 
539 	return mei_hbm_cl_write(dev, cl, CLIENT_DISCONNECT_REQ_CMD, len);
540 }
541 
542 /**
543  * mei_hbm_cl_disconnect_rsp - sends disconnect respose to the FW
544  *
545  * @dev: the device structure
546  * @cl: a client to disconnect from
547  *
548  * Return: -EIO on write failure
549  */
550 int mei_hbm_cl_disconnect_rsp(struct mei_device *dev, struct mei_cl *cl)
551 {
552 	const size_t len = sizeof(struct hbm_client_connect_response);
553 
554 	return mei_hbm_cl_write(dev, cl, CLIENT_DISCONNECT_RES_CMD, len);
555 }
556 
557 /**
558  * mei_hbm_cl_disconnect_res - update the client state according
559  *       disconnect response
560  *
561  * @dev: the device structure
562  * @cl: mei host client
563  * @cmd: disconnect client response host bus message
564  */
565 static void mei_hbm_cl_disconnect_res(struct mei_device *dev, struct mei_cl *cl,
566 				      struct mei_hbm_cl_cmd *cmd)
567 {
568 	struct hbm_client_connect_response *rs =
569 		(struct hbm_client_connect_response *)cmd;
570 
571 	cl_dbg(dev, cl, "hbm: disconnect response status=%d\n", rs->status);
572 
573 	if (rs->status == MEI_CL_DISCONN_SUCCESS)
574 		cl->state = MEI_FILE_DISCONNECTED;
575 	cl->status = 0;
576 }
577 
578 /**
579  * mei_hbm_cl_connect_req - send connection request to specific me client
580  *
581  * @dev: the device structure
582  * @cl: a client to connect to
583  *
584  * Return: -EIO on write failure
585  */
586 int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
587 {
588 	const size_t len = sizeof(struct hbm_client_connect_request);
589 
590 	return mei_hbm_cl_write(dev, cl, CLIENT_CONNECT_REQ_CMD, len);
591 }
592 
593 /**
594  * mei_hbm_cl_connect_res - update the client state according
595  *        connection response
596  *
597  * @dev: the device structure
598  * @cl: mei host client
599  * @cmd: connect client response host bus message
600  */
601 static void mei_hbm_cl_connect_res(struct mei_device *dev, struct mei_cl *cl,
602 				   struct mei_hbm_cl_cmd *cmd)
603 {
604 	struct hbm_client_connect_response *rs =
605 		(struct hbm_client_connect_response *)cmd;
606 
607 	cl_dbg(dev, cl, "hbm: connect response status=%s\n",
608 			mei_cl_conn_status_str(rs->status));
609 
610 	if (rs->status == MEI_CL_CONN_SUCCESS)
611 		cl->state = MEI_FILE_CONNECTED;
612 	else
613 		cl->state = MEI_FILE_DISCONNECTED;
614 	cl->status = mei_cl_conn_status_to_errno(rs->status);
615 }
616 
617 /**
618  * mei_hbm_cl_res - process hbm response received on behalf
619  *         an client
620  *
621  * @dev: the device structure
622  * @rs:  hbm client message
623  * @fop_type: file operation type
624  */
625 static void mei_hbm_cl_res(struct mei_device *dev,
626 			   struct mei_hbm_cl_cmd *rs,
627 			   enum mei_cb_file_ops fop_type)
628 {
629 	struct mei_cl *cl;
630 	struct mei_cl_cb *cb, *next;
631 
632 	cl = NULL;
633 	list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
634 
635 		cl = cb->cl;
636 
637 		if (cb->fop_type != fop_type)
638 			continue;
639 
640 		if (mei_hbm_cl_addr_equal(cl, rs)) {
641 			list_del(&cb->list);
642 			break;
643 		}
644 	}
645 
646 	if (!cl)
647 		return;
648 
649 	switch (fop_type) {
650 	case MEI_FOP_CONNECT:
651 		mei_hbm_cl_connect_res(dev, cl, rs);
652 		break;
653 	case MEI_FOP_DISCONNECT:
654 		mei_hbm_cl_disconnect_res(dev, cl, rs);
655 		break;
656 	default:
657 		return;
658 	}
659 
660 	cl->timer_count = 0;
661 	wake_up(&cl->wait);
662 }
663 
664 
665 /**
666  * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
667  *  host sends disconnect response
668  *
669  * @dev: the device structure.
670  * @disconnect_req: disconnect request bus message from the me
671  *
672  * Return: -ENOMEM on allocation failure
673  */
674 static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
675 		struct hbm_client_connect_request *disconnect_req)
676 {
677 	struct mei_cl *cl;
678 	struct mei_cl_cb *cb;
679 
680 	cl = mei_hbm_cl_find_by_cmd(dev, disconnect_req);
681 	if (cl) {
682 		cl_dbg(dev, cl, "disconnect request received\n");
683 		cl->state = MEI_FILE_DISCONNECTED;
684 		cl->timer_count = 0;
685 
686 		cb = mei_io_cb_init(cl, NULL);
687 		if (!cb)
688 			return -ENOMEM;
689 		cb->fop_type = MEI_FOP_DISCONNECT_RSP;
690 		cl_dbg(dev, cl, "add disconnect response as first\n");
691 		list_add(&cb->list, &dev->ctrl_wr_list.list);
692 	}
693 	return 0;
694 }
695 
696 /**
697  * mei_hbm_config_features - check what hbm features and commands
698  *        are supported by the fw
699  *
700  * @dev: the device structure
701  */
702 static void mei_hbm_config_features(struct mei_device *dev)
703 {
704 	/* Power Gating Isolation Support */
705 	dev->hbm_f_pg_supported = 0;
706 	if (dev->version.major_version > HBM_MAJOR_VERSION_PGI)
707 		dev->hbm_f_pg_supported = 1;
708 
709 	if (dev->version.major_version == HBM_MAJOR_VERSION_PGI &&
710 	    dev->version.minor_version >= HBM_MINOR_VERSION_PGI)
711 		dev->hbm_f_pg_supported = 1;
712 }
713 
714 /**
715  * mei_hbm_version_is_supported - checks whether the driver can
716  *     support the hbm version of the device
717  *
718  * @dev: the device structure
719  * Return: true if driver can support hbm version of the device
720  */
721 bool mei_hbm_version_is_supported(struct mei_device *dev)
722 {
723 	return	(dev->version.major_version < HBM_MAJOR_VERSION) ||
724 		(dev->version.major_version == HBM_MAJOR_VERSION &&
725 		 dev->version.minor_version <= HBM_MINOR_VERSION);
726 }
727 
728 /**
729  * mei_hbm_dispatch - bottom half read routine after ISR to
730  * handle the read bus message cmd processing.
731  *
732  * @dev: the device structure
733  * @hdr: header of bus message
734  *
735  * Return: 0 on success and < 0 on failure
736  */
737 int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
738 {
739 	struct mei_bus_message *mei_msg;
740 	struct hbm_host_version_response *version_res;
741 	struct hbm_props_response *props_res;
742 	struct hbm_host_enum_response *enum_res;
743 
744 	struct mei_hbm_cl_cmd *cl_cmd;
745 	struct hbm_client_connect_request *disconnect_req;
746 	struct hbm_flow_control *flow_control;
747 
748 	/* read the message to our buffer */
749 	BUG_ON(hdr->length >= sizeof(dev->rd_msg_buf));
750 	mei_read_slots(dev, dev->rd_msg_buf, hdr->length);
751 	mei_msg = (struct mei_bus_message *)dev->rd_msg_buf;
752 	cl_cmd  = (struct mei_hbm_cl_cmd *)mei_msg;
753 
754 	/* ignore spurious message and prevent reset nesting
755 	 * hbm is put to idle during system reset
756 	 */
757 	if (dev->hbm_state == MEI_HBM_IDLE) {
758 		dev_dbg(dev->dev, "hbm: state is idle ignore spurious messages\n");
759 		return 0;
760 	}
761 
762 	switch (mei_msg->hbm_cmd) {
763 	case HOST_START_RES_CMD:
764 		dev_dbg(dev->dev, "hbm: start: response message received.\n");
765 
766 		dev->init_clients_timer = 0;
767 
768 		version_res = (struct hbm_host_version_response *)mei_msg;
769 
770 		dev_dbg(dev->dev, "HBM VERSION: DRIVER=%02d:%02d DEVICE=%02d:%02d\n",
771 				HBM_MAJOR_VERSION, HBM_MINOR_VERSION,
772 				version_res->me_max_version.major_version,
773 				version_res->me_max_version.minor_version);
774 
775 		if (version_res->host_version_supported) {
776 			dev->version.major_version = HBM_MAJOR_VERSION;
777 			dev->version.minor_version = HBM_MINOR_VERSION;
778 		} else {
779 			dev->version.major_version =
780 				version_res->me_max_version.major_version;
781 			dev->version.minor_version =
782 				version_res->me_max_version.minor_version;
783 		}
784 
785 		if (!mei_hbm_version_is_supported(dev)) {
786 			dev_warn(dev->dev, "hbm: start: version mismatch - stopping the driver.\n");
787 
788 			dev->hbm_state = MEI_HBM_STOPPED;
789 			if (mei_hbm_stop_req(dev)) {
790 				dev_err(dev->dev, "hbm: start: failed to send stop request\n");
791 				return -EIO;
792 			}
793 			break;
794 		}
795 
796 		mei_hbm_config_features(dev);
797 
798 		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
799 		    dev->hbm_state != MEI_HBM_STARTING) {
800 			dev_err(dev->dev, "hbm: start: state mismatch, [%d, %d]\n",
801 				dev->dev_state, dev->hbm_state);
802 			return -EPROTO;
803 		}
804 
805 		if (mei_hbm_enum_clients_req(dev)) {
806 			dev_err(dev->dev, "hbm: start: failed to send enumeration request\n");
807 			return -EIO;
808 		}
809 
810 		wake_up(&dev->wait_hbm_start);
811 		break;
812 
813 	case CLIENT_CONNECT_RES_CMD:
814 		dev_dbg(dev->dev, "hbm: client connect response: message received.\n");
815 		mei_hbm_cl_res(dev, cl_cmd, MEI_FOP_CONNECT);
816 		break;
817 
818 	case CLIENT_DISCONNECT_RES_CMD:
819 		dev_dbg(dev->dev, "hbm: client disconnect response: message received.\n");
820 		mei_hbm_cl_res(dev, cl_cmd, MEI_FOP_DISCONNECT);
821 		break;
822 
823 	case MEI_FLOW_CONTROL_CMD:
824 		dev_dbg(dev->dev, "hbm: client flow control response: message received.\n");
825 
826 		flow_control = (struct hbm_flow_control *) mei_msg;
827 		mei_hbm_cl_flow_control_res(dev, flow_control);
828 		break;
829 
830 	case MEI_PG_ISOLATION_ENTRY_RES_CMD:
831 		dev_dbg(dev->dev, "power gate isolation entry response received\n");
832 		dev->pg_event = MEI_PG_EVENT_RECEIVED;
833 		if (waitqueue_active(&dev->wait_pg))
834 			wake_up(&dev->wait_pg);
835 		break;
836 
837 	case MEI_PG_ISOLATION_EXIT_REQ_CMD:
838 		dev_dbg(dev->dev, "power gate isolation exit request received\n");
839 		dev->pg_event = MEI_PG_EVENT_RECEIVED;
840 		if (waitqueue_active(&dev->wait_pg))
841 			wake_up(&dev->wait_pg);
842 		else
843 			/*
844 			* If the driver is not waiting on this then
845 			* this is HW initiated exit from PG.
846 			* Start runtime pm resume sequence to exit from PG.
847 			*/
848 			pm_request_resume(dev->dev);
849 		break;
850 
851 	case HOST_CLIENT_PROPERTIES_RES_CMD:
852 		dev_dbg(dev->dev, "hbm: properties response: message received.\n");
853 
854 		dev->init_clients_timer = 0;
855 
856 		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
857 		    dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
858 			dev_err(dev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
859 				dev->dev_state, dev->hbm_state);
860 			return -EPROTO;
861 		}
862 
863 		props_res = (struct hbm_props_response *)mei_msg;
864 
865 		if (props_res->status) {
866 			dev_err(dev->dev, "hbm: properties response: wrong status = %d %s\n",
867 				props_res->status,
868 				mei_hbm_status_str(props_res->status));
869 			return -EPROTO;
870 		}
871 
872 		mei_hbm_me_cl_add(dev, props_res);
873 
874 		dev->me_client_index++;
875 
876 		/* request property for the next client */
877 		if (mei_hbm_prop_req(dev))
878 			return -EIO;
879 
880 		break;
881 
882 	case HOST_ENUM_RES_CMD:
883 		dev_dbg(dev->dev, "hbm: enumeration response: message received\n");
884 
885 		dev->init_clients_timer = 0;
886 
887 		enum_res = (struct hbm_host_enum_response *) mei_msg;
888 		BUILD_BUG_ON(sizeof(dev->me_clients_map)
889 				< sizeof(enum_res->valid_addresses));
890 		memcpy(dev->me_clients_map, enum_res->valid_addresses,
891 				sizeof(enum_res->valid_addresses));
892 
893 		if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
894 		    dev->hbm_state != MEI_HBM_ENUM_CLIENTS) {
895 			dev_err(dev->dev, "hbm: enumeration response: state mismatch, [%d, %d]\n",
896 				dev->dev_state, dev->hbm_state);
897 			return -EPROTO;
898 		}
899 
900 		dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;
901 
902 		/* first property request */
903 		if (mei_hbm_prop_req(dev))
904 			return -EIO;
905 
906 		break;
907 
908 	case HOST_STOP_RES_CMD:
909 		dev_dbg(dev->dev, "hbm: stop response: message received\n");
910 
911 		dev->init_clients_timer = 0;
912 
913 		if (dev->hbm_state != MEI_HBM_STOPPED) {
914 			dev_err(dev->dev, "hbm: stop response: state mismatch, [%d, %d]\n",
915 				dev->dev_state, dev->hbm_state);
916 			return -EPROTO;
917 		}
918 
919 		dev->dev_state = MEI_DEV_POWER_DOWN;
920 		dev_info(dev->dev, "hbm: stop response: resetting.\n");
921 		/* force the reset */
922 		return -EPROTO;
923 		break;
924 
925 	case CLIENT_DISCONNECT_REQ_CMD:
926 		dev_dbg(dev->dev, "hbm: disconnect request: message received\n");
927 
928 		disconnect_req = (struct hbm_client_connect_request *)mei_msg;
929 		mei_hbm_fw_disconnect_req(dev, disconnect_req);
930 		break;
931 
932 	case ME_STOP_REQ_CMD:
933 		dev_dbg(dev->dev, "hbm: stop request: message received\n");
934 		dev->hbm_state = MEI_HBM_STOPPED;
935 		if (mei_hbm_stop_req(dev)) {
936 			dev_err(dev->dev, "hbm: stop request: failed to send stop request\n");
937 			return -EIO;
938 		}
939 		break;
940 	default:
941 		BUG();
942 		break;
943 
944 	}
945 	return 0;
946 }
947 
948