blob: 4960288e543a2657fbf80689eef5003b93f83428 [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"
Alexander Usyskin12d00662014-02-17 15:13:23 +020024#include "client.h"
Tomas Winklerbb1b0132012-12-25 19:06:07 +020025
Alexander Usyskin285e2992014-02-17 15:13:20 +020026static const char *mei_cl_conn_status_str(enum mei_cl_connect_status status)
27{
28#define MEI_CL_CS(status) case MEI_CL_CONN_##status: return #status
29 switch (status) {
30 MEI_CL_CS(SUCCESS);
31 MEI_CL_CS(NOT_FOUND);
32 MEI_CL_CS(ALREADY_STARTED);
33 MEI_CL_CS(OUT_OF_RESOURCES);
34 MEI_CL_CS(MESSAGE_SMALL);
35 default: return "unknown";
36 }
37#undef MEI_CL_CCS
38}
39
40/**
41 * mei_cl_conn_status_to_errno - convert client connect response
42 * status to error code
43 *
44 * @status: client connect response status
45 *
46 * returns corresponding error code
47 */
48static int mei_cl_conn_status_to_errno(enum mei_cl_connect_status status)
49{
50 switch (status) {
51 case MEI_CL_CONN_SUCCESS: return 0;
52 case MEI_CL_CONN_NOT_FOUND: return -ENOTTY;
53 case MEI_CL_CONN_ALREADY_STARTED: return -EBUSY;
54 case MEI_CL_CONN_OUT_OF_RESOURCES: return -EBUSY;
55 case MEI_CL_CONN_MESSAGE_SMALL: return -EINVAL;
56 default: return -EINVAL;
57 }
58}
59
Tomas Winklerbb1b0132012-12-25 19:06:07 +020060/**
Tomas Winklera40b2602013-01-08 23:07:19 +020061 * mei_hbm_me_cl_allocate - allocates storage for me clients
62 *
63 * @dev: the device structure
64 *
Tomas Winkler544f9462014-01-08 20:19:21 +020065 * returns 0 on success -ENOMEM on allocation failure
Tomas Winklera40b2602013-01-08 23:07:19 +020066 */
Tomas Winkler544f9462014-01-08 20:19:21 +020067static int mei_hbm_me_cl_allocate(struct mei_device *dev)
Tomas Winklera40b2602013-01-08 23:07:19 +020068{
69 struct mei_me_client *clients;
70 int b;
71
Tomas Winkler1aee3512013-09-02 13:29:45 +030072 dev->me_clients_num = 0;
73 dev->me_client_presentation_num = 0;
74 dev->me_client_index = 0;
75
Tomas Winklera40b2602013-01-08 23:07:19 +020076 /* count how many ME clients we have */
77 for_each_set_bit(b, dev->me_clients_map, MEI_CLIENTS_MAX)
78 dev->me_clients_num++;
79
Tomas Winkler1aee3512013-09-02 13:29:45 +030080 if (dev->me_clients_num == 0)
Tomas Winkler544f9462014-01-08 20:19:21 +020081 return 0;
Tomas Winklera40b2602013-01-08 23:07:19 +020082
83 kfree(dev->me_clients);
84 dev->me_clients = NULL;
85
Tomas Winklere19555c2013-09-02 03:11:03 +030086 dev_dbg(&dev->pdev->dev, "memory allocation for ME clients size=%ld.\n",
Tomas Winklera40b2602013-01-08 23:07:19 +020087 dev->me_clients_num * sizeof(struct mei_me_client));
88 /* allocate storage for ME clients representation */
89 clients = kcalloc(dev->me_clients_num,
90 sizeof(struct mei_me_client), GFP_KERNEL);
91 if (!clients) {
92 dev_err(&dev->pdev->dev, "memory allocation for ME clients failed.\n");
Tomas Winkler544f9462014-01-08 20:19:21 +020093 return -ENOMEM;
Tomas Winklera40b2602013-01-08 23:07:19 +020094 }
95 dev->me_clients = clients;
Tomas Winkler544f9462014-01-08 20:19:21 +020096 return 0;
Tomas Winklera40b2602013-01-08 23:07:19 +020097}
98
99/**
Tomas Winklercd51ed62012-12-25 19:06:09 +0200100 * mei_hbm_cl_hdr - construct client hbm header
Masanari Iida393b1482013-04-05 01:05:05 +0900101 *
Tomas Winklercd51ed62012-12-25 19:06:09 +0200102 * @cl: - client
103 * @hbm_cmd: host bus message command
104 * @buf: buffer for cl header
105 * @len: buffer length
106 */
107static inline
108void mei_hbm_cl_hdr(struct mei_cl *cl, u8 hbm_cmd, void *buf, size_t len)
109{
110 struct mei_hbm_cl_cmd *cmd = buf;
111
112 memset(cmd, 0, len);
113
114 cmd->hbm_cmd = hbm_cmd;
115 cmd->host_addr = cl->host_client_id;
116 cmd->me_addr = cl->me_client_id;
117}
118
119/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200120 * mei_hbm_cl_addr_equal - tells if they have the same address
Tomas Winklercd51ed62012-12-25 19:06:09 +0200121 *
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200122 * @cl: - client
123 * @buf: buffer with cl header
Tomas Winklercd51ed62012-12-25 19:06:09 +0200124 *
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200125 * returns true if addresses are the same
Tomas Winklercd51ed62012-12-25 19:06:09 +0200126 */
127static inline
128bool mei_hbm_cl_addr_equal(struct mei_cl *cl, void *buf)
129{
130 struct mei_hbm_cl_cmd *cmd = buf;
131 return cl->host_client_id == cmd->host_addr &&
132 cl->me_client_id == cmd->me_addr;
133}
134
135
136/**
Tomas Winkler66ae4602014-01-08 20:19:22 +0200137 * mei_hbm_idle - set hbm to idle state
138 *
139 * @dev: the device structure
140 */
141void mei_hbm_idle(struct mei_device *dev)
142{
143 dev->init_clients_timer = 0;
144 dev->hbm_state = MEI_HBM_IDLE;
145}
146
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300147int mei_hbm_start_wait(struct mei_device *dev)
148{
149 int ret;
150 if (dev->hbm_state > MEI_HBM_START)
151 return 0;
152
153 mutex_unlock(&dev->device_lock);
154 ret = wait_event_interruptible_timeout(dev->wait_recvd_msg,
155 dev->hbm_state == MEI_HBM_IDLE ||
Tomas Winkler544f9462014-01-08 20:19:21 +0200156 dev->hbm_state >= MEI_HBM_STARTED,
Tomas Winkler7d93e582014-01-14 23:10:10 +0200157 mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300158 mutex_lock(&dev->device_lock);
159
160 if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
161 dev->hbm_state = MEI_HBM_IDLE;
Masanari Iida8b513d02013-05-21 23:13:12 +0900162 dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
Alexander Usyskin7ca96aa2014-02-19 17:35:49 +0200163 return -ETIME;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300164 }
165 return 0;
166}
167
Tomas Winkler6bbda152012-12-25 19:06:12 +0200168/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200169 * mei_hbm_start_req - sends start request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200170 *
171 * @dev: the device structure
Tomas Winkler544f9462014-01-08 20:19:21 +0200172 *
173 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200174 */
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300175int mei_hbm_start_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200176{
Tomas Winklere46f1872012-12-25 19:06:10 +0200177 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200178 struct hbm_host_version_request *start_req;
179 const size_t len = sizeof(struct hbm_host_version_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200180 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200181
Tomas Winklere46f1872012-12-25 19:06:10 +0200182 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200183
184 /* host start message */
Tomas Winklere46f1872012-12-25 19:06:10 +0200185 start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200186 memset(start_req, 0, len);
187 start_req->hbm_cmd = HOST_START_REQ_CMD;
188 start_req->host_version.major_version = HBM_MAJOR_VERSION;
189 start_req->host_version.minor_version = HBM_MINOR_VERSION;
190
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300191 dev->hbm_state = MEI_HBM_IDLE;
Tomas Winkler544f9462014-01-08 20:19:21 +0200192 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
193 if (ret) {
194 dev_err(&dev->pdev->dev, "version message write failed: ret = %d\n",
195 ret);
196 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200197 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200198
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300199 dev->hbm_state = MEI_HBM_START;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200200 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300201 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200202}
203
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300204/*
Tomas Winkler8120e722012-12-25 19:06:11 +0200205 * mei_hbm_enum_clients_req - sends enumeration client request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200206 *
207 * @dev: the device structure
208 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200209 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200210 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200211static int mei_hbm_enum_clients_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200212{
Tomas Winklere46f1872012-12-25 19:06:10 +0200213 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200214 struct hbm_host_enum_request *enum_req;
215 const size_t len = sizeof(struct hbm_host_enum_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200216 int ret;
217
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200218 /* enumerate clients */
Tomas Winklere46f1872012-12-25 19:06:10 +0200219 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200220
Tomas Winklere46f1872012-12-25 19:06:10 +0200221 enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
222 memset(enum_req, 0, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200223 enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
224
Tomas Winkler544f9462014-01-08 20:19:21 +0200225 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
226 if (ret) {
227 dev_err(&dev->pdev->dev, "enumeration request write failed: ret = %d.\n",
228 ret);
229 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200230 }
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300231 dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200232 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler544f9462014-01-08 20:19:21 +0200233 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200234}
235
Tomas Winkler8120e722012-12-25 19:06:11 +0200236/**
Masanari Iida393b1482013-04-05 01:05:05 +0900237 * mei_hbm_prop_req - request property for a single client
Tomas Winkler8120e722012-12-25 19:06:11 +0200238 *
239 * @dev: the device structure
240 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200241 * returns 0 on success and < 0 on failure
Tomas Winkler8120e722012-12-25 19:06:11 +0200242 */
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200243
Tomas Winkler8120e722012-12-25 19:06:11 +0200244static int mei_hbm_prop_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200245{
246
Tomas Winklere46f1872012-12-25 19:06:10 +0200247 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200248 struct hbm_props_request *prop_req;
249 const size_t len = sizeof(struct hbm_props_request);
250 unsigned long next_client_index;
Tomas Winkler1aee3512013-09-02 13:29:45 +0300251 unsigned long client_num;
Tomas Winkler544f9462014-01-08 20:19:21 +0200252 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200253
254 client_num = dev->me_client_presentation_num;
255
256 next_client_index = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX,
257 dev->me_client_index);
258
259 /* We got all client properties */
260 if (next_client_index == MEI_CLIENTS_MAX) {
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300261 dev->hbm_state = MEI_HBM_STARTED;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200262 schedule_work(&dev->init_work);
263
264 return 0;
265 }
266
267 dev->me_clients[client_num].client_id = next_client_index;
268 dev->me_clients[client_num].mei_flow_ctrl_creds = 0;
269
Tomas Winklere46f1872012-12-25 19:06:10 +0200270 mei_hbm_hdr(mei_hdr, len);
271 prop_req = (struct hbm_props_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200272
273 memset(prop_req, 0, sizeof(struct hbm_props_request));
274
275
276 prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
277 prop_req->address = next_client_index;
278
Tomas Winkler544f9462014-01-08 20:19:21 +0200279 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
280 if (ret) {
281 dev_err(&dev->pdev->dev, "properties request write failed: ret = %d\n",
282 ret);
283 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200284 }
285
286 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
287 dev->me_client_index = next_client_index;
288
289 return 0;
290}
291
292/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200293 * mei_hbm_stop_req - send stop request message
Tomas Winklere46f1872012-12-25 19:06:10 +0200294 *
295 * @dev - mei device
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200296 * @cl: client info
297 *
298 * This function returns -EIO on write failure
Tomas Winklere46f1872012-12-25 19:06:10 +0200299 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200300static int mei_hbm_stop_req(struct mei_device *dev)
Tomas Winklere46f1872012-12-25 19:06:10 +0200301{
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200302 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklere46f1872012-12-25 19:06:10 +0200303 struct hbm_host_stop_request *req =
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200304 (struct hbm_host_stop_request *)dev->wr_msg.data;
Tomas Winklere46f1872012-12-25 19:06:10 +0200305 const size_t len = sizeof(struct hbm_host_stop_request);
306
307 mei_hbm_hdr(mei_hdr, len);
308
309 memset(req, 0, len);
310 req->hbm_cmd = HOST_STOP_REQ_CMD;
311 req->reason = DRIVER_STOP_REQUEST;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200312
313 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklere46f1872012-12-25 19:06:10 +0200314}
315
316/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200317 * mei_hbm_cl_flow_control_req - sends flow control request.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200318 *
319 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200320 * @cl: client info
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200321 *
322 * This function returns -EIO on write failure
323 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200324int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200325{
Tomas Winklere46f1872012-12-25 19:06:10 +0200326 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200327 const size_t len = sizeof(struct hbm_flow_control);
328
Tomas Winklere46f1872012-12-25 19:06:10 +0200329 mei_hbm_hdr(mei_hdr, len);
330 mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200331
Tomas Winkler46922182014-03-16 14:35:55 +0200332 cl_dbg(dev, cl, "sending flow control\n");
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200333
Tomas Winklere46f1872012-12-25 19:06:10 +0200334 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200335}
336
337/**
Masanari Iida393b1482013-04-05 01:05:05 +0900338 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
Tomas Winkler6bbda152012-12-25 19:06:12 +0200339 *
Masanari Iida393b1482013-04-05 01:05:05 +0900340 * @dev: the device structure
Tomas Winkler6bbda152012-12-25 19:06:12 +0200341 * @flow: flow control.
Alexander Usyskin12d00662014-02-17 15:13:23 +0200342 *
343 * return 0 on success, < 0 otherwise
Tomas Winkler6bbda152012-12-25 19:06:12 +0200344 */
Alexander Usyskin12d00662014-02-17 15:13:23 +0200345static int mei_hbm_add_single_flow_creds(struct mei_device *dev,
Tomas Winkler6bbda152012-12-25 19:06:12 +0200346 struct hbm_flow_control *flow)
347{
Alexander Usyskin12d00662014-02-17 15:13:23 +0200348 struct mei_me_client *me_cl;
349 int id;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200350
Alexander Usyskin12d00662014-02-17 15:13:23 +0200351 id = mei_me_cl_by_id(dev, flow->me_addr);
352 if (id < 0) {
353 dev_err(&dev->pdev->dev, "no such me client %d\n",
354 flow->me_addr);
355 return id;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200356 }
Alexander Usyskin12d00662014-02-17 15:13:23 +0200357
358 me_cl = &dev->me_clients[id];
359 if (me_cl->props.single_recv_buf) {
360 me_cl->mei_flow_ctrl_creds++;
361 dev_dbg(&dev->pdev->dev, "recv flow ctrl msg ME %d (single).\n",
362 flow->me_addr);
363 dev_dbg(&dev->pdev->dev, "flow control credentials =%d.\n",
364 me_cl->mei_flow_ctrl_creds);
365 } else {
366 BUG(); /* error in flow control */
367 }
368
369 return 0;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200370}
371
372/**
373 * mei_hbm_cl_flow_control_res - flow control response from me
374 *
375 * @dev: the device structure
376 * @flow_control: flow control response bus message
377 */
378static void mei_hbm_cl_flow_control_res(struct mei_device *dev,
379 struct hbm_flow_control *flow_control)
380{
Tomas Winkler31f88f52014-02-17 15:13:25 +0200381 struct mei_cl *cl;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200382
383 if (!flow_control->host_addr) {
384 /* single receive buffer */
385 mei_hbm_add_single_flow_creds(dev, flow_control);
386 return;
387 }
388
389 /* normal connection */
Tomas Winkler31f88f52014-02-17 15:13:25 +0200390 list_for_each_entry(cl, &dev->file_list, link) {
Tomas Winkler6bbda152012-12-25 19:06:12 +0200391 if (mei_hbm_cl_addr_equal(cl, flow_control)) {
392 cl->mei_flow_ctrl_creds++;
393 dev_dbg(&dev->pdev->dev, "flow ctrl msg for host %d ME %d.\n",
394 flow_control->host_addr, flow_control->me_addr);
395 dev_dbg(&dev->pdev->dev, "flow control credentials = %d.\n",
396 cl->mei_flow_ctrl_creds);
397 break;
398 }
399 }
400}
401
402
403/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200404 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200405 *
406 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200407 * @cl: a client to disconnect from
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200408 *
409 * This function returns -EIO on write failure
410 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200411int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200412{
Tomas Winklere46f1872012-12-25 19:06:10 +0200413 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200414 const size_t len = sizeof(struct hbm_client_connect_request);
415
Tomas Winklere46f1872012-12-25 19:06:10 +0200416 mei_hbm_hdr(mei_hdr, len);
417 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200418
Tomas Winklere46f1872012-12-25 19:06:10 +0200419 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200420}
421
422/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200423 * mei_hbm_cl_disconnect_rsp - sends disconnect respose to the FW
424 *
425 * @dev: the device structure
426 * @cl: a client to disconnect from
427 *
428 * This function returns -EIO on write failure
429 */
430int mei_hbm_cl_disconnect_rsp(struct mei_device *dev, struct mei_cl *cl)
431{
432 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
433 const size_t len = sizeof(struct hbm_client_connect_response);
434
435 mei_hbm_hdr(mei_hdr, len);
436 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_RES_CMD, dev->wr_msg.data, len);
437
438 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
439}
440
441/**
Tomas Winkler6bbda152012-12-25 19:06:12 +0200442 * mei_hbm_cl_disconnect_res - disconnect response from ME
443 *
444 * @dev: the device structure
445 * @rs: disconnect response bus message
446 */
447static void mei_hbm_cl_disconnect_res(struct mei_device *dev,
448 struct hbm_client_connect_response *rs)
449{
450 struct mei_cl *cl;
Tomas Winkler64092852014-02-17 15:13:21 +0200451 struct mei_cl_cb *cb, *next;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200452
Alexander Usyskin285e2992014-02-17 15:13:20 +0200453 dev_dbg(&dev->pdev->dev, "hbm: disconnect response cl:host=%02d me=%02d status=%d\n",
454 rs->me_addr, rs->host_addr, rs->status);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200455
Tomas Winkler64092852014-02-17 15:13:21 +0200456 list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
457 cl = cb->cl;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200458
Tomas Winkler64092852014-02-17 15:13:21 +0200459 /* this should not happen */
460 if (WARN_ON(!cl)) {
461 list_del(&cb->list);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200462 return;
463 }
464
Tomas Winkler6bbda152012-12-25 19:06:12 +0200465 if (mei_hbm_cl_addr_equal(cl, rs)) {
Tomas Winkler64092852014-02-17 15:13:21 +0200466 list_del(&cb->list);
Alexander Usyskin285e2992014-02-17 15:13:20 +0200467 if (rs->status == MEI_CL_DISCONN_SUCCESS)
Tomas Winkler6bbda152012-12-25 19:06:12 +0200468 cl->state = MEI_FILE_DISCONNECTED;
469
470 cl->status = 0;
471 cl->timer_count = 0;
472 break;
473 }
474 }
475}
476
477/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200478 * mei_hbm_cl_connect_req - send connection request to specific me client
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200479 *
480 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200481 * @cl: a client to connect to
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200482 *
Tomas Winkler8120e722012-12-25 19:06:11 +0200483 * returns -EIO on write failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200484 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200485int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200486{
Tomas Winklere46f1872012-12-25 19:06:10 +0200487 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200488 const size_t len = sizeof(struct hbm_client_connect_request);
489
Tomas Winklere46f1872012-12-25 19:06:10 +0200490 mei_hbm_hdr(mei_hdr, len);
491 mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200492
Tomas Winklere46f1872012-12-25 19:06:10 +0200493 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200494}
495
496/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200497 * mei_hbm_cl_connect_res - connect response from the ME
Tomas Winkler6bbda152012-12-25 19:06:12 +0200498 *
499 * @dev: the device structure
500 * @rs: connect response bus message
501 */
502static void mei_hbm_cl_connect_res(struct mei_device *dev,
503 struct hbm_client_connect_response *rs)
504{
505
506 struct mei_cl *cl;
Tomas Winkler64092852014-02-17 15:13:21 +0200507 struct mei_cl_cb *cb, *next;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200508
Alexander Usyskin285e2992014-02-17 15:13:20 +0200509 dev_dbg(&dev->pdev->dev, "hbm: connect response cl:host=%02d me=%02d status=%s\n",
510 rs->me_addr, rs->host_addr,
511 mei_cl_conn_status_str(rs->status));
Tomas Winkler6bbda152012-12-25 19:06:12 +0200512
Tomas Winkler64092852014-02-17 15:13:21 +0200513 cl = NULL;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200514
Tomas Winkler64092852014-02-17 15:13:21 +0200515 list_for_each_entry_safe(cb, next, &dev->ctrl_rd_list.list, list) {
Tomas Winkler6bbda152012-12-25 19:06:12 +0200516
Tomas Winkler64092852014-02-17 15:13:21 +0200517 cl = cb->cl;
518 /* this should not happen */
519 if (WARN_ON(!cl)) {
520 list_del_init(&cb->list);
521 continue;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200522 }
Tomas Winkler64092852014-02-17 15:13:21 +0200523
524 if (cb->fop_type != MEI_FOP_CONNECT)
525 continue;
526
527 if (mei_hbm_cl_addr_equal(cl, rs)) {
528 list_del(&cb->list);
529 break;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200530 }
531 }
Tomas Winkler64092852014-02-17 15:13:21 +0200532
533 if (!cl)
534 return;
535
536 cl->timer_count = 0;
537 if (rs->status == MEI_CL_CONN_SUCCESS)
538 cl->state = MEI_FILE_CONNECTED;
539 else
540 cl->state = MEI_FILE_DISCONNECTED;
541 cl->status = mei_cl_conn_status_to_errno(rs->status);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200542}
543
544
545/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200546 * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
547 * host sends disconnect response
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200548 *
549 * @dev: the device structure.
Tomas Winkler8120e722012-12-25 19:06:11 +0200550 * @disconnect_req: disconnect request bus message from the me
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200551 *
552 * returns -ENOMEM on allocation failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200553 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200554static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200555 struct hbm_client_connect_request *disconnect_req)
556{
Tomas Winkler31f88f52014-02-17 15:13:25 +0200557 struct mei_cl *cl;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200558 struct mei_cl_cb *cb;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200559
Tomas Winkler31f88f52014-02-17 15:13:25 +0200560 list_for_each_entry(cl, &dev->file_list, link) {
Tomas Winklercd51ed62012-12-25 19:06:09 +0200561 if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200562 dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
563 disconnect_req->host_addr,
564 disconnect_req->me_addr);
Tomas Winklercd51ed62012-12-25 19:06:09 +0200565 cl->state = MEI_FILE_DISCONNECTED;
566 cl->timer_count = 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200567
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200568 cb = mei_io_cb_init(cl, NULL);
569 if (!cb)
570 return -ENOMEM;
571 cb->fop_type = MEI_FOP_DISCONNECT_RSP;
572 cl_dbg(dev, cl, "add disconnect response as first\n");
573 list_add(&cb->list, &dev->ctrl_wr_list.list);
574
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200575 break;
576 }
577 }
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200578 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200579}
580
581
582/**
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300583 * mei_hbm_version_is_supported - checks whether the driver can
584 * support the hbm version of the device
585 *
586 * @dev: the device structure
587 * returns true if driver can support hbm version of the device
588 */
589bool mei_hbm_version_is_supported(struct mei_device *dev)
590{
591 return (dev->version.major_version < HBM_MAJOR_VERSION) ||
592 (dev->version.major_version == HBM_MAJOR_VERSION &&
593 dev->version.minor_version <= HBM_MINOR_VERSION);
594}
595
596/**
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200597 * mei_hbm_dispatch - bottom half read routine after ISR to
598 * handle the read bus message cmd processing.
599 *
600 * @dev: the device structure
601 * @mei_hdr: header of bus message
Tomas Winkler544f9462014-01-08 20:19:21 +0200602 *
603 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200604 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200605int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200606{
607 struct mei_bus_message *mei_msg;
608 struct mei_me_client *me_client;
609 struct hbm_host_version_response *version_res;
610 struct hbm_client_connect_response *connect_res;
611 struct hbm_client_connect_response *disconnect_res;
612 struct hbm_client_connect_request *disconnect_req;
613 struct hbm_flow_control *flow_control;
614 struct hbm_props_response *props_res;
615 struct hbm_host_enum_response *enum_res;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200616
617 /* read the message to our buffer */
618 BUG_ON(hdr->length >= sizeof(dev->rd_msg_buf));
619 mei_read_slots(dev, dev->rd_msg_buf, hdr->length);
620 mei_msg = (struct mei_bus_message *)dev->rd_msg_buf;
621
Tomas Winkler66ae4602014-01-08 20:19:22 +0200622 /* ignore spurious message and prevent reset nesting
623 * hbm is put to idle during system reset
624 */
625 if (dev->hbm_state == MEI_HBM_IDLE) {
626 dev_dbg(&dev->pdev->dev, "hbm: state is idle ignore spurious messages\n");
627 return 0;
628 }
629
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200630 switch (mei_msg->hbm_cmd) {
631 case HOST_START_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200632 dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");
633
634 dev->init_clients_timer = 0;
635
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200636 version_res = (struct hbm_host_version_response *)mei_msg;
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300637
638 dev_dbg(&dev->pdev->dev, "HBM VERSION: DRIVER=%02d:%02d DEVICE=%02d:%02d\n",
639 HBM_MAJOR_VERSION, HBM_MINOR_VERSION,
640 version_res->me_max_version.major_version,
641 version_res->me_max_version.minor_version);
642
643 if (version_res->host_version_supported) {
644 dev->version.major_version = HBM_MAJOR_VERSION;
645 dev->version.minor_version = HBM_MINOR_VERSION;
646 } else {
647 dev->version.major_version =
648 version_res->me_max_version.major_version;
649 dev->version.minor_version =
650 version_res->me_max_version.minor_version;
651 }
652
653 if (!mei_hbm_version_is_supported(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200654 dev_warn(&dev->pdev->dev, "hbm: start: version mismatch - stopping the driver.\n");
Tomas Winklere46f1872012-12-25 19:06:10 +0200655
Tomas Winkler544f9462014-01-08 20:19:21 +0200656 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200657 if (mei_hbm_stop_req(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200658 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
659 return -EIO;
660 }
661 break;
Tomas Winklere46f1872012-12-25 19:06:10 +0200662 }
663
Tomas Winkler544f9462014-01-08 20:19:21 +0200664 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
665 dev->hbm_state != MEI_HBM_START) {
666 dev_err(&dev->pdev->dev, "hbm: start: state mismatch, [%d, %d]\n",
667 dev->dev_state, dev->hbm_state);
668 return -EPROTO;
669 }
670
671 dev->hbm_state = MEI_HBM_STARTED;
672
673 if (mei_hbm_enum_clients_req(dev)) {
674 dev_err(&dev->pdev->dev, "hbm: start: failed to send enumeration request\n");
675 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200676 }
677
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300678 wake_up_interruptible(&dev->wait_recvd_msg);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200679 break;
680
681 case CLIENT_CONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200682 dev_dbg(&dev->pdev->dev, "hbm: client connect response: message received.\n");
683
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200684 connect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200685 mei_hbm_cl_connect_res(dev, connect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200686 wake_up(&dev->wait_recvd_msg);
687 break;
688
689 case CLIENT_DISCONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200690 dev_dbg(&dev->pdev->dev, "hbm: client disconnect response: message received.\n");
691
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200692 disconnect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200693 mei_hbm_cl_disconnect_res(dev, disconnect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200694 wake_up(&dev->wait_recvd_msg);
695 break;
696
697 case MEI_FLOW_CONTROL_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200698 dev_dbg(&dev->pdev->dev, "hbm: client flow control response: message received.\n");
699
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200700 flow_control = (struct hbm_flow_control *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200701 mei_hbm_cl_flow_control_res(dev, flow_control);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200702 break;
703
704 case HOST_CLIENT_PROPERTIES_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200705 dev_dbg(&dev->pdev->dev, "hbm: properties response: message received.\n");
706
707 dev->init_clients_timer = 0;
708
709 if (dev->me_clients == NULL) {
710 dev_err(&dev->pdev->dev, "hbm: properties response: mei_clients not allocated\n");
711 return -EPROTO;
712 }
713
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200714 props_res = (struct hbm_props_response *)mei_msg;
715 me_client = &dev->me_clients[dev->me_client_presentation_num];
716
Tomas Winkler544f9462014-01-08 20:19:21 +0200717 if (props_res->status) {
718 dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
719 props_res->status);
720 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200721 }
722
723 if (me_client->client_id != props_res->address) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200724 dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
725 me_client->client_id, props_res->address);
726 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200727 }
728
729 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300730 dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200731 dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
732 dev->dev_state, dev->hbm_state);
733 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200734 }
735
736 me_client->props = props_res->client_properties;
737 dev->me_client_index++;
738 dev->me_client_presentation_num++;
739
Tomas Winkler8120e722012-12-25 19:06:11 +0200740 /* request property for the next client */
Tomas Winkler544f9462014-01-08 20:19:21 +0200741 if (mei_hbm_prop_req(dev))
742 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200743
744 break;
745
746 case HOST_ENUM_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200747 dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");
748
749 dev->init_clients_timer = 0;
750
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200751 enum_res = (struct hbm_host_enum_response *) mei_msg;
Tomas Winkler23f5a322013-09-02 03:11:01 +0300752 BUILD_BUG_ON(sizeof(dev->me_clients_map)
753 < sizeof(enum_res->valid_addresses));
754 memcpy(dev->me_clients_map, enum_res->valid_addresses,
755 sizeof(enum_res->valid_addresses));
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200756
Tomas Winkler544f9462014-01-08 20:19:21 +0200757 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
758 dev->hbm_state != MEI_HBM_ENUM_CLIENTS) {
759 dev_err(&dev->pdev->dev, "hbm: enumeration response: state mismatch, [%d, %d]\n",
760 dev->dev_state, dev->hbm_state);
761 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200762 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200763
764 if (mei_hbm_me_cl_allocate(dev)) {
765 dev_err(&dev->pdev->dev, "hbm: enumeration response: cannot allocate clients array\n");
766 return -ENOMEM;
767 }
768
769 dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;
770
771 /* first property request */
772 if (mei_hbm_prop_req(dev))
773 return -EIO;
774
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200775 break;
776
777 case HOST_STOP_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200778 dev_dbg(&dev->pdev->dev, "hbm: stop response: message received\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300779
Tomas Winkler544f9462014-01-08 20:19:21 +0200780 dev->init_clients_timer = 0;
781
782 if (dev->hbm_state != MEI_HBM_STOPPED) {
783 dev_err(&dev->pdev->dev, "hbm: stop response: state mismatch, [%d, %d]\n",
784 dev->dev_state, dev->hbm_state);
785 return -EPROTO;
786 }
787
Tomas Winkler33ec0822014-01-12 00:36:09 +0200788 dev->dev_state = MEI_DEV_POWER_DOWN;
Tomas Winkler544f9462014-01-08 20:19:21 +0200789 dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
790 /* force the reset */
791 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200792 break;
793
794 case CLIENT_DISCONNECT_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200795 dev_dbg(&dev->pdev->dev, "hbm: disconnect request: message received\n");
796
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200797 disconnect_req = (struct hbm_client_connect_request *)mei_msg;
Tomas Winkler8120e722012-12-25 19:06:11 +0200798 mei_hbm_fw_disconnect_req(dev, disconnect_req);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200799 break;
800
801 case ME_STOP_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200802 dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200803 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200804 if (mei_hbm_stop_req(dev)) {
805 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
806 return -EIO;
807 }
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200808 break;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200809 default:
810 BUG();
811 break;
812
813 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200814 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200815}
816