blob: d360e9a5a1a50166d5aac0b2cd84d0c276a7f539 [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"
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 Winkler6bbda152012-12-25 19:06:12 +0200137 * is_treat_specially_client - checks if the message belongs
138 * to the file private data.
139 *
140 * @cl: private data of the file object
141 * @rs: connect response bus message
142 *
143 */
144static bool is_treat_specially_client(struct mei_cl *cl,
145 struct hbm_client_connect_response *rs)
146{
147 if (mei_hbm_cl_addr_equal(cl, rs)) {
Alexander Usyskin285e2992014-02-17 15:13:20 +0200148 if (rs->status == MEI_CL_CONN_SUCCESS)
Tomas Winkler6bbda152012-12-25 19:06:12 +0200149 cl->state = MEI_FILE_CONNECTED;
Alexander Usyskin285e2992014-02-17 15:13:20 +0200150 else
Tomas Winkler6bbda152012-12-25 19:06:12 +0200151 cl->state = MEI_FILE_DISCONNECTED;
Alexander Usyskin285e2992014-02-17 15:13:20 +0200152 cl->status = mei_cl_conn_status_to_errno(rs->status);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200153 cl->timer_count = 0;
154
155 return true;
156 }
157 return false;
158}
159
Tomas Winkler66ae4602014-01-08 20:19:22 +0200160/**
161 * mei_hbm_idle - set hbm to idle state
162 *
163 * @dev: the device structure
164 */
165void mei_hbm_idle(struct mei_device *dev)
166{
167 dev->init_clients_timer = 0;
168 dev->hbm_state = MEI_HBM_IDLE;
169}
170
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300171int mei_hbm_start_wait(struct mei_device *dev)
172{
173 int ret;
174 if (dev->hbm_state > MEI_HBM_START)
175 return 0;
176
177 mutex_unlock(&dev->device_lock);
178 ret = wait_event_interruptible_timeout(dev->wait_recvd_msg,
179 dev->hbm_state == MEI_HBM_IDLE ||
Tomas Winkler544f9462014-01-08 20:19:21 +0200180 dev->hbm_state >= MEI_HBM_STARTED,
Tomas Winkler7d93e582014-01-14 23:10:10 +0200181 mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300182 mutex_lock(&dev->device_lock);
183
184 if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
185 dev->hbm_state = MEI_HBM_IDLE;
Masanari Iida8b513d02013-05-21 23:13:12 +0900186 dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300187 return -ETIMEDOUT;
188 }
189 return 0;
190}
191
Tomas Winkler6bbda152012-12-25 19:06:12 +0200192/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200193 * mei_hbm_start_req - sends start request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200194 *
195 * @dev: the device structure
Tomas Winkler544f9462014-01-08 20:19:21 +0200196 *
197 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200198 */
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300199int mei_hbm_start_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200200{
Tomas Winklere46f1872012-12-25 19:06:10 +0200201 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200202 struct hbm_host_version_request *start_req;
203 const size_t len = sizeof(struct hbm_host_version_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200204 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200205
Tomas Winklere46f1872012-12-25 19:06:10 +0200206 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200207
208 /* host start message */
Tomas Winklere46f1872012-12-25 19:06:10 +0200209 start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200210 memset(start_req, 0, len);
211 start_req->hbm_cmd = HOST_START_REQ_CMD;
212 start_req->host_version.major_version = HBM_MAJOR_VERSION;
213 start_req->host_version.minor_version = HBM_MINOR_VERSION;
214
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300215 dev->hbm_state = MEI_HBM_IDLE;
Tomas Winkler544f9462014-01-08 20:19:21 +0200216 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
217 if (ret) {
218 dev_err(&dev->pdev->dev, "version message write failed: ret = %d\n",
219 ret);
220 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200221 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200222
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300223 dev->hbm_state = MEI_HBM_START;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200224 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300225 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200226}
227
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300228/*
Tomas Winkler8120e722012-12-25 19:06:11 +0200229 * mei_hbm_enum_clients_req - sends enumeration client request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200230 *
231 * @dev: the device structure
232 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200233 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200234 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200235static int mei_hbm_enum_clients_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200236{
Tomas Winklere46f1872012-12-25 19:06:10 +0200237 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200238 struct hbm_host_enum_request *enum_req;
239 const size_t len = sizeof(struct hbm_host_enum_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200240 int ret;
241
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200242 /* enumerate clients */
Tomas Winklere46f1872012-12-25 19:06:10 +0200243 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200244
Tomas Winklere46f1872012-12-25 19:06:10 +0200245 enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
246 memset(enum_req, 0, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200247 enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
248
Tomas Winkler544f9462014-01-08 20:19:21 +0200249 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
250 if (ret) {
251 dev_err(&dev->pdev->dev, "enumeration request write failed: ret = %d.\n",
252 ret);
253 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200254 }
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300255 dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200256 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler544f9462014-01-08 20:19:21 +0200257 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200258}
259
Tomas Winkler8120e722012-12-25 19:06:11 +0200260/**
Masanari Iida393b1482013-04-05 01:05:05 +0900261 * mei_hbm_prop_req - request property for a single client
Tomas Winkler8120e722012-12-25 19:06:11 +0200262 *
263 * @dev: the device structure
264 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200265 * returns 0 on success and < 0 on failure
Tomas Winkler8120e722012-12-25 19:06:11 +0200266 */
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200267
Tomas Winkler8120e722012-12-25 19:06:11 +0200268static int mei_hbm_prop_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200269{
270
Tomas Winklere46f1872012-12-25 19:06:10 +0200271 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200272 struct hbm_props_request *prop_req;
273 const size_t len = sizeof(struct hbm_props_request);
274 unsigned long next_client_index;
Tomas Winkler1aee3512013-09-02 13:29:45 +0300275 unsigned long client_num;
Tomas Winkler544f9462014-01-08 20:19:21 +0200276 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200277
278 client_num = dev->me_client_presentation_num;
279
280 next_client_index = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX,
281 dev->me_client_index);
282
283 /* We got all client properties */
284 if (next_client_index == MEI_CLIENTS_MAX) {
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300285 dev->hbm_state = MEI_HBM_STARTED;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200286 schedule_work(&dev->init_work);
287
288 return 0;
289 }
290
291 dev->me_clients[client_num].client_id = next_client_index;
292 dev->me_clients[client_num].mei_flow_ctrl_creds = 0;
293
Tomas Winklere46f1872012-12-25 19:06:10 +0200294 mei_hbm_hdr(mei_hdr, len);
295 prop_req = (struct hbm_props_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200296
297 memset(prop_req, 0, sizeof(struct hbm_props_request));
298
299
300 prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
301 prop_req->address = next_client_index;
302
Tomas Winkler544f9462014-01-08 20:19:21 +0200303 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
304 if (ret) {
305 dev_err(&dev->pdev->dev, "properties request write failed: ret = %d\n",
306 ret);
307 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200308 }
309
310 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
311 dev->me_client_index = next_client_index;
312
313 return 0;
314}
315
316/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200317 * mei_hbm_stop_req - send stop request message
Tomas Winklere46f1872012-12-25 19:06:10 +0200318 *
319 * @dev - mei device
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200320 * @cl: client info
321 *
322 * This function returns -EIO on write failure
Tomas Winklere46f1872012-12-25 19:06:10 +0200323 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200324static int mei_hbm_stop_req(struct mei_device *dev)
Tomas Winklere46f1872012-12-25 19:06:10 +0200325{
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200326 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklere46f1872012-12-25 19:06:10 +0200327 struct hbm_host_stop_request *req =
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200328 (struct hbm_host_stop_request *)dev->wr_msg.data;
Tomas Winklere46f1872012-12-25 19:06:10 +0200329 const size_t len = sizeof(struct hbm_host_stop_request);
330
331 mei_hbm_hdr(mei_hdr, len);
332
333 memset(req, 0, len);
334 req->hbm_cmd = HOST_STOP_REQ_CMD;
335 req->reason = DRIVER_STOP_REQUEST;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200336
337 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklere46f1872012-12-25 19:06:10 +0200338}
339
340/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200341 * mei_hbm_cl_flow_control_req - sends flow control request.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200342 *
343 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200344 * @cl: client info
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200345 *
346 * This function returns -EIO on write failure
347 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200348int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200349{
Tomas Winklere46f1872012-12-25 19:06:10 +0200350 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200351 const size_t len = sizeof(struct hbm_flow_control);
352
Tomas Winklere46f1872012-12-25 19:06:10 +0200353 mei_hbm_hdr(mei_hdr, len);
354 mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200355
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200356 dev_dbg(&dev->pdev->dev, "sending flow control host client = %d, ME client = %d\n",
357 cl->host_client_id, cl->me_client_id);
358
Tomas Winklere46f1872012-12-25 19:06:10 +0200359 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200360}
361
362/**
Masanari Iida393b1482013-04-05 01:05:05 +0900363 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
Tomas Winkler6bbda152012-12-25 19:06:12 +0200364 *
Masanari Iida393b1482013-04-05 01:05:05 +0900365 * @dev: the device structure
Tomas Winkler6bbda152012-12-25 19:06:12 +0200366 * @flow: flow control.
367 */
368static void mei_hbm_add_single_flow_creds(struct mei_device *dev,
369 struct hbm_flow_control *flow)
370{
371 struct mei_me_client *client;
372 int i;
373
374 for (i = 0; i < dev->me_clients_num; i++) {
375 client = &dev->me_clients[i];
376 if (client && flow->me_addr == client->client_id) {
377 if (client->props.single_recv_buf) {
378 client->mei_flow_ctrl_creds++;
379 dev_dbg(&dev->pdev->dev, "recv flow ctrl msg ME %d (single).\n",
380 flow->me_addr);
381 dev_dbg(&dev->pdev->dev, "flow control credentials =%d.\n",
382 client->mei_flow_ctrl_creds);
383 } else {
384 BUG(); /* error in flow control */
385 }
386 }
387 }
388}
389
390/**
391 * mei_hbm_cl_flow_control_res - flow control response from me
392 *
393 * @dev: the device structure
394 * @flow_control: flow control response bus message
395 */
396static void mei_hbm_cl_flow_control_res(struct mei_device *dev,
397 struct hbm_flow_control *flow_control)
398{
399 struct mei_cl *cl = NULL;
400 struct mei_cl *next = NULL;
401
402 if (!flow_control->host_addr) {
403 /* single receive buffer */
404 mei_hbm_add_single_flow_creds(dev, flow_control);
405 return;
406 }
407
408 /* normal connection */
409 list_for_each_entry_safe(cl, next, &dev->file_list, link) {
410 if (mei_hbm_cl_addr_equal(cl, flow_control)) {
411 cl->mei_flow_ctrl_creds++;
412 dev_dbg(&dev->pdev->dev, "flow ctrl msg for host %d ME %d.\n",
413 flow_control->host_addr, flow_control->me_addr);
414 dev_dbg(&dev->pdev->dev, "flow control credentials = %d.\n",
415 cl->mei_flow_ctrl_creds);
416 break;
417 }
418 }
419}
420
421
422/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200423 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200424 *
425 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200426 * @cl: a client to disconnect from
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200427 *
428 * This function returns -EIO on write failure
429 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200430int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200431{
Tomas Winklere46f1872012-12-25 19:06:10 +0200432 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200433 const size_t len = sizeof(struct hbm_client_connect_request);
434
Tomas Winklere46f1872012-12-25 19:06:10 +0200435 mei_hbm_hdr(mei_hdr, len);
436 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200437
Tomas Winklere46f1872012-12-25 19:06:10 +0200438 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200439}
440
441/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200442 * mei_hbm_cl_disconnect_rsp - sends disconnect respose to the FW
443 *
444 * @dev: the device structure
445 * @cl: a client to disconnect from
446 *
447 * This function returns -EIO on write failure
448 */
449int mei_hbm_cl_disconnect_rsp(struct mei_device *dev, struct mei_cl *cl)
450{
451 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
452 const size_t len = sizeof(struct hbm_client_connect_response);
453
454 mei_hbm_hdr(mei_hdr, len);
455 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_RES_CMD, dev->wr_msg.data, len);
456
457 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
458}
459
460/**
Tomas Winkler6bbda152012-12-25 19:06:12 +0200461 * mei_hbm_cl_disconnect_res - disconnect response from ME
462 *
463 * @dev: the device structure
464 * @rs: disconnect response bus message
465 */
466static void mei_hbm_cl_disconnect_res(struct mei_device *dev,
467 struct hbm_client_connect_response *rs)
468{
469 struct mei_cl *cl;
470 struct mei_cl_cb *pos = NULL, *next = NULL;
471
Alexander Usyskin285e2992014-02-17 15:13:20 +0200472 dev_dbg(&dev->pdev->dev, "hbm: disconnect response cl:host=%02d me=%02d status=%d\n",
473 rs->me_addr, rs->host_addr, rs->status);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200474
475 list_for_each_entry_safe(pos, next, &dev->ctrl_rd_list.list, list) {
476 cl = pos->cl;
477
478 if (!cl) {
479 list_del(&pos->list);
480 return;
481 }
482
483 dev_dbg(&dev->pdev->dev, "list_for_each_entry_safe in ctrl_rd_list.\n");
484 if (mei_hbm_cl_addr_equal(cl, rs)) {
485 list_del(&pos->list);
Alexander Usyskin285e2992014-02-17 15:13:20 +0200486 if (rs->status == MEI_CL_DISCONN_SUCCESS)
Tomas Winkler6bbda152012-12-25 19:06:12 +0200487 cl->state = MEI_FILE_DISCONNECTED;
488
489 cl->status = 0;
490 cl->timer_count = 0;
491 break;
492 }
493 }
494}
495
496/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200497 * mei_hbm_cl_connect_req - send connection request to specific me client
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200498 *
499 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200500 * @cl: a client to connect to
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200501 *
Tomas Winkler8120e722012-12-25 19:06:11 +0200502 * returns -EIO on write failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200503 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200504int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200505{
Tomas Winklere46f1872012-12-25 19:06:10 +0200506 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200507 const size_t len = sizeof(struct hbm_client_connect_request);
508
Tomas Winklere46f1872012-12-25 19:06:10 +0200509 mei_hbm_hdr(mei_hdr, len);
510 mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200511
Tomas Winklere46f1872012-12-25 19:06:10 +0200512 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200513}
514
515/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200516 * mei_hbm_cl_connect_res - connect response from the ME
Tomas Winkler6bbda152012-12-25 19:06:12 +0200517 *
518 * @dev: the device structure
519 * @rs: connect response bus message
520 */
521static void mei_hbm_cl_connect_res(struct mei_device *dev,
522 struct hbm_client_connect_response *rs)
523{
524
525 struct mei_cl *cl;
526 struct mei_cl_cb *pos = NULL, *next = NULL;
527
Alexander Usyskin285e2992014-02-17 15:13:20 +0200528 dev_dbg(&dev->pdev->dev, "hbm: connect response cl:host=%02d me=%02d status=%s\n",
529 rs->me_addr, rs->host_addr,
530 mei_cl_conn_status_str(rs->status));
Tomas Winkler6bbda152012-12-25 19:06:12 +0200531
532 /* if WD or iamthif client treat specially */
533
534 if (is_treat_specially_client(&dev->wd_cl, rs)) {
535 dev_dbg(&dev->pdev->dev, "successfully connected to WD client.\n");
536 mei_watchdog_register(dev);
537
538 return;
539 }
540
541 if (is_treat_specially_client(&dev->iamthif_cl, rs)) {
542 dev->iamthif_state = MEI_IAMTHIF_IDLE;
543 return;
544 }
545 list_for_each_entry_safe(pos, next, &dev->ctrl_rd_list.list, list) {
546
547 cl = pos->cl;
548 if (!cl) {
549 list_del(&pos->list);
550 return;
551 }
Tomas Winkler02a7eec2014-02-12 21:41:51 +0200552 if (pos->fop_type == MEI_FOP_CONNECT) {
Tomas Winkler6bbda152012-12-25 19:06:12 +0200553 if (is_treat_specially_client(cl, rs)) {
554 list_del(&pos->list);
Tomas Winkler6bbda152012-12-25 19:06:12 +0200555 cl->timer_count = 0;
556 break;
557 }
558 }
559 }
560}
561
562
563/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200564 * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
565 * host sends disconnect response
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200566 *
567 * @dev: the device structure.
Tomas Winkler8120e722012-12-25 19:06:11 +0200568 * @disconnect_req: disconnect request bus message from the me
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200569 *
570 * returns -ENOMEM on allocation failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200571 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200572static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200573 struct hbm_client_connect_request *disconnect_req)
574{
Tomas Winklercd51ed62012-12-25 19:06:09 +0200575 struct mei_cl *cl, *next;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200576 struct mei_cl_cb *cb;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200577
Tomas Winklercd51ed62012-12-25 19:06:09 +0200578 list_for_each_entry_safe(cl, next, &dev->file_list, link) {
579 if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200580 dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
581 disconnect_req->host_addr,
582 disconnect_req->me_addr);
Tomas Winklercd51ed62012-12-25 19:06:09 +0200583 cl->state = MEI_FILE_DISCONNECTED;
584 cl->timer_count = 0;
585 if (cl == &dev->wd_cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200586 dev->wd_pending = false;
Tomas Winklercd51ed62012-12-25 19:06:09 +0200587 else if (cl == &dev->iamthif_cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200588 dev->iamthif_timer = 0;
589
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200590 cb = mei_io_cb_init(cl, NULL);
591 if (!cb)
592 return -ENOMEM;
593 cb->fop_type = MEI_FOP_DISCONNECT_RSP;
594 cl_dbg(dev, cl, "add disconnect response as first\n");
595 list_add(&cb->list, &dev->ctrl_wr_list.list);
596
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200597 break;
598 }
599 }
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200600 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200601}
602
603
604/**
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300605 * mei_hbm_version_is_supported - checks whether the driver can
606 * support the hbm version of the device
607 *
608 * @dev: the device structure
609 * returns true if driver can support hbm version of the device
610 */
611bool mei_hbm_version_is_supported(struct mei_device *dev)
612{
613 return (dev->version.major_version < HBM_MAJOR_VERSION) ||
614 (dev->version.major_version == HBM_MAJOR_VERSION &&
615 dev->version.minor_version <= HBM_MINOR_VERSION);
616}
617
618/**
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200619 * mei_hbm_dispatch - bottom half read routine after ISR to
620 * handle the read bus message cmd processing.
621 *
622 * @dev: the device structure
623 * @mei_hdr: header of bus message
Tomas Winkler544f9462014-01-08 20:19:21 +0200624 *
625 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200626 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200627int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200628{
629 struct mei_bus_message *mei_msg;
630 struct mei_me_client *me_client;
631 struct hbm_host_version_response *version_res;
632 struct hbm_client_connect_response *connect_res;
633 struct hbm_client_connect_response *disconnect_res;
634 struct hbm_client_connect_request *disconnect_req;
635 struct hbm_flow_control *flow_control;
636 struct hbm_props_response *props_res;
637 struct hbm_host_enum_response *enum_res;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200638
639 /* read the message to our buffer */
640 BUG_ON(hdr->length >= sizeof(dev->rd_msg_buf));
641 mei_read_slots(dev, dev->rd_msg_buf, hdr->length);
642 mei_msg = (struct mei_bus_message *)dev->rd_msg_buf;
643
Tomas Winkler66ae4602014-01-08 20:19:22 +0200644 /* ignore spurious message and prevent reset nesting
645 * hbm is put to idle during system reset
646 */
647 if (dev->hbm_state == MEI_HBM_IDLE) {
648 dev_dbg(&dev->pdev->dev, "hbm: state is idle ignore spurious messages\n");
649 return 0;
650 }
651
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200652 switch (mei_msg->hbm_cmd) {
653 case HOST_START_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200654 dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");
655
656 dev->init_clients_timer = 0;
657
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200658 version_res = (struct hbm_host_version_response *)mei_msg;
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300659
660 dev_dbg(&dev->pdev->dev, "HBM VERSION: DRIVER=%02d:%02d DEVICE=%02d:%02d\n",
661 HBM_MAJOR_VERSION, HBM_MINOR_VERSION,
662 version_res->me_max_version.major_version,
663 version_res->me_max_version.minor_version);
664
665 if (version_res->host_version_supported) {
666 dev->version.major_version = HBM_MAJOR_VERSION;
667 dev->version.minor_version = HBM_MINOR_VERSION;
668 } else {
669 dev->version.major_version =
670 version_res->me_max_version.major_version;
671 dev->version.minor_version =
672 version_res->me_max_version.minor_version;
673 }
674
675 if (!mei_hbm_version_is_supported(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200676 dev_warn(&dev->pdev->dev, "hbm: start: version mismatch - stopping the driver.\n");
Tomas Winklere46f1872012-12-25 19:06:10 +0200677
Tomas Winkler544f9462014-01-08 20:19:21 +0200678 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200679 if (mei_hbm_stop_req(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200680 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
681 return -EIO;
682 }
683 break;
Tomas Winklere46f1872012-12-25 19:06:10 +0200684 }
685
Tomas Winkler544f9462014-01-08 20:19:21 +0200686 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
687 dev->hbm_state != MEI_HBM_START) {
688 dev_err(&dev->pdev->dev, "hbm: start: state mismatch, [%d, %d]\n",
689 dev->dev_state, dev->hbm_state);
690 return -EPROTO;
691 }
692
693 dev->hbm_state = MEI_HBM_STARTED;
694
695 if (mei_hbm_enum_clients_req(dev)) {
696 dev_err(&dev->pdev->dev, "hbm: start: failed to send enumeration request\n");
697 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200698 }
699
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300700 wake_up_interruptible(&dev->wait_recvd_msg);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200701 break;
702
703 case CLIENT_CONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200704 dev_dbg(&dev->pdev->dev, "hbm: client connect response: message received.\n");
705
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200706 connect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200707 mei_hbm_cl_connect_res(dev, connect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200708 wake_up(&dev->wait_recvd_msg);
709 break;
710
711 case CLIENT_DISCONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200712 dev_dbg(&dev->pdev->dev, "hbm: client disconnect response: message received.\n");
713
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200714 disconnect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200715 mei_hbm_cl_disconnect_res(dev, disconnect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200716 wake_up(&dev->wait_recvd_msg);
717 break;
718
719 case MEI_FLOW_CONTROL_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200720 dev_dbg(&dev->pdev->dev, "hbm: client flow control response: message received.\n");
721
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200722 flow_control = (struct hbm_flow_control *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200723 mei_hbm_cl_flow_control_res(dev, flow_control);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200724 break;
725
726 case HOST_CLIENT_PROPERTIES_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200727 dev_dbg(&dev->pdev->dev, "hbm: properties response: message received.\n");
728
729 dev->init_clients_timer = 0;
730
731 if (dev->me_clients == NULL) {
732 dev_err(&dev->pdev->dev, "hbm: properties response: mei_clients not allocated\n");
733 return -EPROTO;
734 }
735
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200736 props_res = (struct hbm_props_response *)mei_msg;
737 me_client = &dev->me_clients[dev->me_client_presentation_num];
738
Tomas Winkler544f9462014-01-08 20:19:21 +0200739 if (props_res->status) {
740 dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
741 props_res->status);
742 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200743 }
744
745 if (me_client->client_id != props_res->address) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200746 dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
747 me_client->client_id, props_res->address);
748 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200749 }
750
751 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300752 dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200753 dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
754 dev->dev_state, dev->hbm_state);
755 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200756 }
757
758 me_client->props = props_res->client_properties;
759 dev->me_client_index++;
760 dev->me_client_presentation_num++;
761
Tomas Winkler8120e722012-12-25 19:06:11 +0200762 /* request property for the next client */
Tomas Winkler544f9462014-01-08 20:19:21 +0200763 if (mei_hbm_prop_req(dev))
764 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200765
766 break;
767
768 case HOST_ENUM_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200769 dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");
770
771 dev->init_clients_timer = 0;
772
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200773 enum_res = (struct hbm_host_enum_response *) mei_msg;
Tomas Winkler23f5a322013-09-02 03:11:01 +0300774 BUILD_BUG_ON(sizeof(dev->me_clients_map)
775 < sizeof(enum_res->valid_addresses));
776 memcpy(dev->me_clients_map, enum_res->valid_addresses,
777 sizeof(enum_res->valid_addresses));
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200778
Tomas Winkler544f9462014-01-08 20:19:21 +0200779 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
780 dev->hbm_state != MEI_HBM_ENUM_CLIENTS) {
781 dev_err(&dev->pdev->dev, "hbm: enumeration response: state mismatch, [%d, %d]\n",
782 dev->dev_state, dev->hbm_state);
783 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200784 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200785
786 if (mei_hbm_me_cl_allocate(dev)) {
787 dev_err(&dev->pdev->dev, "hbm: enumeration response: cannot allocate clients array\n");
788 return -ENOMEM;
789 }
790
791 dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;
792
793 /* first property request */
794 if (mei_hbm_prop_req(dev))
795 return -EIO;
796
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200797 break;
798
799 case HOST_STOP_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200800 dev_dbg(&dev->pdev->dev, "hbm: stop response: message received\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300801
Tomas Winkler544f9462014-01-08 20:19:21 +0200802 dev->init_clients_timer = 0;
803
804 if (dev->hbm_state != MEI_HBM_STOPPED) {
805 dev_err(&dev->pdev->dev, "hbm: stop response: state mismatch, [%d, %d]\n",
806 dev->dev_state, dev->hbm_state);
807 return -EPROTO;
808 }
809
Tomas Winkler33ec0822014-01-12 00:36:09 +0200810 dev->dev_state = MEI_DEV_POWER_DOWN;
Tomas Winkler544f9462014-01-08 20:19:21 +0200811 dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
812 /* force the reset */
813 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200814 break;
815
816 case CLIENT_DISCONNECT_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200817 dev_dbg(&dev->pdev->dev, "hbm: disconnect request: message received\n");
818
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200819 disconnect_req = (struct hbm_client_connect_request *)mei_msg;
Tomas Winkler8120e722012-12-25 19:06:11 +0200820 mei_hbm_fw_disconnect_req(dev, disconnect_req);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200821 break;
822
823 case ME_STOP_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200824 dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200825 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200826 if (mei_hbm_stop_req(dev)) {
827 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
828 return -EIO;
829 }
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200830 break;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200831 default:
832 BUG();
833 break;
834
835 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200836 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200837}
838