blob: 9555791c010b33471c50d9c39c999c309f33e890 [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
17#include <linux/pci.h>
18#include <linux/sched.h>
19#include <linux/wait.h>
20#include <linux/mei.h>
21
22#include "mei_dev.h"
Tomas Winkler0edb23f2013-01-08 23:07:12 +020023#include "hbm.h"
Tomas Winkler9dc64d62013-01-08 23:07:17 +020024#include "hw-me.h"
Alexander Usyskin12d00662014-02-17 15:13:23 +020025#include "client.h"
Tomas Winklerbb1b0132012-12-25 19:06:07 +020026
Alexander Usyskin285e2992014-02-17 15:13:20 +020027static const char *mei_cl_conn_status_str(enum mei_cl_connect_status status)
28{
29#define MEI_CL_CS(status) case MEI_CL_CONN_##status: return #status
30 switch (status) {
31 MEI_CL_CS(SUCCESS);
32 MEI_CL_CS(NOT_FOUND);
33 MEI_CL_CS(ALREADY_STARTED);
34 MEI_CL_CS(OUT_OF_RESOURCES);
35 MEI_CL_CS(MESSAGE_SMALL);
36 default: return "unknown";
37 }
38#undef MEI_CL_CCS
39}
40
41/**
42 * mei_cl_conn_status_to_errno - convert client connect response
43 * status to error code
44 *
45 * @status: client connect response status
46 *
47 * returns corresponding error code
48 */
49static int mei_cl_conn_status_to_errno(enum mei_cl_connect_status status)
50{
51 switch (status) {
52 case MEI_CL_CONN_SUCCESS: return 0;
53 case MEI_CL_CONN_NOT_FOUND: return -ENOTTY;
54 case MEI_CL_CONN_ALREADY_STARTED: return -EBUSY;
55 case MEI_CL_CONN_OUT_OF_RESOURCES: return -EBUSY;
56 case MEI_CL_CONN_MESSAGE_SMALL: return -EINVAL;
57 default: return -EINVAL;
58 }
59}
60
Tomas Winklerbb1b0132012-12-25 19:06:07 +020061/**
Tomas Winklera40b2602013-01-08 23:07:19 +020062 * mei_hbm_me_cl_allocate - allocates storage for me clients
63 *
64 * @dev: the device structure
65 *
Tomas Winkler544f9462014-01-08 20:19:21 +020066 * returns 0 on success -ENOMEM on allocation failure
Tomas Winklera40b2602013-01-08 23:07:19 +020067 */
Tomas Winkler544f9462014-01-08 20:19:21 +020068static int mei_hbm_me_cl_allocate(struct mei_device *dev)
Tomas Winklera40b2602013-01-08 23:07:19 +020069{
70 struct mei_me_client *clients;
71 int b;
72
Tomas Winkler1aee3512013-09-02 13:29:45 +030073 dev->me_clients_num = 0;
74 dev->me_client_presentation_num = 0;
75 dev->me_client_index = 0;
76
Tomas Winklera40b2602013-01-08 23:07:19 +020077 /* count how many ME clients we have */
78 for_each_set_bit(b, dev->me_clients_map, MEI_CLIENTS_MAX)
79 dev->me_clients_num++;
80
Tomas Winkler1aee3512013-09-02 13:29:45 +030081 if (dev->me_clients_num == 0)
Tomas Winkler544f9462014-01-08 20:19:21 +020082 return 0;
Tomas Winklera40b2602013-01-08 23:07:19 +020083
84 kfree(dev->me_clients);
85 dev->me_clients = NULL;
86
Tomas Winklere19555c2013-09-02 03:11:03 +030087 dev_dbg(&dev->pdev->dev, "memory allocation for ME clients size=%ld.\n",
Tomas Winklera40b2602013-01-08 23:07:19 +020088 dev->me_clients_num * sizeof(struct mei_me_client));
89 /* allocate storage for ME clients representation */
90 clients = kcalloc(dev->me_clients_num,
91 sizeof(struct mei_me_client), GFP_KERNEL);
92 if (!clients) {
93 dev_err(&dev->pdev->dev, "memory allocation for ME clients failed.\n");
Tomas Winkler544f9462014-01-08 20:19:21 +020094 return -ENOMEM;
Tomas Winklera40b2602013-01-08 23:07:19 +020095 }
96 dev->me_clients = clients;
Tomas Winkler544f9462014-01-08 20:19:21 +020097 return 0;
Tomas Winklera40b2602013-01-08 23:07:19 +020098}
99
100/**
Tomas Winklercd51ed62012-12-25 19:06:09 +0200101 * mei_hbm_cl_hdr - construct client hbm header
Masanari Iida393b1482013-04-05 01:05:05 +0900102 *
Tomas Winklercd51ed62012-12-25 19:06:09 +0200103 * @cl: - client
104 * @hbm_cmd: host bus message command
105 * @buf: buffer for cl header
106 * @len: buffer length
107 */
108static inline
109void mei_hbm_cl_hdr(struct mei_cl *cl, u8 hbm_cmd, void *buf, size_t len)
110{
111 struct mei_hbm_cl_cmd *cmd = buf;
112
113 memset(cmd, 0, len);
114
115 cmd->hbm_cmd = hbm_cmd;
116 cmd->host_addr = cl->host_client_id;
117 cmd->me_addr = cl->me_client_id;
118}
119
120/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200121 * mei_hbm_cl_addr_equal - tells if they have the same address
Tomas Winklercd51ed62012-12-25 19:06:09 +0200122 *
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200123 * @cl: - client
124 * @buf: buffer with cl header
Tomas Winklercd51ed62012-12-25 19:06:09 +0200125 *
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200126 * returns true if addresses are the same
Tomas Winklercd51ed62012-12-25 19:06:09 +0200127 */
128static inline
129bool mei_hbm_cl_addr_equal(struct mei_cl *cl, void *buf)
130{
131 struct mei_hbm_cl_cmd *cmd = buf;
132 return cl->host_client_id == cmd->host_addr &&
133 cl->me_client_id == cmd->me_addr;
134}
135
136
137/**
Tomas Winkler66ae4602014-01-08 20:19:22 +0200138 * mei_hbm_idle - set hbm to idle state
139 *
140 * @dev: the device structure
141 */
142void mei_hbm_idle(struct mei_device *dev)
143{
144 dev->init_clients_timer = 0;
145 dev->hbm_state = MEI_HBM_IDLE;
146}
147
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300148int mei_hbm_start_wait(struct mei_device *dev)
149{
150 int ret;
151 if (dev->hbm_state > MEI_HBM_START)
152 return 0;
153
154 mutex_unlock(&dev->device_lock);
155 ret = wait_event_interruptible_timeout(dev->wait_recvd_msg,
156 dev->hbm_state == MEI_HBM_IDLE ||
Tomas Winkler544f9462014-01-08 20:19:21 +0200157 dev->hbm_state >= MEI_HBM_STARTED,
Tomas Winkler7d93e582014-01-14 23:10:10 +0200158 mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300159 mutex_lock(&dev->device_lock);
160
161 if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
162 dev->hbm_state = MEI_HBM_IDLE;
Masanari Iida8b513d02013-05-21 23:13:12 +0900163 dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
Alexander Usyskin7ca96aa2014-02-19 17:35:49 +0200164 return -ETIME;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300165 }
166 return 0;
167}
168
Tomas Winkler6bbda152012-12-25 19:06:12 +0200169/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200170 * mei_hbm_start_req - sends start request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200171 *
172 * @dev: the device structure
Tomas Winkler544f9462014-01-08 20:19:21 +0200173 *
174 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200175 */
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300176int mei_hbm_start_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200177{
Tomas Winklere46f1872012-12-25 19:06:10 +0200178 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200179 struct hbm_host_version_request *start_req;
180 const size_t len = sizeof(struct hbm_host_version_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200181 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200182
Tomas Winklere46f1872012-12-25 19:06:10 +0200183 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200184
185 /* host start message */
Tomas Winklere46f1872012-12-25 19:06:10 +0200186 start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200187 memset(start_req, 0, len);
188 start_req->hbm_cmd = HOST_START_REQ_CMD;
189 start_req->host_version.major_version = HBM_MAJOR_VERSION;
190 start_req->host_version.minor_version = HBM_MINOR_VERSION;
191
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300192 dev->hbm_state = MEI_HBM_IDLE;
Tomas Winkler544f9462014-01-08 20:19:21 +0200193 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
194 if (ret) {
195 dev_err(&dev->pdev->dev, "version message write failed: ret = %d\n",
196 ret);
197 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200198 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200199
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300200 dev->hbm_state = MEI_HBM_START;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200201 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300202 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200203}
204
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300205/*
Tomas Winkler8120e722012-12-25 19:06:11 +0200206 * mei_hbm_enum_clients_req - sends enumeration client request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200207 *
208 * @dev: the device structure
209 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200210 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200211 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200212static int mei_hbm_enum_clients_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200213{
Tomas Winklere46f1872012-12-25 19:06:10 +0200214 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200215 struct hbm_host_enum_request *enum_req;
216 const size_t len = sizeof(struct hbm_host_enum_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200217 int ret;
218
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200219 /* enumerate clients */
Tomas Winklere46f1872012-12-25 19:06:10 +0200220 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200221
Tomas Winklere46f1872012-12-25 19:06:10 +0200222 enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
223 memset(enum_req, 0, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200224 enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
225
Tomas Winkler544f9462014-01-08 20:19:21 +0200226 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
227 if (ret) {
228 dev_err(&dev->pdev->dev, "enumeration request write failed: ret = %d.\n",
229 ret);
230 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200231 }
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300232 dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200233 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler544f9462014-01-08 20:19:21 +0200234 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200235}
236
Tomas Winkler8120e722012-12-25 19:06:11 +0200237/**
Masanari Iida393b1482013-04-05 01:05:05 +0900238 * mei_hbm_prop_req - request property for a single client
Tomas Winkler8120e722012-12-25 19:06:11 +0200239 *
240 * @dev: the device structure
241 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200242 * returns 0 on success and < 0 on failure
Tomas Winkler8120e722012-12-25 19:06:11 +0200243 */
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200244
Tomas Winkler8120e722012-12-25 19:06:11 +0200245static int mei_hbm_prop_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200246{
247
Tomas Winklere46f1872012-12-25 19:06:10 +0200248 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200249 struct hbm_props_request *prop_req;
250 const size_t len = sizeof(struct hbm_props_request);
251 unsigned long next_client_index;
Tomas Winkler1aee3512013-09-02 13:29:45 +0300252 unsigned long client_num;
Tomas Winkler544f9462014-01-08 20:19:21 +0200253 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200254
255 client_num = dev->me_client_presentation_num;
256
257 next_client_index = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX,
258 dev->me_client_index);
259
260 /* We got all client properties */
261 if (next_client_index == MEI_CLIENTS_MAX) {
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300262 dev->hbm_state = MEI_HBM_STARTED;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200263 schedule_work(&dev->init_work);
264
265 return 0;
266 }
267
268 dev->me_clients[client_num].client_id = next_client_index;
269 dev->me_clients[client_num].mei_flow_ctrl_creds = 0;
270
Tomas Winklere46f1872012-12-25 19:06:10 +0200271 mei_hbm_hdr(mei_hdr, len);
272 prop_req = (struct hbm_props_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200273
274 memset(prop_req, 0, sizeof(struct hbm_props_request));
275
276
277 prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
278 prop_req->address = next_client_index;
279
Tomas Winkler544f9462014-01-08 20:19:21 +0200280 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
281 if (ret) {
282 dev_err(&dev->pdev->dev, "properties request write failed: ret = %d\n",
283 ret);
284 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200285 }
286
287 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
288 dev->me_client_index = next_client_index;
289
290 return 0;
291}
292
293/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200294 * mei_hbm_stop_req - send stop request message
Tomas Winklere46f1872012-12-25 19:06:10 +0200295 *
296 * @dev - mei device
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200297 * @cl: client info
298 *
299 * This function returns -EIO on write failure
Tomas Winklere46f1872012-12-25 19:06:10 +0200300 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200301static int mei_hbm_stop_req(struct mei_device *dev)
Tomas Winklere46f1872012-12-25 19:06:10 +0200302{
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200303 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklere46f1872012-12-25 19:06:10 +0200304 struct hbm_host_stop_request *req =
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200305 (struct hbm_host_stop_request *)dev->wr_msg.data;
Tomas Winklere46f1872012-12-25 19:06:10 +0200306 const size_t len = sizeof(struct hbm_host_stop_request);
307
308 mei_hbm_hdr(mei_hdr, len);
309
310 memset(req, 0, len);
311 req->hbm_cmd = HOST_STOP_REQ_CMD;
312 req->reason = DRIVER_STOP_REQUEST;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200313
314 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklere46f1872012-12-25 19:06:10 +0200315}
316
317/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200318 * mei_hbm_cl_flow_control_req - sends flow control request.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200319 *
320 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200321 * @cl: client info
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200322 *
323 * This function returns -EIO on write failure
324 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200325int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200326{
Tomas Winklere46f1872012-12-25 19:06:10 +0200327 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200328 const size_t len = sizeof(struct hbm_flow_control);
329
Tomas Winklere46f1872012-12-25 19:06:10 +0200330 mei_hbm_hdr(mei_hdr, len);
331 mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200332
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200333 dev_dbg(&dev->pdev->dev, "sending flow control host client = %d, ME client = %d\n",
334 cl->host_client_id, cl->me_client_id);
335
Tomas Winklere46f1872012-12-25 19:06:10 +0200336 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200337}
338
339/**
Masanari Iida393b1482013-04-05 01:05:05 +0900340 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
Tomas Winkler6bbda152012-12-25 19:06:12 +0200341 *
Masanari Iida393b1482013-04-05 01:05:05 +0900342 * @dev: the device structure
Tomas Winkler6bbda152012-12-25 19:06:12 +0200343 * @flow: flow control.
Alexander Usyskin12d00662014-02-17 15:13:23 +0200344 *
345 * return 0 on success, < 0 otherwise
Tomas Winkler6bbda152012-12-25 19:06:12 +0200346 */
Alexander Usyskin12d00662014-02-17 15:13:23 +0200347static int mei_hbm_add_single_flow_creds(struct mei_device *dev,
Tomas Winkler6bbda152012-12-25 19:06:12 +0200348 struct hbm_flow_control *flow)
349{
Alexander Usyskin12d00662014-02-17 15:13:23 +0200350 struct mei_me_client *me_cl;
351 int id;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200352
Alexander Usyskin12d00662014-02-17 15:13:23 +0200353 id = mei_me_cl_by_id(dev, flow->me_addr);
354 if (id < 0) {
355 dev_err(&dev->pdev->dev, "no such me client %d\n",
356 flow->me_addr);
357 return id;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200358 }
Alexander Usyskin12d00662014-02-17 15:13:23 +0200359
360 me_cl = &dev->me_clients[id];
361 if (me_cl->props.single_recv_buf) {
362 me_cl->mei_flow_ctrl_creds++;
363 dev_dbg(&dev->pdev->dev, "recv flow ctrl msg ME %d (single).\n",
364 flow->me_addr);
365 dev_dbg(&dev->pdev->dev, "flow control credentials =%d.\n",
366 me_cl->mei_flow_ctrl_creds);
367 } else {
368 BUG(); /* error in flow control */
369 }
370
371 return 0;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200372}
373
374/**
375 * mei_hbm_cl_flow_control_res - flow control response from me
376 *
377 * @dev: the device structure
378 * @flow_control: flow control response bus message
379 */
380static void mei_hbm_cl_flow_control_res(struct mei_device *dev,
381 struct hbm_flow_control *flow_control)
382{
Tomas Winkler31f88f52014-02-17 15:13:25 +0200383 struct mei_cl *cl;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200384
385 if (!flow_control->host_addr) {
386 /* single receive buffer */
387 mei_hbm_add_single_flow_creds(dev, flow_control);
388 return;
389 }
390
391 /* normal connection */
Tomas Winkler31f88f52014-02-17 15:13:25 +0200392 list_for_each_entry(cl, &dev->file_list, link) {
Tomas Winkler6bbda152012-12-25 19:06:12 +0200393 if (mei_hbm_cl_addr_equal(cl, flow_control)) {
394 cl->mei_flow_ctrl_creds++;
395 dev_dbg(&dev->pdev->dev, "flow ctrl msg for host %d ME %d.\n",
396 flow_control->host_addr, flow_control->me_addr);
397 dev_dbg(&dev->pdev->dev, "flow control credentials = %d.\n",
398 cl->mei_flow_ctrl_creds);
399 break;
400 }
401 }
402}
403
404
405/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200406 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200407 *
408 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200409 * @cl: a client to disconnect from
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200410 *
411 * This function returns -EIO on write failure
412 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200413int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200414{
Tomas Winklere46f1872012-12-25 19:06:10 +0200415 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200416 const size_t len = sizeof(struct hbm_client_connect_request);
417
Tomas Winklere46f1872012-12-25 19:06:10 +0200418 mei_hbm_hdr(mei_hdr, len);
419 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200420
Tomas Winklere46f1872012-12-25 19:06:10 +0200421 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200422}
423
424/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200425 * mei_hbm_cl_disconnect_rsp - sends disconnect respose to the FW
426 *
427 * @dev: the device structure
428 * @cl: a client to disconnect from
429 *
430 * This function returns -EIO on write failure
431 */
432int mei_hbm_cl_disconnect_rsp(struct mei_device *dev, struct mei_cl *cl)
433{
434 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
435 const size_t len = sizeof(struct hbm_client_connect_response);
436
437 mei_hbm_hdr(mei_hdr, len);
438 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_RES_CMD, dev->wr_msg.data, len);
439
440 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
441}
442
443/**
Tomas Winkler6bbda152012-12-25 19:06:12 +0200444 * mei_hbm_cl_disconnect_res - disconnect response from ME
445 *
446 * @dev: the device structure
447 * @rs: disconnect response bus message
448 */
449static void mei_hbm_cl_disconnect_res(struct mei_device *dev,
450 struct hbm_client_connect_response *rs)
451{
452 struct mei_cl *cl;
Tomas Winkler64092852014-02-17 15:13:21 +0200453 struct mei_cl_cb *cb, *next;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200454
Alexander Usyskin285e2992014-02-17 15:13:20 +0200455 dev_dbg(&dev->pdev->dev, "hbm: disconnect response cl:host=%02d me=%02d status=%d\n",
456 rs->me_addr, rs->host_addr, rs->status);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200457
Tomas Winkler64092852014-02-17 15:13:21 +0200458 list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
459 cl = cb->cl;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200460
Tomas Winkler64092852014-02-17 15:13:21 +0200461 /* this should not happen */
462 if (WARN_ON(!cl)) {
463 list_del(&cb->list);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200464 return;
465 }
466
Tomas Winkler6bbda152012-12-25 19:06:12 +0200467 if (mei_hbm_cl_addr_equal(cl, rs)) {
Tomas Winkler64092852014-02-17 15:13:21 +0200468 list_del(&cb->list);
Alexander Usyskin285e2992014-02-17 15:13:20 +0200469 if (rs->status == MEI_CL_DISCONN_SUCCESS)
Tomas Winkler6bbda152012-12-25 19:06:12 +0200470 cl->state = MEI_FILE_DISCONNECTED;
471
472 cl->status = 0;
473 cl->timer_count = 0;
474 break;
475 }
476 }
477}
478
479/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200480 * mei_hbm_cl_connect_req - send connection request to specific me client
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200481 *
482 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200483 * @cl: a client to connect to
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200484 *
Tomas Winkler8120e722012-12-25 19:06:11 +0200485 * returns -EIO on write failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200486 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200487int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200488{
Tomas Winklere46f1872012-12-25 19:06:10 +0200489 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200490 const size_t len = sizeof(struct hbm_client_connect_request);
491
Tomas Winklere46f1872012-12-25 19:06:10 +0200492 mei_hbm_hdr(mei_hdr, len);
493 mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200494
Tomas Winklere46f1872012-12-25 19:06:10 +0200495 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200496}
497
498/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200499 * mei_hbm_cl_connect_res - connect response from the ME
Tomas Winkler6bbda152012-12-25 19:06:12 +0200500 *
501 * @dev: the device structure
502 * @rs: connect response bus message
503 */
504static void mei_hbm_cl_connect_res(struct mei_device *dev,
505 struct hbm_client_connect_response *rs)
506{
507
508 struct mei_cl *cl;
Tomas Winkler64092852014-02-17 15:13:21 +0200509 struct mei_cl_cb *cb, *next;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200510
Alexander Usyskin285e2992014-02-17 15:13:20 +0200511 dev_dbg(&dev->pdev->dev, "hbm: connect response cl:host=%02d me=%02d status=%s\n",
512 rs->me_addr, rs->host_addr,
513 mei_cl_conn_status_str(rs->status));
Tomas Winkler6bbda152012-12-25 19:06:12 +0200514
Tomas Winkler64092852014-02-17 15:13:21 +0200515 cl = NULL;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200516
Tomas Winkler64092852014-02-17 15:13:21 +0200517 list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
Tomas Winkler6bbda152012-12-25 19:06:12 +0200518
Tomas Winkler64092852014-02-17 15:13:21 +0200519 cl = cb->cl;
520 /* this should not happen */
521 if (WARN_ON(!cl)) {
522 list_del_init(&cb->list);
523 continue;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200524 }
Tomas Winkler64092852014-02-17 15:13:21 +0200525
526 if (cb->fop_type != MEI_FOP_CONNECT)
527 continue;
528
529 if (mei_hbm_cl_addr_equal(cl, rs)) {
530 list_del(&cb->list);
531 break;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200532 }
533 }
Tomas Winkler64092852014-02-17 15:13:21 +0200534
535 if (!cl)
536 return;
537
538 cl->timer_count = 0;
539 if (rs->status == MEI_CL_CONN_SUCCESS)
540 cl->state = MEI_FILE_CONNECTED;
541 else
542 cl->state = MEI_FILE_DISCONNECTED;
543 cl->status = mei_cl_conn_status_to_errno(rs->status);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200544}
545
546
547/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200548 * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
549 * host sends disconnect response
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200550 *
551 * @dev: the device structure.
Tomas Winkler8120e722012-12-25 19:06:11 +0200552 * @disconnect_req: disconnect request bus message from the me
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200553 *
554 * returns -ENOMEM on allocation failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200555 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200556static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200557 struct hbm_client_connect_request *disconnect_req)
558{
Tomas Winkler31f88f52014-02-17 15:13:25 +0200559 struct mei_cl *cl;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200560 struct mei_cl_cb *cb;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200561
Tomas Winkler31f88f52014-02-17 15:13:25 +0200562 list_for_each_entry(cl, &dev->file_list, link) {
Tomas Winklercd51ed62012-12-25 19:06:09 +0200563 if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200564 dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
565 disconnect_req->host_addr,
566 disconnect_req->me_addr);
Tomas Winklercd51ed62012-12-25 19:06:09 +0200567 cl->state = MEI_FILE_DISCONNECTED;
568 cl->timer_count = 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200569
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200570 cb = mei_io_cb_init(cl, NULL);
571 if (!cb)
572 return -ENOMEM;
573 cb->fop_type = MEI_FOP_DISCONNECT_RSP;
574 cl_dbg(dev, cl, "add disconnect response as first\n");
575 list_add(&cb->list, &dev->ctrl_wr_list.list);
576
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200577 break;
578 }
579 }
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200580 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200581}
582
583
584/**
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300585 * mei_hbm_version_is_supported - checks whether the driver can
586 * support the hbm version of the device
587 *
588 * @dev: the device structure
589 * returns true if driver can support hbm version of the device
590 */
591bool mei_hbm_version_is_supported(struct mei_device *dev)
592{
593 return (dev->version.major_version < HBM_MAJOR_VERSION) ||
594 (dev->version.major_version == HBM_MAJOR_VERSION &&
595 dev->version.minor_version <= HBM_MINOR_VERSION);
596}
597
598/**
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200599 * mei_hbm_dispatch - bottom half read routine after ISR to
600 * handle the read bus message cmd processing.
601 *
602 * @dev: the device structure
603 * @mei_hdr: header of bus message
Tomas Winkler544f9462014-01-08 20:19:21 +0200604 *
605 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200606 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200607int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200608{
609 struct mei_bus_message *mei_msg;
610 struct mei_me_client *me_client;
611 struct hbm_host_version_response *version_res;
612 struct hbm_client_connect_response *connect_res;
613 struct hbm_client_connect_response *disconnect_res;
614 struct hbm_client_connect_request *disconnect_req;
615 struct hbm_flow_control *flow_control;
616 struct hbm_props_response *props_res;
617 struct hbm_host_enum_response *enum_res;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200618
619 /* read the message to our buffer */
620 BUG_ON(hdr->length >= sizeof(dev->rd_msg_buf));
621 mei_read_slots(dev, dev->rd_msg_buf, hdr->length);
622 mei_msg = (struct mei_bus_message *)dev->rd_msg_buf;
623
Tomas Winkler66ae4602014-01-08 20:19:22 +0200624 /* ignore spurious message and prevent reset nesting
625 * hbm is put to idle during system reset
626 */
627 if (dev->hbm_state == MEI_HBM_IDLE) {
628 dev_dbg(&dev->pdev->dev, "hbm: state is idle ignore spurious messages\n");
629 return 0;
630 }
631
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200632 switch (mei_msg->hbm_cmd) {
633 case HOST_START_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200634 dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");
635
636 dev->init_clients_timer = 0;
637
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200638 version_res = (struct hbm_host_version_response *)mei_msg;
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300639
640 dev_dbg(&dev->pdev->dev, "HBM VERSION: DRIVER=%02d:%02d DEVICE=%02d:%02d\n",
641 HBM_MAJOR_VERSION, HBM_MINOR_VERSION,
642 version_res->me_max_version.major_version,
643 version_res->me_max_version.minor_version);
644
645 if (version_res->host_version_supported) {
646 dev->version.major_version = HBM_MAJOR_VERSION;
647 dev->version.minor_version = HBM_MINOR_VERSION;
648 } else {
649 dev->version.major_version =
650 version_res->me_max_version.major_version;
651 dev->version.minor_version =
652 version_res->me_max_version.minor_version;
653 }
654
655 if (!mei_hbm_version_is_supported(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200656 dev_warn(&dev->pdev->dev, "hbm: start: version mismatch - stopping the driver.\n");
Tomas Winklere46f1872012-12-25 19:06:10 +0200657
Tomas Winkler544f9462014-01-08 20:19:21 +0200658 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200659 if (mei_hbm_stop_req(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200660 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
661 return -EIO;
662 }
663 break;
Tomas Winklere46f1872012-12-25 19:06:10 +0200664 }
665
Tomas Winkler544f9462014-01-08 20:19:21 +0200666 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
667 dev->hbm_state != MEI_HBM_START) {
668 dev_err(&dev->pdev->dev, "hbm: start: state mismatch, [%d, %d]\n",
669 dev->dev_state, dev->hbm_state);
670 return -EPROTO;
671 }
672
673 dev->hbm_state = MEI_HBM_STARTED;
674
675 if (mei_hbm_enum_clients_req(dev)) {
676 dev_err(&dev->pdev->dev, "hbm: start: failed to send enumeration request\n");
677 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200678 }
679
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300680 wake_up_interruptible(&dev->wait_recvd_msg);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200681 break;
682
683 case CLIENT_CONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200684 dev_dbg(&dev->pdev->dev, "hbm: client connect response: message received.\n");
685
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200686 connect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200687 mei_hbm_cl_connect_res(dev, connect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200688 wake_up(&dev->wait_recvd_msg);
689 break;
690
691 case CLIENT_DISCONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200692 dev_dbg(&dev->pdev->dev, "hbm: client disconnect response: message received.\n");
693
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200694 disconnect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200695 mei_hbm_cl_disconnect_res(dev, disconnect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200696 wake_up(&dev->wait_recvd_msg);
697 break;
698
699 case MEI_FLOW_CONTROL_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200700 dev_dbg(&dev->pdev->dev, "hbm: client flow control response: message received.\n");
701
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200702 flow_control = (struct hbm_flow_control *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200703 mei_hbm_cl_flow_control_res(dev, flow_control);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200704 break;
705
706 case HOST_CLIENT_PROPERTIES_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200707 dev_dbg(&dev->pdev->dev, "hbm: properties response: message received.\n");
708
709 dev->init_clients_timer = 0;
710
711 if (dev->me_clients == NULL) {
712 dev_err(&dev->pdev->dev, "hbm: properties response: mei_clients not allocated\n");
713 return -EPROTO;
714 }
715
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200716 props_res = (struct hbm_props_response *)mei_msg;
717 me_client = &dev->me_clients[dev->me_client_presentation_num];
718
Tomas Winkler544f9462014-01-08 20:19:21 +0200719 if (props_res->status) {
720 dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
721 props_res->status);
722 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200723 }
724
725 if (me_client->client_id != props_res->address) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200726 dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
727 me_client->client_id, props_res->address);
728 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200729 }
730
731 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300732 dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200733 dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
734 dev->dev_state, dev->hbm_state);
735 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200736 }
737
738 me_client->props = props_res->client_properties;
739 dev->me_client_index++;
740 dev->me_client_presentation_num++;
741
Tomas Winkler8120e722012-12-25 19:06:11 +0200742 /* request property for the next client */
Tomas Winkler544f9462014-01-08 20:19:21 +0200743 if (mei_hbm_prop_req(dev))
744 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200745
746 break;
747
748 case HOST_ENUM_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200749 dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");
750
751 dev->init_clients_timer = 0;
752
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200753 enum_res = (struct hbm_host_enum_response *) mei_msg;
Tomas Winkler23f5a322013-09-02 03:11:01 +0300754 BUILD_BUG_ON(sizeof(dev->me_clients_map)
755 < sizeof(enum_res->valid_addresses));
756 memcpy(dev->me_clients_map, enum_res->valid_addresses,
757 sizeof(enum_res->valid_addresses));
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200758
Tomas Winkler544f9462014-01-08 20:19:21 +0200759 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
760 dev->hbm_state != MEI_HBM_ENUM_CLIENTS) {
761 dev_err(&dev->pdev->dev, "hbm: enumeration response: state mismatch, [%d, %d]\n",
762 dev->dev_state, dev->hbm_state);
763 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200764 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200765
766 if (mei_hbm_me_cl_allocate(dev)) {
767 dev_err(&dev->pdev->dev, "hbm: enumeration response: cannot allocate clients array\n");
768 return -ENOMEM;
769 }
770
771 dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;
772
773 /* first property request */
774 if (mei_hbm_prop_req(dev))
775 return -EIO;
776
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200777 break;
778
779 case HOST_STOP_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200780 dev_dbg(&dev->pdev->dev, "hbm: stop response: message received\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300781
Tomas Winkler544f9462014-01-08 20:19:21 +0200782 dev->init_clients_timer = 0;
783
784 if (dev->hbm_state != MEI_HBM_STOPPED) {
785 dev_err(&dev->pdev->dev, "hbm: stop response: state mismatch, [%d, %d]\n",
786 dev->dev_state, dev->hbm_state);
787 return -EPROTO;
788 }
789
Tomas Winkler33ec0822014-01-12 00:36:09 +0200790 dev->dev_state = MEI_DEV_POWER_DOWN;
Tomas Winkler544f9462014-01-08 20:19:21 +0200791 dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
792 /* force the reset */
793 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200794 break;
795
796 case CLIENT_DISCONNECT_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200797 dev_dbg(&dev->pdev->dev, "hbm: disconnect request: message received\n");
798
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200799 disconnect_req = (struct hbm_client_connect_request *)mei_msg;
Tomas Winkler8120e722012-12-25 19:06:11 +0200800 mei_hbm_fw_disconnect_req(dev, disconnect_req);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200801 break;
802
803 case ME_STOP_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200804 dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200805 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200806 if (mei_hbm_stop_req(dev)) {
807 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
808 return -EIO;
809 }
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200810 break;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200811 default:
812 BUG();
813 break;
814
815 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200816 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200817}
818