blob: d4dba639db3712af082266fa36edfc6a9a6394c0 [file] [log] [blame]
Tomas Winklerbb1b0132012-12-25 19:06:07 +02001/*
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
Tomas Winkler4fcbc992014-03-18 22:51:55 +020017#include <linux/export.h>
Tomas Winklerbb1b0132012-12-25 19:06:07 +020018#include <linux/sched.h>
19#include <linux/wait.h>
Tomas Winkler180ea052014-03-18 22:52:02 +020020#include <linux/pm_runtime.h>
Tomas Winkler1f180352014-09-29 16:31:46 +030021#include <linux/slab.h>
22
23#include <linux/mei.h>
Tomas Winklerbb1b0132012-12-25 19:06:07 +020024
25#include "mei_dev.h"
Tomas Winkler0edb23f2013-01-08 23:07:12 +020026#include "hbm.h"
Alexander Usyskin12d00662014-02-17 15:13:23 +020027#include "client.h"
Tomas Winklerbb1b0132012-12-25 19:06:07 +020028
Tomas Winkler89778d62014-08-21 14:29:16 +030029static 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
Alexander Usyskin285e2992014-02-17 15:13:20 +020046static 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
Alexander Usyskin1beeb4b2014-09-29 16:31:33 +030060const 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
Alexander Usyskin285e2992014-02-17 15:13:20 +020076/**
77 * mei_cl_conn_status_to_errno - convert client connect response
78 * status to error code
79 *
80 * @status: client connect response status
81 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +030082 * Return: corresponding error code
Alexander Usyskin285e2992014-02-17 15:13:20 +020083 */
84static 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
Tomas Winklerbb1b0132012-12-25 19:06:07 +020096/**
Tomas Winkler84b32942014-05-07 16:51:28 +030097 * mei_hbm_idle - set hbm to idle state
98 *
99 * @dev: the device structure
100 */
101void 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 */
112void mei_hbm_reset(struct mei_device *dev)
113{
Tomas Winkler84b32942014-05-07 16:51:28 +0300114 dev->me_client_index = 0;
115
Tomas Winkler79563db2015-01-11 00:07:16 +0200116 mei_me_cl_rm_all(dev);
Tomas Winkler84b32942014-05-07 16:51:28 +0300117
118 mei_hbm_idle(dev);
119}
120
121/**
Tomas Winkler2190fe22014-09-29 16:31:40 +0300122 * mei_hbm_hdr - construct hbm header
123 *
124 * @hdr: hbm header
125 * @length: payload length
126 */
127
128static 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/**
Tomas Winklercd51ed62012-12-25 19:06:09 +0200138 * mei_hbm_cl_hdr - construct client hbm header
Masanari Iida393b1482013-04-05 01:05:05 +0900139 *
Tomas Winkler68d1aa62014-08-21 14:29:11 +0300140 * @cl: client
Tomas Winklercd51ed62012-12-25 19:06:09 +0200141 * @hbm_cmd: host bus message command
142 * @buf: buffer for cl header
143 * @len: buffer length
144 */
145static inline
146void 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;
Alexander Usyskin1df629e2015-05-04 09:43:56 +0300153 cmd->host_addr = mei_cl_host_addr(cl);
Alexander Usyskind49ed642015-05-04 09:43:54 +0300154 cmd->me_addr = mei_cl_me_id(cl);
Tomas Winklercd51ed62012-12-25 19:06:09 +0200155}
156
157/**
Tomas Winkler68d1aa62014-08-21 14:29:11 +0300158 * 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
Alexander Usyskince231392014-09-29 16:31:50 +0300164 *
165 * Return: 0 on success, <0 on failure.
Tomas Winkler68d1aa62014-08-21 14:29:11 +0300166 */
167static inline
168int 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/**
Tomas Winkler2af89db2014-08-21 14:29:20 +0300180 * mei_hbm_cl_addr_equal - check if the client's and
181 * the message address match
Tomas Winklercd51ed62012-12-25 19:06:09 +0200182 *
Tomas Winkler2af89db2014-08-21 14:29:20 +0300183 * @cl: client
184 * @cmd: hbm client message
Tomas Winklercd51ed62012-12-25 19:06:09 +0200185 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300186 * Return: true if addresses are the same
Tomas Winklercd51ed62012-12-25 19:06:09 +0200187 */
188static inline
Tomas Winkler2af89db2014-08-21 14:29:20 +0300189bool mei_hbm_cl_addr_equal(struct mei_cl *cl, struct mei_hbm_cl_cmd *cmd)
Tomas Winklercd51ed62012-12-25 19:06:09 +0200190{
Alexander Usyskin1df629e2015-05-04 09:43:56 +0300191 return mei_cl_host_addr(cl) == cmd->host_addr &&
Alexander Usyskind49ed642015-05-04 09:43:54 +0300192 mei_cl_me_id(cl) == cmd->me_addr;
Tomas Winklercd51ed62012-12-25 19:06:09 +0200193}
194
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300195/**
Tomas Winkler2af89db2014-08-21 14:29:20 +0300196 * mei_hbm_cl_find_by_cmd - find recipient client
197 *
198 * @dev: the device structure
199 * @buf: a buffer with hbm cl command
200 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300201 * Return: the recipient client or NULL if not found
Tomas Winkler2af89db2014-08-21 14:29:20 +0300202 */
203static inline
204struct 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/**
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300217 * mei_hbm_start_wait - wait for start response message.
218 *
219 * @dev: the device structure
220 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300221 * Return: 0 on success and < 0 on failure
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300222 */
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300223int mei_hbm_start_wait(struct mei_device *dev)
224{
225 int ret;
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300226
227 if (dev->hbm_state > MEI_HBM_STARTING)
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300228 return 0;
229
230 mutex_unlock(&dev->device_lock);
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300231 ret = wait_event_timeout(dev->wait_hbm_start,
232 dev->hbm_state != MEI_HBM_STARTING,
Tomas Winkler7d93e582014-01-14 23:10:10 +0200233 mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300234 mutex_lock(&dev->device_lock);
235
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300236 if (ret == 0 && (dev->hbm_state <= MEI_HBM_STARTING)) {
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300237 dev->hbm_state = MEI_HBM_IDLE;
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300238 dev_err(dev->dev, "waiting for mei start failed\n");
Alexander Usyskin7ca96aa2014-02-19 17:35:49 +0200239 return -ETIME;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300240 }
241 return 0;
242}
243
Tomas Winkler6bbda152012-12-25 19:06:12 +0200244/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200245 * mei_hbm_start_req - sends start request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200246 *
247 * @dev: the device structure
Tomas Winkler544f9462014-01-08 20:19:21 +0200248 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300249 * Return: 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200250 */
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300251int mei_hbm_start_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200252{
Tomas Winklere46f1872012-12-25 19:06:10 +0200253 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200254 struct hbm_host_version_request *start_req;
255 const size_t len = sizeof(struct hbm_host_version_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200256 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200257
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300258 mei_hbm_reset(dev);
259
Tomas Winklere46f1872012-12-25 19:06:10 +0200260 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200261
262 /* host start message */
Tomas Winklere46f1872012-12-25 19:06:10 +0200263 start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200264 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
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300269 dev->hbm_state = MEI_HBM_IDLE;
Tomas Winkler544f9462014-01-08 20:19:21 +0200270 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
271 if (ret) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300272 dev_err(dev->dev, "version message write failed: ret = %d\n",
Tomas Winkler544f9462014-01-08 20:19:21 +0200273 ret);
274 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200275 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200276
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300277 dev->hbm_state = MEI_HBM_STARTING;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200278 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300279 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200280}
281
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300282/*
Tomas Winkler8120e722012-12-25 19:06:11 +0200283 * mei_hbm_enum_clients_req - sends enumeration client request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200284 *
285 * @dev: the device structure
286 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300287 * Return: 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200288 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200289static int mei_hbm_enum_clients_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200290{
Tomas Winklere46f1872012-12-25 19:06:10 +0200291 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200292 struct hbm_host_enum_request *enum_req;
293 const size_t len = sizeof(struct hbm_host_enum_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200294 int ret;
295
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200296 /* enumerate clients */
Tomas Winklere46f1872012-12-25 19:06:10 +0200297 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200298
Tomas Winklere46f1872012-12-25 19:06:10 +0200299 enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
300 memset(enum_req, 0, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200301 enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
Tomas Winkler70ef8352015-07-23 21:37:12 +0300302 enum_req->allow_add = dev->hbm_f_dc_supported;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200303
Tomas Winkler544f9462014-01-08 20:19:21 +0200304 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
305 if (ret) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300306 dev_err(dev->dev, "enumeration request write failed: ret = %d.\n",
Tomas Winkler544f9462014-01-08 20:19:21 +0200307 ret);
308 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200309 }
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300310 dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200311 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler544f9462014-01-08 20:19:21 +0200312 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200313}
314
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300315/*
316 * mei_hbm_me_cl_add - add new me client to the list
317 *
318 * @dev: the device structure
319 * @res: hbm property response
320 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300321 * Return: 0 on success and -ENOMEM on allocation failure
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300322 */
323
324static int mei_hbm_me_cl_add(struct mei_device *dev,
325 struct hbm_props_response *res)
326{
327 struct mei_me_client *me_cl;
Tomas Winkler79563db2015-01-11 00:07:16 +0200328 const uuid_le *uuid = &res->client_properties.protocol_name;
329
330 mei_me_cl_rm_by_uuid(dev, uuid);
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300331
332 me_cl = kzalloc(sizeof(struct mei_me_client), GFP_KERNEL);
333 if (!me_cl)
334 return -ENOMEM;
335
Tomas Winkler79563db2015-01-11 00:07:16 +0200336 mei_me_cl_init(me_cl);
337
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300338 me_cl->props = res->client_properties;
339 me_cl->client_id = res->me_addr;
340 me_cl->mei_flow_ctrl_creds = 0;
341
Tomas Winklerb7d88512015-02-10 10:39:31 +0200342 mei_me_cl_add(dev, me_cl);
343
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300344 return 0;
345}
346
Tomas Winkler8120e722012-12-25 19:06:11 +0200347/**
Tomas Winkler70ef8352015-07-23 21:37:12 +0300348 * mei_hbm_add_cl_resp - send response to fw on client add request
349 *
350 * @dev: the device structure
351 * @addr: me address
352 * @status: response status
353 *
354 * Return: 0 on success and < 0 on failure
355 */
356static int mei_hbm_add_cl_resp(struct mei_device *dev, u8 addr, u8 status)
357{
358 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
359 struct hbm_add_client_response *resp;
360 const size_t len = sizeof(struct hbm_add_client_response);
361 int ret;
362
363 dev_dbg(dev->dev, "adding client response\n");
364
365 resp = (struct hbm_add_client_response *)dev->wr_msg.data;
366
367 mei_hbm_hdr(mei_hdr, len);
368 memset(resp, 0, sizeof(struct hbm_add_client_response));
369
370 resp->hbm_cmd = MEI_HBM_ADD_CLIENT_RES_CMD;
371 resp->me_addr = addr;
372 resp->status = status;
373
374 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
375 if (ret)
376 dev_err(dev->dev, "add client response write failed: ret = %d\n",
377 ret);
378 return ret;
379}
380
381/**
382 * mei_hbm_fw_add_cl_req - request from the fw to add a client
383 *
384 * @dev: the device structure
385 * @req: add client request
386 *
387 * Return: 0 on success and < 0 on failure
388 */
389static int mei_hbm_fw_add_cl_req(struct mei_device *dev,
390 struct hbm_add_client_request *req)
391{
392 int ret;
393 u8 status = MEI_HBMS_SUCCESS;
394
395 BUILD_BUG_ON(sizeof(struct hbm_add_client_request) !=
396 sizeof(struct hbm_props_response));
397
398 ret = mei_hbm_me_cl_add(dev, (struct hbm_props_response *)req);
399 if (ret)
400 status = !MEI_HBMS_SUCCESS;
401
402 return mei_hbm_add_cl_resp(dev, req->me_addr, status);
403}
404
405/**
Masanari Iida393b1482013-04-05 01:05:05 +0900406 * mei_hbm_prop_req - request property for a single client
Tomas Winkler8120e722012-12-25 19:06:11 +0200407 *
408 * @dev: the device structure
409 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300410 * Return: 0 on success and < 0 on failure
Tomas Winkler8120e722012-12-25 19:06:11 +0200411 */
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200412
Tomas Winkler8120e722012-12-25 19:06:11 +0200413static int mei_hbm_prop_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200414{
415
Tomas Winklere46f1872012-12-25 19:06:10 +0200416 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200417 struct hbm_props_request *prop_req;
418 const size_t len = sizeof(struct hbm_props_request);
419 unsigned long next_client_index;
Tomas Winkler544f9462014-01-08 20:19:21 +0200420 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200421
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200422 next_client_index = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX,
423 dev->me_client_index);
424
425 /* We got all client properties */
426 if (next_client_index == MEI_CLIENTS_MAX) {
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300427 dev->hbm_state = MEI_HBM_STARTED;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200428 schedule_work(&dev->init_work);
429
430 return 0;
431 }
432
Tomas Winklere46f1872012-12-25 19:06:10 +0200433 mei_hbm_hdr(mei_hdr, len);
434 prop_req = (struct hbm_props_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200435
436 memset(prop_req, 0, sizeof(struct hbm_props_request));
437
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200438 prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
Tomas Winkler3438c1f2014-08-21 14:29:10 +0300439 prop_req->me_addr = next_client_index;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200440
Tomas Winkler544f9462014-01-08 20:19:21 +0200441 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
442 if (ret) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300443 dev_err(dev->dev, "properties request write failed: ret = %d\n",
Tomas Winkler544f9462014-01-08 20:19:21 +0200444 ret);
445 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200446 }
447
448 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
449 dev->me_client_index = next_client_index;
450
451 return 0;
452}
453
Tomas Winkler4fcbc992014-03-18 22:51:55 +0200454/*
455 * mei_hbm_pg - sends pg command
456 *
457 * @dev: the device structure
458 * @pg_cmd: the pg command code
459 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300460 * Return: -EIO on write failure
Tomas Winklerbae1cc72014-08-21 14:29:21 +0300461 * -EOPNOTSUPP if the operation is not supported by the protocol
Tomas Winkler4fcbc992014-03-18 22:51:55 +0200462 */
463int mei_hbm_pg(struct mei_device *dev, u8 pg_cmd)
464{
465 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
466 struct hbm_power_gate *req;
467 const size_t len = sizeof(struct hbm_power_gate);
468 int ret;
469
Tomas Winklerbae1cc72014-08-21 14:29:21 +0300470 if (!dev->hbm_f_pg_supported)
471 return -EOPNOTSUPP;
472
Tomas Winkler4fcbc992014-03-18 22:51:55 +0200473 mei_hbm_hdr(mei_hdr, len);
474
475 req = (struct hbm_power_gate *)dev->wr_msg.data;
476 memset(req, 0, len);
477 req->hbm_cmd = pg_cmd;
478
479 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
480 if (ret)
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300481 dev_err(dev->dev, "power gate command write failed.\n");
Tomas Winkler4fcbc992014-03-18 22:51:55 +0200482 return ret;
483}
484EXPORT_SYMBOL_GPL(mei_hbm_pg);
485
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200486/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200487 * mei_hbm_stop_req - send stop request message
Tomas Winklere46f1872012-12-25 19:06:10 +0200488 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300489 * @dev: mei device
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200490 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300491 * Return: -EIO on write failure
Tomas Winklere46f1872012-12-25 19:06:10 +0200492 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200493static int mei_hbm_stop_req(struct mei_device *dev)
Tomas Winklere46f1872012-12-25 19:06:10 +0200494{
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200495 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklere46f1872012-12-25 19:06:10 +0200496 struct hbm_host_stop_request *req =
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200497 (struct hbm_host_stop_request *)dev->wr_msg.data;
Tomas Winklere46f1872012-12-25 19:06:10 +0200498 const size_t len = sizeof(struct hbm_host_stop_request);
499
500 mei_hbm_hdr(mei_hdr, len);
501
502 memset(req, 0, len);
503 req->hbm_cmd = HOST_STOP_REQ_CMD;
504 req->reason = DRIVER_STOP_REQUEST;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200505
506 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklere46f1872012-12-25 19:06:10 +0200507}
508
509/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200510 * mei_hbm_cl_flow_control_req - sends flow control request.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200511 *
512 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200513 * @cl: client info
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200514 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300515 * Return: -EIO on write failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200516 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200517int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200518{
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200519 const size_t len = sizeof(struct hbm_flow_control);
Tomas Winkler92db1552014-09-29 16:31:37 +0300520
Tomas Winkler46922182014-03-16 14:35:55 +0200521 cl_dbg(dev, cl, "sending flow control\n");
Tomas Winkler68d1aa62014-08-21 14:29:11 +0300522 return mei_hbm_cl_write(dev, cl, MEI_FLOW_CONTROL_CMD, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200523}
524
525/**
Masanari Iida393b1482013-04-05 01:05:05 +0900526 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
Tomas Winkler6bbda152012-12-25 19:06:12 +0200527 *
Masanari Iida393b1482013-04-05 01:05:05 +0900528 * @dev: the device structure
Tomas Winkler6bbda152012-12-25 19:06:12 +0200529 * @flow: flow control.
Alexander Usyskin12d00662014-02-17 15:13:23 +0200530 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300531 * Return: 0 on success, < 0 otherwise
Tomas Winkler6bbda152012-12-25 19:06:12 +0200532 */
Alexander Usyskin12d00662014-02-17 15:13:23 +0200533static int mei_hbm_add_single_flow_creds(struct mei_device *dev,
Tomas Winkler6bbda152012-12-25 19:06:12 +0200534 struct hbm_flow_control *flow)
535{
Alexander Usyskin12d00662014-02-17 15:13:23 +0200536 struct mei_me_client *me_cl;
Tomas Winkler79563db2015-01-11 00:07:16 +0200537 int rets;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200538
Tomas Winklerd3208322014-08-24 12:08:55 +0300539 me_cl = mei_me_cl_by_id(dev, flow->me_addr);
540 if (!me_cl) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300541 dev_err(dev->dev, "no such me client %d\n",
Alexander Usyskin12d00662014-02-17 15:13:23 +0200542 flow->me_addr);
Tomas Winklerd3208322014-08-24 12:08:55 +0300543 return -ENOENT;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200544 }
Alexander Usyskin12d00662014-02-17 15:13:23 +0200545
Tomas Winkler79563db2015-01-11 00:07:16 +0200546 if (WARN_ON(me_cl->props.single_recv_buf == 0)) {
547 rets = -EINVAL;
548 goto out;
549 }
Tomas Winklerd3208322014-08-24 12:08:55 +0300550
551 me_cl->mei_flow_ctrl_creds++;
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300552 dev_dbg(dev->dev, "recv flow ctrl msg ME %d (single) creds = %d.\n",
Tomas Winklerd3208322014-08-24 12:08:55 +0300553 flow->me_addr, me_cl->mei_flow_ctrl_creds);
Alexander Usyskin12d00662014-02-17 15:13:23 +0200554
Tomas Winkler79563db2015-01-11 00:07:16 +0200555 rets = 0;
556out:
557 mei_me_cl_put(me_cl);
558 return rets;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200559}
560
561/**
562 * mei_hbm_cl_flow_control_res - flow control response from me
563 *
564 * @dev: the device structure
565 * @flow_control: flow control response bus message
566 */
567static void mei_hbm_cl_flow_control_res(struct mei_device *dev,
Tomas Winkler2af89db2014-08-21 14:29:20 +0300568 struct hbm_flow_control *flow_control)
Tomas Winkler6bbda152012-12-25 19:06:12 +0200569{
Tomas Winkler31f88f52014-02-17 15:13:25 +0200570 struct mei_cl *cl;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200571
572 if (!flow_control->host_addr) {
573 /* single receive buffer */
574 mei_hbm_add_single_flow_creds(dev, flow_control);
575 return;
576 }
577
Tomas Winkler2af89db2014-08-21 14:29:20 +0300578 cl = mei_hbm_cl_find_by_cmd(dev, flow_control);
579 if (cl) {
580 cl->mei_flow_ctrl_creds++;
581 cl_dbg(dev, cl, "flow control creds = %d.\n",
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300582 cl->mei_flow_ctrl_creds);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200583 }
584}
585
586
587/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200588 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200589 *
590 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200591 * @cl: a client to disconnect from
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200592 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300593 * Return: -EIO on write failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200594 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200595int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200596{
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200597 const size_t len = sizeof(struct hbm_client_connect_request);
Tomas Winkler92db1552014-09-29 16:31:37 +0300598
Tomas Winkler68d1aa62014-08-21 14:29:11 +0300599 return mei_hbm_cl_write(dev, cl, CLIENT_DISCONNECT_REQ_CMD, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200600}
601
602/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200603 * mei_hbm_cl_disconnect_rsp - sends disconnect respose to the FW
604 *
605 * @dev: the device structure
606 * @cl: a client to disconnect from
607 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300608 * Return: -EIO on write failure
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200609 */
610int mei_hbm_cl_disconnect_rsp(struct mei_device *dev, struct mei_cl *cl)
611{
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200612 const size_t len = sizeof(struct hbm_client_connect_response);
Tomas Winkler92db1552014-09-29 16:31:37 +0300613
Tomas Winkler68d1aa62014-08-21 14:29:11 +0300614 return mei_hbm_cl_write(dev, cl, CLIENT_DISCONNECT_RES_CMD, len);
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200615}
616
617/**
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300618 * mei_hbm_cl_disconnect_res - update the client state according
619 * disconnect response
Tomas Winkler6bbda152012-12-25 19:06:12 +0200620 *
Alexander Usyskind512c202014-10-29 23:50:58 +0200621 * @dev: the device structure
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300622 * @cl: mei host client
623 * @cmd: disconnect client response host bus message
Tomas Winkler6bbda152012-12-25 19:06:12 +0200624 */
Alexander Usyskind512c202014-10-29 23:50:58 +0200625static void mei_hbm_cl_disconnect_res(struct mei_device *dev, struct mei_cl *cl,
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300626 struct mei_hbm_cl_cmd *cmd)
Tomas Winkler6bbda152012-12-25 19:06:12 +0200627{
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300628 struct hbm_client_connect_response *rs =
629 (struct hbm_client_connect_response *)cmd;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200630
Alexander Usyskind512c202014-10-29 23:50:58 +0200631 cl_dbg(dev, cl, "hbm: disconnect response status=%d\n", rs->status);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200632
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300633 if (rs->status == MEI_CL_DISCONN_SUCCESS)
Tomas Winkler3c666182015-05-04 09:43:52 +0300634 cl->state = MEI_FILE_DISCONNECT_REPLY;
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300635 cl->status = 0;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200636}
637
638/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200639 * mei_hbm_cl_connect_req - send connection request to specific me client
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200640 *
641 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200642 * @cl: a client to connect to
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200643 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300644 * Return: -EIO on write failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200645 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200646int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200647{
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200648 const size_t len = sizeof(struct hbm_client_connect_request);
Tomas Winkler92db1552014-09-29 16:31:37 +0300649
Tomas Winkler68d1aa62014-08-21 14:29:11 +0300650 return mei_hbm_cl_write(dev, cl, CLIENT_CONNECT_REQ_CMD, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200651}
652
653/**
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300654 * mei_hbm_cl_connect_res - update the client state according
655 * connection response
Tomas Winkler6bbda152012-12-25 19:06:12 +0200656 *
Alexander Usyskind512c202014-10-29 23:50:58 +0200657 * @dev: the device structure
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300658 * @cl: mei host client
659 * @cmd: connect client response host bus message
Tomas Winkler6bbda152012-12-25 19:06:12 +0200660 */
Alexander Usyskind512c202014-10-29 23:50:58 +0200661static void mei_hbm_cl_connect_res(struct mei_device *dev, struct mei_cl *cl,
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300662 struct mei_hbm_cl_cmd *cmd)
Tomas Winkler6bbda152012-12-25 19:06:12 +0200663{
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300664 struct hbm_client_connect_response *rs =
665 (struct hbm_client_connect_response *)cmd;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200666
Alexander Usyskind512c202014-10-29 23:50:58 +0200667 cl_dbg(dev, cl, "hbm: connect response status=%s\n",
Alexander Usyskin285e2992014-02-17 15:13:20 +0200668 mei_cl_conn_status_str(rs->status));
Tomas Winkler6bbda152012-12-25 19:06:12 +0200669
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300670 if (rs->status == MEI_CL_CONN_SUCCESS)
671 cl->state = MEI_FILE_CONNECTED;
Tomas Winkler70ef8352015-07-23 21:37:12 +0300672 else {
Tomas Winkler3c666182015-05-04 09:43:52 +0300673 cl->state = MEI_FILE_DISCONNECT_REPLY;
Tomas Winkler70ef8352015-07-23 21:37:12 +0300674 if (rs->status == MEI_CL_CONN_NOT_FOUND)
675 mei_me_cl_del(dev, cl->me_cl);
676 }
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300677 cl->status = mei_cl_conn_status_to_errno(rs->status);
678}
Tomas Winkler6bbda152012-12-25 19:06:12 +0200679
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300680/**
681 * mei_hbm_cl_res - process hbm response received on behalf
682 * an client
683 *
684 * @dev: the device structure
685 * @rs: hbm client message
686 * @fop_type: file operation type
687 */
688static void mei_hbm_cl_res(struct mei_device *dev,
689 struct mei_hbm_cl_cmd *rs,
690 enum mei_cb_file_ops fop_type)
691{
692 struct mei_cl *cl;
693 struct mei_cl_cb *cb, *next;
694
695 cl = NULL;
Tomas Winkler64092852014-02-17 15:13:21 +0200696 list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
Tomas Winkler6bbda152012-12-25 19:06:12 +0200697
Tomas Winkler64092852014-02-17 15:13:21 +0200698 cl = cb->cl;
Tomas Winkler64092852014-02-17 15:13:21 +0200699
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300700 if (cb->fop_type != fop_type)
Tomas Winkler64092852014-02-17 15:13:21 +0200701 continue;
702
703 if (mei_hbm_cl_addr_equal(cl, rs)) {
Tomas Winkler928fa662015-02-10 10:39:45 +0200704 list_del_init(&cb->list);
Tomas Winkler64092852014-02-17 15:13:21 +0200705 break;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200706 }
707 }
Tomas Winkler64092852014-02-17 15:13:21 +0200708
709 if (!cl)
710 return;
711
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300712 switch (fop_type) {
713 case MEI_FOP_CONNECT:
Alexander Usyskind512c202014-10-29 23:50:58 +0200714 mei_hbm_cl_connect_res(dev, cl, rs);
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300715 break;
716 case MEI_FOP_DISCONNECT:
Alexander Usyskind512c202014-10-29 23:50:58 +0200717 mei_hbm_cl_disconnect_res(dev, cl, rs);
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300718 break;
719 default:
720 return;
721 }
722
Tomas Winkler64092852014-02-17 15:13:21 +0200723 cl->timer_count = 0;
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300724 wake_up(&cl->wait);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200725}
726
727
728/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200729 * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
730 * host sends disconnect response
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200731 *
732 * @dev: the device structure.
Tomas Winkler8120e722012-12-25 19:06:11 +0200733 * @disconnect_req: disconnect request bus message from the me
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200734 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300735 * Return: -ENOMEM on allocation failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200736 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200737static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200738 struct hbm_client_connect_request *disconnect_req)
739{
Tomas Winkler31f88f52014-02-17 15:13:25 +0200740 struct mei_cl *cl;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200741 struct mei_cl_cb *cb;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200742
Tomas Winkler2af89db2014-08-21 14:29:20 +0300743 cl = mei_hbm_cl_find_by_cmd(dev, disconnect_req);
744 if (cl) {
Tomas Winkler3c666182015-05-04 09:43:52 +0300745 cl_dbg(dev, cl, "fw disconnect request received\n");
746 cl->state = MEI_FILE_DISCONNECTING;
Tomas Winkler2af89db2014-08-21 14:29:20 +0300747 cl->timer_count = 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200748
Tomas Winklerbca67d62015-02-10 10:39:43 +0200749 cb = mei_io_cb_init(cl, MEI_FOP_DISCONNECT_RSP, NULL);
Tomas Winkler2af89db2014-08-21 14:29:20 +0300750 if (!cb)
751 return -ENOMEM;
Tomas Winkler2af89db2014-08-21 14:29:20 +0300752 cl_dbg(dev, cl, "add disconnect response as first\n");
753 list_add(&cb->list, &dev->ctrl_wr_list.list);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200754 }
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200755 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200756}
757
Tomas Winklerbae1cc72014-08-21 14:29:21 +0300758/**
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300759 * mei_hbm_config_features - check what hbm features and commands
Tomas Winklerbae1cc72014-08-21 14:29:21 +0300760 * are supported by the fw
761 *
762 * @dev: the device structure
763 */
764static void mei_hbm_config_features(struct mei_device *dev)
765{
766 /* Power Gating Isolation Support */
767 dev->hbm_f_pg_supported = 0;
768 if (dev->version.major_version > HBM_MAJOR_VERSION_PGI)
769 dev->hbm_f_pg_supported = 1;
770
771 if (dev->version.major_version == HBM_MAJOR_VERSION_PGI &&
772 dev->version.minor_version >= HBM_MINOR_VERSION_PGI)
773 dev->hbm_f_pg_supported = 1;
Tomas Winkler70ef8352015-07-23 21:37:12 +0300774
775 if (dev->version.major_version >= HBM_MAJOR_VERSION_DC)
776 dev->hbm_f_dc_supported = 1;
Tomas Winklerbae1cc72014-08-21 14:29:21 +0300777}
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200778
779/**
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300780 * mei_hbm_version_is_supported - checks whether the driver can
781 * support the hbm version of the device
782 *
783 * @dev: the device structure
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300784 * Return: true if driver can support hbm version of the device
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300785 */
786bool mei_hbm_version_is_supported(struct mei_device *dev)
787{
788 return (dev->version.major_version < HBM_MAJOR_VERSION) ||
789 (dev->version.major_version == HBM_MAJOR_VERSION &&
790 dev->version.minor_version <= HBM_MINOR_VERSION);
791}
792
793/**
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200794 * mei_hbm_dispatch - bottom half read routine after ISR to
795 * handle the read bus message cmd processing.
796 *
797 * @dev: the device structure
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300798 * @hdr: header of bus message
Tomas Winkler544f9462014-01-08 20:19:21 +0200799 *
Alexander Usyskina8605ea2014-09-29 16:31:49 +0300800 * Return: 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200801 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200802int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200803{
804 struct mei_bus_message *mei_msg;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200805 struct hbm_host_version_response *version_res;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200806 struct hbm_props_response *props_res;
807 struct hbm_host_enum_response *enum_res;
Tomas Winkler70ef8352015-07-23 21:37:12 +0300808 struct hbm_add_client_request *add_cl_req;
809 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200810
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300811 struct mei_hbm_cl_cmd *cl_cmd;
812 struct hbm_client_connect_request *disconnect_req;
813 struct hbm_flow_control *flow_control;
814
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200815 /* read the message to our buffer */
816 BUG_ON(hdr->length >= sizeof(dev->rd_msg_buf));
817 mei_read_slots(dev, dev->rd_msg_buf, hdr->length);
818 mei_msg = (struct mei_bus_message *)dev->rd_msg_buf;
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300819 cl_cmd = (struct mei_hbm_cl_cmd *)mei_msg;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200820
Tomas Winkler66ae4602014-01-08 20:19:22 +0200821 /* ignore spurious message and prevent reset nesting
822 * hbm is put to idle during system reset
823 */
824 if (dev->hbm_state == MEI_HBM_IDLE) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300825 dev_dbg(dev->dev, "hbm: state is idle ignore spurious messages\n");
Tomas Winkler66ae4602014-01-08 20:19:22 +0200826 return 0;
827 }
828
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200829 switch (mei_msg->hbm_cmd) {
830 case HOST_START_RES_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300831 dev_dbg(dev->dev, "hbm: start: response message received.\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200832
833 dev->init_clients_timer = 0;
834
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200835 version_res = (struct hbm_host_version_response *)mei_msg;
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300836
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300837 dev_dbg(dev->dev, "HBM VERSION: DRIVER=%02d:%02d DEVICE=%02d:%02d\n",
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300838 HBM_MAJOR_VERSION, HBM_MINOR_VERSION,
839 version_res->me_max_version.major_version,
840 version_res->me_max_version.minor_version);
841
842 if (version_res->host_version_supported) {
843 dev->version.major_version = HBM_MAJOR_VERSION;
844 dev->version.minor_version = HBM_MINOR_VERSION;
845 } else {
846 dev->version.major_version =
847 version_res->me_max_version.major_version;
848 dev->version.minor_version =
849 version_res->me_max_version.minor_version;
850 }
851
852 if (!mei_hbm_version_is_supported(dev)) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300853 dev_warn(dev->dev, "hbm: start: version mismatch - stopping the driver.\n");
Tomas Winklere46f1872012-12-25 19:06:10 +0200854
Tomas Winkler544f9462014-01-08 20:19:21 +0200855 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200856 if (mei_hbm_stop_req(dev)) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300857 dev_err(dev->dev, "hbm: start: failed to send stop request\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200858 return -EIO;
859 }
860 break;
Tomas Winklere46f1872012-12-25 19:06:10 +0200861 }
862
Tomas Winklerbae1cc72014-08-21 14:29:21 +0300863 mei_hbm_config_features(dev);
864
Tomas Winkler544f9462014-01-08 20:19:21 +0200865 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300866 dev->hbm_state != MEI_HBM_STARTING) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300867 dev_err(dev->dev, "hbm: start: state mismatch, [%d, %d]\n",
Tomas Winkler544f9462014-01-08 20:19:21 +0200868 dev->dev_state, dev->hbm_state);
869 return -EPROTO;
870 }
871
Tomas Winkler544f9462014-01-08 20:19:21 +0200872 if (mei_hbm_enum_clients_req(dev)) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300873 dev_err(dev->dev, "hbm: start: failed to send enumeration request\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200874 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200875 }
876
Alexander Usyskincb02efc2014-08-21 14:29:19 +0300877 wake_up(&dev->wait_hbm_start);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200878 break;
879
880 case CLIENT_CONNECT_RES_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300881 dev_dbg(dev->dev, "hbm: client connect response: message received.\n");
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300882 mei_hbm_cl_res(dev, cl_cmd, MEI_FOP_CONNECT);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200883 break;
884
885 case CLIENT_DISCONNECT_RES_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300886 dev_dbg(dev->dev, "hbm: client disconnect response: message received.\n");
Tomas Winkler12f45ed2014-08-21 14:29:18 +0300887 mei_hbm_cl_res(dev, cl_cmd, MEI_FOP_DISCONNECT);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200888 break;
889
890 case MEI_FLOW_CONTROL_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300891 dev_dbg(dev->dev, "hbm: client flow control response: message received.\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200892
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200893 flow_control = (struct hbm_flow_control *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200894 mei_hbm_cl_flow_control_res(dev, flow_control);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200895 break;
896
Tomas Winkler4fcbc992014-03-18 22:51:55 +0200897 case MEI_PG_ISOLATION_ENTRY_RES_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300898 dev_dbg(dev->dev, "power gate isolation entry response received\n");
Tomas Winklerba9cdd02014-03-18 22:52:00 +0200899 dev->pg_event = MEI_PG_EVENT_RECEIVED;
Tomas Winkler4fcbc992014-03-18 22:51:55 +0200900 if (waitqueue_active(&dev->wait_pg))
901 wake_up(&dev->wait_pg);
902 break;
903
904 case MEI_PG_ISOLATION_EXIT_REQ_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300905 dev_dbg(dev->dev, "power gate isolation exit request received\n");
Tomas Winklerba9cdd02014-03-18 22:52:00 +0200906 dev->pg_event = MEI_PG_EVENT_RECEIVED;
Tomas Winkler4fcbc992014-03-18 22:51:55 +0200907 if (waitqueue_active(&dev->wait_pg))
908 wake_up(&dev->wait_pg);
Tomas Winkler180ea052014-03-18 22:52:02 +0200909 else
910 /*
911 * If the driver is not waiting on this then
912 * this is HW initiated exit from PG.
913 * Start runtime pm resume sequence to exit from PG.
914 */
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300915 pm_request_resume(dev->dev);
Tomas Winkler4fcbc992014-03-18 22:51:55 +0200916 break;
917
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200918 case HOST_CLIENT_PROPERTIES_RES_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300919 dev_dbg(dev->dev, "hbm: properties response: message received.\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200920
921 dev->init_clients_timer = 0;
922
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200923 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300924 dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300925 dev_err(dev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
Tomas Winkler544f9462014-01-08 20:19:21 +0200926 dev->dev_state, dev->hbm_state);
927 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200928 }
929
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300930 props_res = (struct hbm_props_response *)mei_msg;
931
932 if (props_res->status) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300933 dev_err(dev->dev, "hbm: properties response: wrong status = %d %s\n",
Tomas Winkler89778d62014-08-21 14:29:16 +0300934 props_res->status,
935 mei_hbm_status_str(props_res->status));
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300936 return -EPROTO;
937 }
938
939 mei_hbm_me_cl_add(dev, props_res);
940
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200941 dev->me_client_index++;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200942
Tomas Winkler8120e722012-12-25 19:06:11 +0200943 /* request property for the next client */
Tomas Winkler544f9462014-01-08 20:19:21 +0200944 if (mei_hbm_prop_req(dev))
945 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200946
947 break;
948
949 case HOST_ENUM_RES_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300950 dev_dbg(dev->dev, "hbm: enumeration response: message received\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200951
952 dev->init_clients_timer = 0;
953
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200954 enum_res = (struct hbm_host_enum_response *) mei_msg;
Tomas Winkler23f5a322013-09-02 03:11:01 +0300955 BUILD_BUG_ON(sizeof(dev->me_clients_map)
956 < sizeof(enum_res->valid_addresses));
957 memcpy(dev->me_clients_map, enum_res->valid_addresses,
Tomas Winkler5ca2d382014-08-21 14:29:13 +0300958 sizeof(enum_res->valid_addresses));
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200959
Tomas Winkler544f9462014-01-08 20:19:21 +0200960 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
961 dev->hbm_state != MEI_HBM_ENUM_CLIENTS) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300962 dev_err(dev->dev, "hbm: enumeration response: state mismatch, [%d, %d]\n",
Tomas Winkler544f9462014-01-08 20:19:21 +0200963 dev->dev_state, dev->hbm_state);
964 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200965 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200966
Tomas Winkler544f9462014-01-08 20:19:21 +0200967 dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;
968
969 /* first property request */
970 if (mei_hbm_prop_req(dev))
971 return -EIO;
972
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200973 break;
974
975 case HOST_STOP_RES_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300976 dev_dbg(dev->dev, "hbm: stop response: message received\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300977
Tomas Winkler544f9462014-01-08 20:19:21 +0200978 dev->init_clients_timer = 0;
979
980 if (dev->hbm_state != MEI_HBM_STOPPED) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300981 dev_err(dev->dev, "hbm: stop response: state mismatch, [%d, %d]\n",
Tomas Winkler544f9462014-01-08 20:19:21 +0200982 dev->dev_state, dev->hbm_state);
983 return -EPROTO;
984 }
985
Tomas Winkler33ec0822014-01-12 00:36:09 +0200986 dev->dev_state = MEI_DEV_POWER_DOWN;
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300987 dev_info(dev->dev, "hbm: stop response: resetting.\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200988 /* force the reset */
989 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200990 break;
991
992 case CLIENT_DISCONNECT_REQ_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +0300993 dev_dbg(dev->dev, "hbm: disconnect request: message received\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200994
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200995 disconnect_req = (struct hbm_client_connect_request *)mei_msg;
Tomas Winkler8120e722012-12-25 19:06:11 +0200996 mei_hbm_fw_disconnect_req(dev, disconnect_req);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200997 break;
998
999 case ME_STOP_REQ_CMD:
Tomas Winkler2bf94cab2014-09-29 16:31:42 +03001000 dev_dbg(dev->dev, "hbm: stop request: message received\n");
Tomas Winkler544f9462014-01-08 20:19:21 +02001001 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +02001002 if (mei_hbm_stop_req(dev)) {
Tomas Winkler2bf94cab2014-09-29 16:31:42 +03001003 dev_err(dev->dev, "hbm: stop request: failed to send stop request\n");
Tomas Winkler6bb948c2014-02-12 21:41:52 +02001004 return -EIO;
1005 }
Tomas Winklerbb1b0132012-12-25 19:06:07 +02001006 break;
Tomas Winkler70ef8352015-07-23 21:37:12 +03001007
1008 case MEI_HBM_ADD_CLIENT_REQ_CMD:
1009 dev_dbg(dev->dev, "hbm: add client request received\n");
1010 /*
1011 * after the host receives the enum_resp
1012 * message clients may be added or removed
1013 */
1014 if (dev->hbm_state <= MEI_HBM_ENUM_CLIENTS &&
1015 dev->hbm_state >= MEI_HBM_STOPPED) {
1016 dev_err(dev->dev, "hbm: add client: state mismatch, [%d, %d]\n",
1017 dev->dev_state, dev->hbm_state);
1018 return -EPROTO;
1019 }
1020 add_cl_req = (struct hbm_add_client_request *)mei_msg;
1021 ret = mei_hbm_fw_add_cl_req(dev, add_cl_req);
1022 if (ret) {
1023 dev_err(dev->dev, "hbm: add client: failed to send response %d\n",
1024 ret);
1025 return -EIO;
1026 }
1027 dev_dbg(dev->dev, "hbm: add client request processed\n");
1028 break;
1029
Tomas Winklerbb1b0132012-12-25 19:06:07 +02001030 default:
1031 BUG();
1032 break;
1033
1034 }
Tomas Winkler544f9462014-01-08 20:19:21 +02001035 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +02001036}
1037