blob: d3fcb23bb0810179266b5f294b26c06fc7221a74 [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
26/**
Tomas Winklera40b2602013-01-08 23:07:19 +020027 * mei_hbm_me_cl_allocate - allocates storage for me clients
28 *
29 * @dev: the device structure
30 *
Tomas Winkler544f9462014-01-08 20:19:21 +020031 * returns 0 on success -ENOMEM on allocation failure
Tomas Winklera40b2602013-01-08 23:07:19 +020032 */
Tomas Winkler544f9462014-01-08 20:19:21 +020033static int mei_hbm_me_cl_allocate(struct mei_device *dev)
Tomas Winklera40b2602013-01-08 23:07:19 +020034{
35 struct mei_me_client *clients;
36 int b;
37
Tomas Winkler1aee3512013-09-02 13:29:45 +030038 dev->me_clients_num = 0;
39 dev->me_client_presentation_num = 0;
40 dev->me_client_index = 0;
41
Tomas Winklera40b2602013-01-08 23:07:19 +020042 /* count how many ME clients we have */
43 for_each_set_bit(b, dev->me_clients_map, MEI_CLIENTS_MAX)
44 dev->me_clients_num++;
45
Tomas Winkler1aee3512013-09-02 13:29:45 +030046 if (dev->me_clients_num == 0)
Tomas Winkler544f9462014-01-08 20:19:21 +020047 return 0;
Tomas Winklera40b2602013-01-08 23:07:19 +020048
49 kfree(dev->me_clients);
50 dev->me_clients = NULL;
51
Tomas Winklere19555c2013-09-02 03:11:03 +030052 dev_dbg(&dev->pdev->dev, "memory allocation for ME clients size=%ld.\n",
Tomas Winklera40b2602013-01-08 23:07:19 +020053 dev->me_clients_num * sizeof(struct mei_me_client));
54 /* allocate storage for ME clients representation */
55 clients = kcalloc(dev->me_clients_num,
56 sizeof(struct mei_me_client), GFP_KERNEL);
57 if (!clients) {
58 dev_err(&dev->pdev->dev, "memory allocation for ME clients failed.\n");
Tomas Winkler544f9462014-01-08 20:19:21 +020059 return -ENOMEM;
Tomas Winklera40b2602013-01-08 23:07:19 +020060 }
61 dev->me_clients = clients;
Tomas Winkler544f9462014-01-08 20:19:21 +020062 return 0;
Tomas Winklera40b2602013-01-08 23:07:19 +020063}
64
65/**
Tomas Winklercd51ed62012-12-25 19:06:09 +020066 * mei_hbm_cl_hdr - construct client hbm header
Masanari Iida393b1482013-04-05 01:05:05 +090067 *
Tomas Winklercd51ed62012-12-25 19:06:09 +020068 * @cl: - client
69 * @hbm_cmd: host bus message command
70 * @buf: buffer for cl header
71 * @len: buffer length
72 */
73static inline
74void mei_hbm_cl_hdr(struct mei_cl *cl, u8 hbm_cmd, void *buf, size_t len)
75{
76 struct mei_hbm_cl_cmd *cmd = buf;
77
78 memset(cmd, 0, len);
79
80 cmd->hbm_cmd = hbm_cmd;
81 cmd->host_addr = cl->host_client_id;
82 cmd->me_addr = cl->me_client_id;
83}
84
85/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +020086 * mei_hbm_cl_addr_equal - tells if they have the same address
Tomas Winklercd51ed62012-12-25 19:06:09 +020087 *
Alexander Usyskin83ce0742014-01-08 22:31:46 +020088 * @cl: - client
89 * @buf: buffer with cl header
Tomas Winklercd51ed62012-12-25 19:06:09 +020090 *
Alexander Usyskin83ce0742014-01-08 22:31:46 +020091 * returns true if addresses are the same
Tomas Winklercd51ed62012-12-25 19:06:09 +020092 */
93static inline
94bool mei_hbm_cl_addr_equal(struct mei_cl *cl, void *buf)
95{
96 struct mei_hbm_cl_cmd *cmd = buf;
97 return cl->host_client_id == cmd->host_addr &&
98 cl->me_client_id == cmd->me_addr;
99}
100
101
102/**
Tomas Winkler6bbda152012-12-25 19:06:12 +0200103 * is_treat_specially_client - checks if the message belongs
104 * to the file private data.
105 *
106 * @cl: private data of the file object
107 * @rs: connect response bus message
108 *
109 */
110static bool is_treat_specially_client(struct mei_cl *cl,
111 struct hbm_client_connect_response *rs)
112{
113 if (mei_hbm_cl_addr_equal(cl, rs)) {
114 if (!rs->status) {
115 cl->state = MEI_FILE_CONNECTED;
116 cl->status = 0;
117
118 } else {
119 cl->state = MEI_FILE_DISCONNECTED;
120 cl->status = -ENODEV;
121 }
122 cl->timer_count = 0;
123
124 return true;
125 }
126 return false;
127}
128
Tomas Winkler66ae4602014-01-08 20:19:22 +0200129/**
130 * mei_hbm_idle - set hbm to idle state
131 *
132 * @dev: the device structure
133 */
134void mei_hbm_idle(struct mei_device *dev)
135{
136 dev->init_clients_timer = 0;
137 dev->hbm_state = MEI_HBM_IDLE;
138}
139
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300140int mei_hbm_start_wait(struct mei_device *dev)
141{
142 int ret;
143 if (dev->hbm_state > MEI_HBM_START)
144 return 0;
145
146 mutex_unlock(&dev->device_lock);
147 ret = wait_event_interruptible_timeout(dev->wait_recvd_msg,
148 dev->hbm_state == MEI_HBM_IDLE ||
Tomas Winkler544f9462014-01-08 20:19:21 +0200149 dev->hbm_state >= MEI_HBM_STARTED,
Tomas Winkler7d93e582014-01-14 23:10:10 +0200150 mei_secs_to_jiffies(MEI_HBM_TIMEOUT));
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300151 mutex_lock(&dev->device_lock);
152
153 if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
154 dev->hbm_state = MEI_HBM_IDLE;
Masanari Iida8b513d02013-05-21 23:13:12 +0900155 dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300156 return -ETIMEDOUT;
157 }
158 return 0;
159}
160
Tomas Winkler6bbda152012-12-25 19:06:12 +0200161/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200162 * mei_hbm_start_req - sends start request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200163 *
164 * @dev: the device structure
Tomas Winkler544f9462014-01-08 20:19:21 +0200165 *
166 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200167 */
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300168int mei_hbm_start_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200169{
Tomas Winklere46f1872012-12-25 19:06:10 +0200170 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200171 struct hbm_host_version_request *start_req;
172 const size_t len = sizeof(struct hbm_host_version_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200173 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200174
Tomas Winklere46f1872012-12-25 19:06:10 +0200175 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200176
177 /* host start message */
Tomas Winklere46f1872012-12-25 19:06:10 +0200178 start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200179 memset(start_req, 0, len);
180 start_req->hbm_cmd = HOST_START_REQ_CMD;
181 start_req->host_version.major_version = HBM_MAJOR_VERSION;
182 start_req->host_version.minor_version = HBM_MINOR_VERSION;
183
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300184 dev->hbm_state = MEI_HBM_IDLE;
Tomas Winkler544f9462014-01-08 20:19:21 +0200185 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
186 if (ret) {
187 dev_err(&dev->pdev->dev, "version message write failed: ret = %d\n",
188 ret);
189 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200190 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200191
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300192 dev->hbm_state = MEI_HBM_START;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200193 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300194 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200195}
196
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300197/*
Tomas Winkler8120e722012-12-25 19:06:11 +0200198 * mei_hbm_enum_clients_req - sends enumeration client request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200199 *
200 * @dev: the device structure
201 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200202 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200203 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200204static int mei_hbm_enum_clients_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200205{
Tomas Winklere46f1872012-12-25 19:06:10 +0200206 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200207 struct hbm_host_enum_request *enum_req;
208 const size_t len = sizeof(struct hbm_host_enum_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200209 int ret;
210
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200211 /* enumerate clients */
Tomas Winklere46f1872012-12-25 19:06:10 +0200212 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200213
Tomas Winklere46f1872012-12-25 19:06:10 +0200214 enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
215 memset(enum_req, 0, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200216 enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
217
Tomas Winkler544f9462014-01-08 20:19:21 +0200218 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
219 if (ret) {
220 dev_err(&dev->pdev->dev, "enumeration request write failed: ret = %d.\n",
221 ret);
222 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200223 }
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300224 dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200225 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler544f9462014-01-08 20:19:21 +0200226 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200227}
228
Tomas Winkler8120e722012-12-25 19:06:11 +0200229/**
Masanari Iida393b1482013-04-05 01:05:05 +0900230 * mei_hbm_prop_req - request property for a single client
Tomas Winkler8120e722012-12-25 19:06:11 +0200231 *
232 * @dev: the device structure
233 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200234 * returns 0 on success and < 0 on failure
Tomas Winkler8120e722012-12-25 19:06:11 +0200235 */
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200236
Tomas Winkler8120e722012-12-25 19:06:11 +0200237static int mei_hbm_prop_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200238{
239
Tomas Winklere46f1872012-12-25 19:06:10 +0200240 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200241 struct hbm_props_request *prop_req;
242 const size_t len = sizeof(struct hbm_props_request);
243 unsigned long next_client_index;
Tomas Winkler1aee3512013-09-02 13:29:45 +0300244 unsigned long client_num;
Tomas Winkler544f9462014-01-08 20:19:21 +0200245 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200246
247 client_num = dev->me_client_presentation_num;
248
249 next_client_index = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX,
250 dev->me_client_index);
251
252 /* We got all client properties */
253 if (next_client_index == MEI_CLIENTS_MAX) {
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300254 dev->hbm_state = MEI_HBM_STARTED;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200255 schedule_work(&dev->init_work);
256
257 return 0;
258 }
259
260 dev->me_clients[client_num].client_id = next_client_index;
261 dev->me_clients[client_num].mei_flow_ctrl_creds = 0;
262
Tomas Winklere46f1872012-12-25 19:06:10 +0200263 mei_hbm_hdr(mei_hdr, len);
264 prop_req = (struct hbm_props_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200265
266 memset(prop_req, 0, sizeof(struct hbm_props_request));
267
268
269 prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
270 prop_req->address = next_client_index;
271
Tomas Winkler544f9462014-01-08 20:19:21 +0200272 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
273 if (ret) {
274 dev_err(&dev->pdev->dev, "properties request write failed: ret = %d\n",
275 ret);
276 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200277 }
278
279 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
280 dev->me_client_index = next_client_index;
281
282 return 0;
283}
284
285/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200286 * mei_hbm_stop_req - send stop request message
Tomas Winklere46f1872012-12-25 19:06:10 +0200287 *
288 * @dev - mei device
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200289 * @cl: client info
290 *
291 * This function returns -EIO on write failure
Tomas Winklere46f1872012-12-25 19:06:10 +0200292 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200293static int mei_hbm_stop_req(struct mei_device *dev)
Tomas Winklere46f1872012-12-25 19:06:10 +0200294{
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200295 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklere46f1872012-12-25 19:06:10 +0200296 struct hbm_host_stop_request *req =
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200297 (struct hbm_host_stop_request *)dev->wr_msg.data;
Tomas Winklere46f1872012-12-25 19:06:10 +0200298 const size_t len = sizeof(struct hbm_host_stop_request);
299
300 mei_hbm_hdr(mei_hdr, len);
301
302 memset(req, 0, len);
303 req->hbm_cmd = HOST_STOP_REQ_CMD;
304 req->reason = DRIVER_STOP_REQUEST;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200305
306 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklere46f1872012-12-25 19:06:10 +0200307}
308
309/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200310 * mei_hbm_cl_flow_control_req - sends flow control request.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200311 *
312 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200313 * @cl: client info
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200314 *
315 * This function returns -EIO on write failure
316 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200317int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200318{
Tomas Winklere46f1872012-12-25 19:06:10 +0200319 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200320 const size_t len = sizeof(struct hbm_flow_control);
321
Tomas Winklere46f1872012-12-25 19:06:10 +0200322 mei_hbm_hdr(mei_hdr, len);
323 mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200324
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200325 dev_dbg(&dev->pdev->dev, "sending flow control host client = %d, ME client = %d\n",
326 cl->host_client_id, cl->me_client_id);
327
Tomas Winklere46f1872012-12-25 19:06:10 +0200328 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200329}
330
331/**
Masanari Iida393b1482013-04-05 01:05:05 +0900332 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
Tomas Winkler6bbda152012-12-25 19:06:12 +0200333 *
Masanari Iida393b1482013-04-05 01:05:05 +0900334 * @dev: the device structure
Tomas Winkler6bbda152012-12-25 19:06:12 +0200335 * @flow: flow control.
336 */
337static void mei_hbm_add_single_flow_creds(struct mei_device *dev,
338 struct hbm_flow_control *flow)
339{
340 struct mei_me_client *client;
341 int i;
342
343 for (i = 0; i < dev->me_clients_num; i++) {
344 client = &dev->me_clients[i];
345 if (client && flow->me_addr == client->client_id) {
346 if (client->props.single_recv_buf) {
347 client->mei_flow_ctrl_creds++;
348 dev_dbg(&dev->pdev->dev, "recv flow ctrl msg ME %d (single).\n",
349 flow->me_addr);
350 dev_dbg(&dev->pdev->dev, "flow control credentials =%d.\n",
351 client->mei_flow_ctrl_creds);
352 } else {
353 BUG(); /* error in flow control */
354 }
355 }
356 }
357}
358
359/**
360 * mei_hbm_cl_flow_control_res - flow control response from me
361 *
362 * @dev: the device structure
363 * @flow_control: flow control response bus message
364 */
365static void mei_hbm_cl_flow_control_res(struct mei_device *dev,
366 struct hbm_flow_control *flow_control)
367{
368 struct mei_cl *cl = NULL;
369 struct mei_cl *next = NULL;
370
371 if (!flow_control->host_addr) {
372 /* single receive buffer */
373 mei_hbm_add_single_flow_creds(dev, flow_control);
374 return;
375 }
376
377 /* normal connection */
378 list_for_each_entry_safe(cl, next, &dev->file_list, link) {
379 if (mei_hbm_cl_addr_equal(cl, flow_control)) {
380 cl->mei_flow_ctrl_creds++;
381 dev_dbg(&dev->pdev->dev, "flow ctrl msg for host %d ME %d.\n",
382 flow_control->host_addr, flow_control->me_addr);
383 dev_dbg(&dev->pdev->dev, "flow control credentials = %d.\n",
384 cl->mei_flow_ctrl_creds);
385 break;
386 }
387 }
388}
389
390
391/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200392 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200393 *
394 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200395 * @cl: a client to disconnect from
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200396 *
397 * This function returns -EIO on write failure
398 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200399int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200400{
Tomas Winklere46f1872012-12-25 19:06:10 +0200401 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200402 const size_t len = sizeof(struct hbm_client_connect_request);
403
Tomas Winklere46f1872012-12-25 19:06:10 +0200404 mei_hbm_hdr(mei_hdr, len);
405 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200406
Tomas Winklere46f1872012-12-25 19:06:10 +0200407 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200408}
409
410/**
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200411 * mei_hbm_cl_disconnect_rsp - sends disconnect respose to the FW
412 *
413 * @dev: the device structure
414 * @cl: a client to disconnect from
415 *
416 * This function returns -EIO on write failure
417 */
418int mei_hbm_cl_disconnect_rsp(struct mei_device *dev, struct mei_cl *cl)
419{
420 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
421 const size_t len = sizeof(struct hbm_client_connect_response);
422
423 mei_hbm_hdr(mei_hdr, len);
424 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_RES_CMD, dev->wr_msg.data, len);
425
426 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
427}
428
429/**
Tomas Winkler6bbda152012-12-25 19:06:12 +0200430 * mei_hbm_cl_disconnect_res - disconnect response from ME
431 *
432 * @dev: the device structure
433 * @rs: disconnect response bus message
434 */
435static void mei_hbm_cl_disconnect_res(struct mei_device *dev,
436 struct hbm_client_connect_response *rs)
437{
438 struct mei_cl *cl;
439 struct mei_cl_cb *pos = NULL, *next = NULL;
440
441 dev_dbg(&dev->pdev->dev,
442 "disconnect_response:\n"
443 "ME Client = %d\n"
444 "Host Client = %d\n"
445 "Status = %d\n",
446 rs->me_addr,
447 rs->host_addr,
448 rs->status);
449
450 list_for_each_entry_safe(pos, next, &dev->ctrl_rd_list.list, list) {
451 cl = pos->cl;
452
453 if (!cl) {
454 list_del(&pos->list);
455 return;
456 }
457
458 dev_dbg(&dev->pdev->dev, "list_for_each_entry_safe in ctrl_rd_list.\n");
459 if (mei_hbm_cl_addr_equal(cl, rs)) {
460 list_del(&pos->list);
461 if (!rs->status)
462 cl->state = MEI_FILE_DISCONNECTED;
463
464 cl->status = 0;
465 cl->timer_count = 0;
466 break;
467 }
468 }
469}
470
471/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200472 * mei_hbm_cl_connect_req - send connection request to specific me client
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200473 *
474 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200475 * @cl: a client to connect to
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200476 *
Tomas Winkler8120e722012-12-25 19:06:11 +0200477 * returns -EIO on write failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200478 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200479int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200480{
Tomas Winklere46f1872012-12-25 19:06:10 +0200481 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200482 const size_t len = sizeof(struct hbm_client_connect_request);
483
Tomas Winklere46f1872012-12-25 19:06:10 +0200484 mei_hbm_hdr(mei_hdr, len);
485 mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200486
Tomas Winklere46f1872012-12-25 19:06:10 +0200487 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200488}
489
490/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200491 * mei_hbm_cl_connect_res - connect response from the ME
Tomas Winkler6bbda152012-12-25 19:06:12 +0200492 *
493 * @dev: the device structure
494 * @rs: connect response bus message
495 */
496static void mei_hbm_cl_connect_res(struct mei_device *dev,
497 struct hbm_client_connect_response *rs)
498{
499
500 struct mei_cl *cl;
501 struct mei_cl_cb *pos = NULL, *next = NULL;
502
503 dev_dbg(&dev->pdev->dev,
504 "connect_response:\n"
505 "ME Client = %d\n"
506 "Host Client = %d\n"
507 "Status = %d\n",
508 rs->me_addr,
509 rs->host_addr,
510 rs->status);
511
512 /* if WD or iamthif client treat specially */
513
514 if (is_treat_specially_client(&dev->wd_cl, rs)) {
515 dev_dbg(&dev->pdev->dev, "successfully connected to WD client.\n");
516 mei_watchdog_register(dev);
517
518 return;
519 }
520
521 if (is_treat_specially_client(&dev->iamthif_cl, rs)) {
522 dev->iamthif_state = MEI_IAMTHIF_IDLE;
523 return;
524 }
525 list_for_each_entry_safe(pos, next, &dev->ctrl_rd_list.list, list) {
526
527 cl = pos->cl;
528 if (!cl) {
529 list_del(&pos->list);
530 return;
531 }
Tomas Winkler02a7eec2014-02-12 21:41:51 +0200532 if (pos->fop_type == MEI_FOP_CONNECT) {
Tomas Winkler6bbda152012-12-25 19:06:12 +0200533 if (is_treat_specially_client(cl, rs)) {
534 list_del(&pos->list);
535 cl->status = 0;
536 cl->timer_count = 0;
537 break;
538 }
539 }
540 }
541}
542
543
544/**
Alexander Usyskin83ce0742014-01-08 22:31:46 +0200545 * mei_hbm_fw_disconnect_req - disconnect request initiated by ME firmware
546 * host sends disconnect response
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200547 *
548 * @dev: the device structure.
Tomas Winkler8120e722012-12-25 19:06:11 +0200549 * @disconnect_req: disconnect request bus message from the me
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200550 *
551 * returns -ENOMEM on allocation failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200552 */
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200553static int mei_hbm_fw_disconnect_req(struct mei_device *dev,
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200554 struct hbm_client_connect_request *disconnect_req)
555{
Tomas Winklercd51ed62012-12-25 19:06:09 +0200556 struct mei_cl *cl, *next;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200557 struct mei_cl_cb *cb;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200558
Tomas Winklercd51ed62012-12-25 19:06:09 +0200559 list_for_each_entry_safe(cl, next, &dev->file_list, link) {
560 if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200561 dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
562 disconnect_req->host_addr,
563 disconnect_req->me_addr);
Tomas Winklercd51ed62012-12-25 19:06:09 +0200564 cl->state = MEI_FILE_DISCONNECTED;
565 cl->timer_count = 0;
566 if (cl == &dev->wd_cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200567 dev->wd_pending = false;
Tomas Winklercd51ed62012-12-25 19:06:09 +0200568 else if (cl == &dev->iamthif_cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200569 dev->iamthif_timer = 0;
570
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200571 cb = mei_io_cb_init(cl, NULL);
572 if (!cb)
573 return -ENOMEM;
574 cb->fop_type = MEI_FOP_DISCONNECT_RSP;
575 cl_dbg(dev, cl, "add disconnect response as first\n");
576 list_add(&cb->list, &dev->ctrl_wr_list.list);
577
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200578 break;
579 }
580 }
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200581 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200582}
583
584
585/**
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300586 * mei_hbm_version_is_supported - checks whether the driver can
587 * support the hbm version of the device
588 *
589 * @dev: the device structure
590 * returns true if driver can support hbm version of the device
591 */
592bool mei_hbm_version_is_supported(struct mei_device *dev)
593{
594 return (dev->version.major_version < HBM_MAJOR_VERSION) ||
595 (dev->version.major_version == HBM_MAJOR_VERSION &&
596 dev->version.minor_version <= HBM_MINOR_VERSION);
597}
598
599/**
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200600 * mei_hbm_dispatch - bottom half read routine after ISR to
601 * handle the read bus message cmd processing.
602 *
603 * @dev: the device structure
604 * @mei_hdr: header of bus message
Tomas Winkler544f9462014-01-08 20:19:21 +0200605 *
606 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200607 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200608int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200609{
610 struct mei_bus_message *mei_msg;
611 struct mei_me_client *me_client;
612 struct hbm_host_version_response *version_res;
613 struct hbm_client_connect_response *connect_res;
614 struct hbm_client_connect_response *disconnect_res;
615 struct hbm_client_connect_request *disconnect_req;
616 struct hbm_flow_control *flow_control;
617 struct hbm_props_response *props_res;
618 struct hbm_host_enum_response *enum_res;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200619
620 /* read the message to our buffer */
621 BUG_ON(hdr->length >= sizeof(dev->rd_msg_buf));
622 mei_read_slots(dev, dev->rd_msg_buf, hdr->length);
623 mei_msg = (struct mei_bus_message *)dev->rd_msg_buf;
624
Tomas Winkler66ae4602014-01-08 20:19:22 +0200625 /* ignore spurious message and prevent reset nesting
626 * hbm is put to idle during system reset
627 */
628 if (dev->hbm_state == MEI_HBM_IDLE) {
629 dev_dbg(&dev->pdev->dev, "hbm: state is idle ignore spurious messages\n");
630 return 0;
631 }
632
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200633 switch (mei_msg->hbm_cmd) {
634 case HOST_START_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200635 dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");
636
637 dev->init_clients_timer = 0;
638
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200639 version_res = (struct hbm_host_version_response *)mei_msg;
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300640
641 dev_dbg(&dev->pdev->dev, "HBM VERSION: DRIVER=%02d:%02d DEVICE=%02d:%02d\n",
642 HBM_MAJOR_VERSION, HBM_MINOR_VERSION,
643 version_res->me_max_version.major_version,
644 version_res->me_max_version.minor_version);
645
646 if (version_res->host_version_supported) {
647 dev->version.major_version = HBM_MAJOR_VERSION;
648 dev->version.minor_version = HBM_MINOR_VERSION;
649 } else {
650 dev->version.major_version =
651 version_res->me_max_version.major_version;
652 dev->version.minor_version =
653 version_res->me_max_version.minor_version;
654 }
655
656 if (!mei_hbm_version_is_supported(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200657 dev_warn(&dev->pdev->dev, "hbm: start: version mismatch - stopping the driver.\n");
Tomas Winklere46f1872012-12-25 19:06:10 +0200658
Tomas Winkler544f9462014-01-08 20:19:21 +0200659 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200660 if (mei_hbm_stop_req(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200661 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
662 return -EIO;
663 }
664 break;
Tomas Winklere46f1872012-12-25 19:06:10 +0200665 }
666
Tomas Winkler544f9462014-01-08 20:19:21 +0200667 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
668 dev->hbm_state != MEI_HBM_START) {
669 dev_err(&dev->pdev->dev, "hbm: start: state mismatch, [%d, %d]\n",
670 dev->dev_state, dev->hbm_state);
671 return -EPROTO;
672 }
673
674 dev->hbm_state = MEI_HBM_STARTED;
675
676 if (mei_hbm_enum_clients_req(dev)) {
677 dev_err(&dev->pdev->dev, "hbm: start: failed to send enumeration request\n");
678 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200679 }
680
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300681 wake_up_interruptible(&dev->wait_recvd_msg);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200682 break;
683
684 case CLIENT_CONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200685 dev_dbg(&dev->pdev->dev, "hbm: client connect response: message received.\n");
686
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200687 connect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200688 mei_hbm_cl_connect_res(dev, connect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200689 wake_up(&dev->wait_recvd_msg);
690 break;
691
692 case CLIENT_DISCONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200693 dev_dbg(&dev->pdev->dev, "hbm: client disconnect response: message received.\n");
694
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200695 disconnect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200696 mei_hbm_cl_disconnect_res(dev, disconnect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200697 wake_up(&dev->wait_recvd_msg);
698 break;
699
700 case MEI_FLOW_CONTROL_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200701 dev_dbg(&dev->pdev->dev, "hbm: client flow control response: message received.\n");
702
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200703 flow_control = (struct hbm_flow_control *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200704 mei_hbm_cl_flow_control_res(dev, flow_control);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200705 break;
706
707 case HOST_CLIENT_PROPERTIES_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200708 dev_dbg(&dev->pdev->dev, "hbm: properties response: message received.\n");
709
710 dev->init_clients_timer = 0;
711
712 if (dev->me_clients == NULL) {
713 dev_err(&dev->pdev->dev, "hbm: properties response: mei_clients not allocated\n");
714 return -EPROTO;
715 }
716
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200717 props_res = (struct hbm_props_response *)mei_msg;
718 me_client = &dev->me_clients[dev->me_client_presentation_num];
719
Tomas Winkler544f9462014-01-08 20:19:21 +0200720 if (props_res->status) {
721 dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
722 props_res->status);
723 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200724 }
725
726 if (me_client->client_id != props_res->address) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200727 dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
728 me_client->client_id, props_res->address);
729 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200730 }
731
732 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300733 dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200734 dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
735 dev->dev_state, dev->hbm_state);
736 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200737 }
738
739 me_client->props = props_res->client_properties;
740 dev->me_client_index++;
741 dev->me_client_presentation_num++;
742
Tomas Winkler8120e722012-12-25 19:06:11 +0200743 /* request property for the next client */
Tomas Winkler544f9462014-01-08 20:19:21 +0200744 if (mei_hbm_prop_req(dev))
745 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200746
747 break;
748
749 case HOST_ENUM_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200750 dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");
751
752 dev->init_clients_timer = 0;
753
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200754 enum_res = (struct hbm_host_enum_response *) mei_msg;
Tomas Winkler23f5a322013-09-02 03:11:01 +0300755 BUILD_BUG_ON(sizeof(dev->me_clients_map)
756 < sizeof(enum_res->valid_addresses));
757 memcpy(dev->me_clients_map, enum_res->valid_addresses,
758 sizeof(enum_res->valid_addresses));
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200759
Tomas Winkler544f9462014-01-08 20:19:21 +0200760 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
761 dev->hbm_state != MEI_HBM_ENUM_CLIENTS) {
762 dev_err(&dev->pdev->dev, "hbm: enumeration response: state mismatch, [%d, %d]\n",
763 dev->dev_state, dev->hbm_state);
764 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200765 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200766
767 if (mei_hbm_me_cl_allocate(dev)) {
768 dev_err(&dev->pdev->dev, "hbm: enumeration response: cannot allocate clients array\n");
769 return -ENOMEM;
770 }
771
772 dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;
773
774 /* first property request */
775 if (mei_hbm_prop_req(dev))
776 return -EIO;
777
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200778 break;
779
780 case HOST_STOP_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200781 dev_dbg(&dev->pdev->dev, "hbm: stop response: message received\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300782
Tomas Winkler544f9462014-01-08 20:19:21 +0200783 dev->init_clients_timer = 0;
784
785 if (dev->hbm_state != MEI_HBM_STOPPED) {
786 dev_err(&dev->pdev->dev, "hbm: stop response: state mismatch, [%d, %d]\n",
787 dev->dev_state, dev->hbm_state);
788 return -EPROTO;
789 }
790
Tomas Winkler33ec0822014-01-12 00:36:09 +0200791 dev->dev_state = MEI_DEV_POWER_DOWN;
Tomas Winkler544f9462014-01-08 20:19:21 +0200792 dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
793 /* force the reset */
794 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200795 break;
796
797 case CLIENT_DISCONNECT_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200798 dev_dbg(&dev->pdev->dev, "hbm: disconnect request: message received\n");
799
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200800 disconnect_req = (struct hbm_client_connect_request *)mei_msg;
Tomas Winkler8120e722012-12-25 19:06:11 +0200801 mei_hbm_fw_disconnect_req(dev, disconnect_req);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200802 break;
803
804 case ME_STOP_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200805 dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
Tomas Winkler544f9462014-01-08 20:19:21 +0200806 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winkler6bb948c2014-02-12 21:41:52 +0200807 if (mei_hbm_stop_req(dev)) {
808 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
809 return -EIO;
810 }
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200811 break;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200812 default:
813 BUG();
814 break;
815
816 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200817 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200818}
819