blob: 8109b9a98cc37ece5f8fed3c3d8928873f4adb6f [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/**
86 * same_disconn_addr - tells if they have the same address
87 *
88 * @file: private data of the file object.
89 * @disconn: disconnection request.
90 *
91 * returns true if addres are same
92 */
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 Winkler9b0d5ef2013-04-18 23:03:48 +0300129int mei_hbm_start_wait(struct mei_device *dev)
130{
131 int ret;
132 if (dev->hbm_state > MEI_HBM_START)
133 return 0;
134
135 mutex_unlock(&dev->device_lock);
136 ret = wait_event_interruptible_timeout(dev->wait_recvd_msg,
137 dev->hbm_state == MEI_HBM_IDLE ||
Tomas Winkler544f9462014-01-08 20:19:21 +0200138 dev->hbm_state >= MEI_HBM_STARTED,
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300139 mei_secs_to_jiffies(MEI_INTEROP_TIMEOUT));
140 mutex_lock(&dev->device_lock);
141
142 if (ret <= 0 && (dev->hbm_state <= MEI_HBM_START)) {
143 dev->hbm_state = MEI_HBM_IDLE;
Masanari Iida8b513d02013-05-21 23:13:12 +0900144 dev_err(&dev->pdev->dev, "waiting for mei start failed\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300145 return -ETIMEDOUT;
146 }
147 return 0;
148}
149
Tomas Winkler6bbda152012-12-25 19:06:12 +0200150/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200151 * mei_hbm_start_req - sends start request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200152 *
153 * @dev: the device structure
Tomas Winkler544f9462014-01-08 20:19:21 +0200154 *
155 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200156 */
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300157int mei_hbm_start_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200158{
Tomas Winklere46f1872012-12-25 19:06:10 +0200159 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200160 struct hbm_host_version_request *start_req;
161 const size_t len = sizeof(struct hbm_host_version_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200162 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200163
Tomas Winklere46f1872012-12-25 19:06:10 +0200164 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200165
166 /* host start message */
Tomas Winklere46f1872012-12-25 19:06:10 +0200167 start_req = (struct hbm_host_version_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200168 memset(start_req, 0, len);
169 start_req->hbm_cmd = HOST_START_REQ_CMD;
170 start_req->host_version.major_version = HBM_MAJOR_VERSION;
171 start_req->host_version.minor_version = HBM_MINOR_VERSION;
172
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300173 dev->hbm_state = MEI_HBM_IDLE;
Tomas Winkler544f9462014-01-08 20:19:21 +0200174 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
175 if (ret) {
176 dev_err(&dev->pdev->dev, "version message write failed: ret = %d\n",
177 ret);
178 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200179 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200180
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300181 dev->hbm_state = MEI_HBM_START;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200182 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300183 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200184}
185
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300186/*
Tomas Winkler8120e722012-12-25 19:06:11 +0200187 * mei_hbm_enum_clients_req - sends enumeration client request message.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200188 *
189 * @dev: the device structure
190 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200191 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200192 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200193static int mei_hbm_enum_clients_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200194{
Tomas Winklere46f1872012-12-25 19:06:10 +0200195 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200196 struct hbm_host_enum_request *enum_req;
197 const size_t len = sizeof(struct hbm_host_enum_request);
Tomas Winkler544f9462014-01-08 20:19:21 +0200198 int ret;
199
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200200 /* enumerate clients */
Tomas Winklere46f1872012-12-25 19:06:10 +0200201 mei_hbm_hdr(mei_hdr, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200202
Tomas Winklere46f1872012-12-25 19:06:10 +0200203 enum_req = (struct hbm_host_enum_request *)dev->wr_msg.data;
204 memset(enum_req, 0, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200205 enum_req->hbm_cmd = HOST_ENUM_REQ_CMD;
206
Tomas Winkler544f9462014-01-08 20:19:21 +0200207 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
208 if (ret) {
209 dev_err(&dev->pdev->dev, "enumeration request write failed: ret = %d.\n",
210 ret);
211 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200212 }
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300213 dev->hbm_state = MEI_HBM_ENUM_CLIENTS;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200214 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
Tomas Winkler544f9462014-01-08 20:19:21 +0200215 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200216}
217
Tomas Winkler8120e722012-12-25 19:06:11 +0200218/**
Masanari Iida393b1482013-04-05 01:05:05 +0900219 * mei_hbm_prop_req - request property for a single client
Tomas Winkler8120e722012-12-25 19:06:11 +0200220 *
221 * @dev: the device structure
222 *
Tomas Winkler544f9462014-01-08 20:19:21 +0200223 * returns 0 on success and < 0 on failure
Tomas Winkler8120e722012-12-25 19:06:11 +0200224 */
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200225
Tomas Winkler8120e722012-12-25 19:06:11 +0200226static int mei_hbm_prop_req(struct mei_device *dev)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200227{
228
Tomas Winklere46f1872012-12-25 19:06:10 +0200229 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200230 struct hbm_props_request *prop_req;
231 const size_t len = sizeof(struct hbm_props_request);
232 unsigned long next_client_index;
Tomas Winkler1aee3512013-09-02 13:29:45 +0300233 unsigned long client_num;
Tomas Winkler544f9462014-01-08 20:19:21 +0200234 int ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200235
236 client_num = dev->me_client_presentation_num;
237
238 next_client_index = find_next_bit(dev->me_clients_map, MEI_CLIENTS_MAX,
239 dev->me_client_index);
240
241 /* We got all client properties */
242 if (next_client_index == MEI_CLIENTS_MAX) {
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300243 dev->hbm_state = MEI_HBM_STARTED;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200244 schedule_work(&dev->init_work);
245
246 return 0;
247 }
248
249 dev->me_clients[client_num].client_id = next_client_index;
250 dev->me_clients[client_num].mei_flow_ctrl_creds = 0;
251
Tomas Winklere46f1872012-12-25 19:06:10 +0200252 mei_hbm_hdr(mei_hdr, len);
253 prop_req = (struct hbm_props_request *)dev->wr_msg.data;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200254
255 memset(prop_req, 0, sizeof(struct hbm_props_request));
256
257
258 prop_req->hbm_cmd = HOST_CLIENT_PROPERTIES_REQ_CMD;
259 prop_req->address = next_client_index;
260
Tomas Winkler544f9462014-01-08 20:19:21 +0200261 ret = mei_write_message(dev, mei_hdr, dev->wr_msg.data);
262 if (ret) {
263 dev_err(&dev->pdev->dev, "properties request write failed: ret = %d\n",
264 ret);
265 return ret;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200266 }
267
268 dev->init_clients_timer = MEI_CLIENTS_INIT_TIMEOUT;
269 dev->me_client_index = next_client_index;
270
271 return 0;
272}
273
274/**
Tomas Winklere46f1872012-12-25 19:06:10 +0200275 * mei_hbm_stop_req_prepare - perpare stop request message
276 *
277 * @dev - mei device
278 * @mei_hdr - mei message header
279 * @data - hbm message body buffer
280 */
281static void mei_hbm_stop_req_prepare(struct mei_device *dev,
282 struct mei_msg_hdr *mei_hdr, unsigned char *data)
283{
284 struct hbm_host_stop_request *req =
285 (struct hbm_host_stop_request *)data;
286 const size_t len = sizeof(struct hbm_host_stop_request);
287
288 mei_hbm_hdr(mei_hdr, len);
289
290 memset(req, 0, len);
291 req->hbm_cmd = HOST_STOP_REQ_CMD;
292 req->reason = DRIVER_STOP_REQUEST;
293}
294
295/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200296 * mei_hbm_cl_flow_control_req - sends flow control requst.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200297 *
298 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200299 * @cl: client info
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200300 *
301 * This function returns -EIO on write failure
302 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200303int mei_hbm_cl_flow_control_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200304{
Tomas Winklere46f1872012-12-25 19:06:10 +0200305 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200306 const size_t len = sizeof(struct hbm_flow_control);
307
Tomas Winklere46f1872012-12-25 19:06:10 +0200308 mei_hbm_hdr(mei_hdr, len);
309 mei_hbm_cl_hdr(cl, MEI_FLOW_CONTROL_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200310
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200311 dev_dbg(&dev->pdev->dev, "sending flow control host client = %d, ME client = %d\n",
312 cl->host_client_id, cl->me_client_id);
313
Tomas Winklere46f1872012-12-25 19:06:10 +0200314 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200315}
316
317/**
Masanari Iida393b1482013-04-05 01:05:05 +0900318 * mei_hbm_add_single_flow_creds - adds single buffer credentials.
Tomas Winkler6bbda152012-12-25 19:06:12 +0200319 *
Masanari Iida393b1482013-04-05 01:05:05 +0900320 * @dev: the device structure
Tomas Winkler6bbda152012-12-25 19:06:12 +0200321 * @flow: flow control.
322 */
323static void mei_hbm_add_single_flow_creds(struct mei_device *dev,
324 struct hbm_flow_control *flow)
325{
326 struct mei_me_client *client;
327 int i;
328
329 for (i = 0; i < dev->me_clients_num; i++) {
330 client = &dev->me_clients[i];
331 if (client && flow->me_addr == client->client_id) {
332 if (client->props.single_recv_buf) {
333 client->mei_flow_ctrl_creds++;
334 dev_dbg(&dev->pdev->dev, "recv flow ctrl msg ME %d (single).\n",
335 flow->me_addr);
336 dev_dbg(&dev->pdev->dev, "flow control credentials =%d.\n",
337 client->mei_flow_ctrl_creds);
338 } else {
339 BUG(); /* error in flow control */
340 }
341 }
342 }
343}
344
345/**
346 * mei_hbm_cl_flow_control_res - flow control response from me
347 *
348 * @dev: the device structure
349 * @flow_control: flow control response bus message
350 */
351static void mei_hbm_cl_flow_control_res(struct mei_device *dev,
352 struct hbm_flow_control *flow_control)
353{
354 struct mei_cl *cl = NULL;
355 struct mei_cl *next = NULL;
356
357 if (!flow_control->host_addr) {
358 /* single receive buffer */
359 mei_hbm_add_single_flow_creds(dev, flow_control);
360 return;
361 }
362
363 /* normal connection */
364 list_for_each_entry_safe(cl, next, &dev->file_list, link) {
365 if (mei_hbm_cl_addr_equal(cl, flow_control)) {
366 cl->mei_flow_ctrl_creds++;
367 dev_dbg(&dev->pdev->dev, "flow ctrl msg for host %d ME %d.\n",
368 flow_control->host_addr, flow_control->me_addr);
369 dev_dbg(&dev->pdev->dev, "flow control credentials = %d.\n",
370 cl->mei_flow_ctrl_creds);
371 break;
372 }
373 }
374}
375
376
377/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200378 * mei_hbm_cl_disconnect_req - sends disconnect message to fw.
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200379 *
380 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200381 * @cl: a client to disconnect from
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200382 *
383 * This function returns -EIO on write failure
384 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200385int mei_hbm_cl_disconnect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200386{
Tomas Winklere46f1872012-12-25 19:06:10 +0200387 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200388 const size_t len = sizeof(struct hbm_client_connect_request);
389
Tomas Winklere46f1872012-12-25 19:06:10 +0200390 mei_hbm_hdr(mei_hdr, len);
391 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200392
Tomas Winklere46f1872012-12-25 19:06:10 +0200393 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200394}
395
396/**
Tomas Winkler6bbda152012-12-25 19:06:12 +0200397 * mei_hbm_cl_disconnect_res - disconnect response from ME
398 *
399 * @dev: the device structure
400 * @rs: disconnect response bus message
401 */
402static void mei_hbm_cl_disconnect_res(struct mei_device *dev,
403 struct hbm_client_connect_response *rs)
404{
405 struct mei_cl *cl;
406 struct mei_cl_cb *pos = NULL, *next = NULL;
407
408 dev_dbg(&dev->pdev->dev,
409 "disconnect_response:\n"
410 "ME Client = %d\n"
411 "Host Client = %d\n"
412 "Status = %d\n",
413 rs->me_addr,
414 rs->host_addr,
415 rs->status);
416
417 list_for_each_entry_safe(pos, next, &dev->ctrl_rd_list.list, list) {
418 cl = pos->cl;
419
420 if (!cl) {
421 list_del(&pos->list);
422 return;
423 }
424
425 dev_dbg(&dev->pdev->dev, "list_for_each_entry_safe in ctrl_rd_list.\n");
426 if (mei_hbm_cl_addr_equal(cl, rs)) {
427 list_del(&pos->list);
428 if (!rs->status)
429 cl->state = MEI_FILE_DISCONNECTED;
430
431 cl->status = 0;
432 cl->timer_count = 0;
433 break;
434 }
435 }
436}
437
438/**
Tomas Winkler8120e722012-12-25 19:06:11 +0200439 * mei_hbm_cl_connect_req - send connection request to specific me client
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200440 *
441 * @dev: the device structure
Tomas Winkler8120e722012-12-25 19:06:11 +0200442 * @cl: a client to connect to
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200443 *
Tomas Winkler8120e722012-12-25 19:06:11 +0200444 * returns -EIO on write failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200445 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200446int mei_hbm_cl_connect_req(struct mei_device *dev, struct mei_cl *cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200447{
Tomas Winklere46f1872012-12-25 19:06:10 +0200448 struct mei_msg_hdr *mei_hdr = &dev->wr_msg.hdr;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200449 const size_t len = sizeof(struct hbm_client_connect_request);
450
Tomas Winklere46f1872012-12-25 19:06:10 +0200451 mei_hbm_hdr(mei_hdr, len);
452 mei_hbm_cl_hdr(cl, CLIENT_CONNECT_REQ_CMD, dev->wr_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200453
Tomas Winklere46f1872012-12-25 19:06:10 +0200454 return mei_write_message(dev, mei_hdr, dev->wr_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200455}
456
457/**
Tomas Winkler6bbda152012-12-25 19:06:12 +0200458 * mei_hbm_cl_connect_res - connect resposne from the ME
459 *
460 * @dev: the device structure
461 * @rs: connect response bus message
462 */
463static void mei_hbm_cl_connect_res(struct mei_device *dev,
464 struct hbm_client_connect_response *rs)
465{
466
467 struct mei_cl *cl;
468 struct mei_cl_cb *pos = NULL, *next = NULL;
469
470 dev_dbg(&dev->pdev->dev,
471 "connect_response:\n"
472 "ME Client = %d\n"
473 "Host Client = %d\n"
474 "Status = %d\n",
475 rs->me_addr,
476 rs->host_addr,
477 rs->status);
478
479 /* if WD or iamthif client treat specially */
480
481 if (is_treat_specially_client(&dev->wd_cl, rs)) {
482 dev_dbg(&dev->pdev->dev, "successfully connected to WD client.\n");
483 mei_watchdog_register(dev);
484
485 return;
486 }
487
488 if (is_treat_specially_client(&dev->iamthif_cl, rs)) {
489 dev->iamthif_state = MEI_IAMTHIF_IDLE;
490 return;
491 }
492 list_for_each_entry_safe(pos, next, &dev->ctrl_rd_list.list, list) {
493
494 cl = pos->cl;
495 if (!cl) {
496 list_del(&pos->list);
497 return;
498 }
499 if (pos->fop_type == MEI_FOP_IOCTL) {
500 if (is_treat_specially_client(cl, rs)) {
501 list_del(&pos->list);
502 cl->status = 0;
503 cl->timer_count = 0;
504 break;
505 }
506 }
507 }
508}
509
510
511/**
Masanari Iida393b1482013-04-05 01:05:05 +0900512 * mei_hbm_fw_disconnect_req - disconnect request initiated by me
Tomas Winkler8120e722012-12-25 19:06:11 +0200513 * host sends disoconnect response
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200514 *
515 * @dev: the device structure.
Tomas Winkler8120e722012-12-25 19:06:11 +0200516 * @disconnect_req: disconnect request bus message from the me
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200517 */
Tomas Winkler8120e722012-12-25 19:06:11 +0200518static void mei_hbm_fw_disconnect_req(struct mei_device *dev,
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200519 struct hbm_client_connect_request *disconnect_req)
520{
Tomas Winklercd51ed62012-12-25 19:06:09 +0200521 struct mei_cl *cl, *next;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200522 const size_t len = sizeof(struct hbm_client_connect_response);
523
Tomas Winklercd51ed62012-12-25 19:06:09 +0200524 list_for_each_entry_safe(cl, next, &dev->file_list, link) {
525 if (mei_hbm_cl_addr_equal(cl, disconnect_req)) {
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200526 dev_dbg(&dev->pdev->dev, "disconnect request host client %d ME client %d.\n",
527 disconnect_req->host_addr,
528 disconnect_req->me_addr);
Tomas Winklercd51ed62012-12-25 19:06:09 +0200529 cl->state = MEI_FILE_DISCONNECTED;
530 cl->timer_count = 0;
531 if (cl == &dev->wd_cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200532 dev->wd_pending = false;
Tomas Winklercd51ed62012-12-25 19:06:09 +0200533 else if (cl == &dev->iamthif_cl)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200534 dev->iamthif_timer = 0;
535
536 /* prepare disconnect response */
Tomas Winklere46f1872012-12-25 19:06:10 +0200537 mei_hbm_hdr(&dev->wr_ext_msg.hdr, len);
Tomas Winklercd51ed62012-12-25 19:06:09 +0200538 mei_hbm_cl_hdr(cl, CLIENT_DISCONNECT_RES_CMD,
Tomas Winklere46f1872012-12-25 19:06:10 +0200539 dev->wr_ext_msg.data, len);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200540 break;
541 }
542 }
543}
544
545
546/**
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300547 * mei_hbm_version_is_supported - checks whether the driver can
548 * support the hbm version of the device
549 *
550 * @dev: the device structure
551 * returns true if driver can support hbm version of the device
552 */
553bool mei_hbm_version_is_supported(struct mei_device *dev)
554{
555 return (dev->version.major_version < HBM_MAJOR_VERSION) ||
556 (dev->version.major_version == HBM_MAJOR_VERSION &&
557 dev->version.minor_version <= HBM_MINOR_VERSION);
558}
559
560/**
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200561 * mei_hbm_dispatch - bottom half read routine after ISR to
562 * handle the read bus message cmd processing.
563 *
564 * @dev: the device structure
565 * @mei_hdr: header of bus message
Tomas Winkler544f9462014-01-08 20:19:21 +0200566 *
567 * returns 0 on success and < 0 on failure
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200568 */
Tomas Winkler544f9462014-01-08 20:19:21 +0200569int mei_hbm_dispatch(struct mei_device *dev, struct mei_msg_hdr *hdr)
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200570{
571 struct mei_bus_message *mei_msg;
572 struct mei_me_client *me_client;
573 struct hbm_host_version_response *version_res;
574 struct hbm_client_connect_response *connect_res;
575 struct hbm_client_connect_response *disconnect_res;
576 struct hbm_client_connect_request *disconnect_req;
577 struct hbm_flow_control *flow_control;
578 struct hbm_props_response *props_res;
579 struct hbm_host_enum_response *enum_res;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200580
581 /* read the message to our buffer */
582 BUG_ON(hdr->length >= sizeof(dev->rd_msg_buf));
583 mei_read_slots(dev, dev->rd_msg_buf, hdr->length);
584 mei_msg = (struct mei_bus_message *)dev->rd_msg_buf;
585
586 switch (mei_msg->hbm_cmd) {
587 case HOST_START_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200588 dev_dbg(&dev->pdev->dev, "hbm: start: response message received.\n");
589
590 dev->init_clients_timer = 0;
591
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200592 version_res = (struct hbm_host_version_response *)mei_msg;
Tomas Winkler2c9b48a2013-06-16 09:16:31 +0300593
594 dev_dbg(&dev->pdev->dev, "HBM VERSION: DRIVER=%02d:%02d DEVICE=%02d:%02d\n",
595 HBM_MAJOR_VERSION, HBM_MINOR_VERSION,
596 version_res->me_max_version.major_version,
597 version_res->me_max_version.minor_version);
598
599 if (version_res->host_version_supported) {
600 dev->version.major_version = HBM_MAJOR_VERSION;
601 dev->version.minor_version = HBM_MINOR_VERSION;
602 } else {
603 dev->version.major_version =
604 version_res->me_max_version.major_version;
605 dev->version.minor_version =
606 version_res->me_max_version.minor_version;
607 }
608
609 if (!mei_hbm_version_is_supported(dev)) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200610 dev_warn(&dev->pdev->dev, "hbm: start: version mismatch - stopping the driver.\n");
Tomas Winklere46f1872012-12-25 19:06:10 +0200611
Tomas Winkler544f9462014-01-08 20:19:21 +0200612 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winklere46f1872012-12-25 19:06:10 +0200613 mei_hbm_stop_req_prepare(dev, &dev->wr_msg.hdr,
614 dev->wr_msg.data);
Tomas Winkler544f9462014-01-08 20:19:21 +0200615 if (mei_write_message(dev, &dev->wr_msg.hdr,
616 dev->wr_msg.data)) {
617 dev_err(&dev->pdev->dev, "hbm: start: failed to send stop request\n");
618 return -EIO;
619 }
620 break;
Tomas Winklere46f1872012-12-25 19:06:10 +0200621 }
622
Tomas Winkler544f9462014-01-08 20:19:21 +0200623 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
624 dev->hbm_state != MEI_HBM_START) {
625 dev_err(&dev->pdev->dev, "hbm: start: state mismatch, [%d, %d]\n",
626 dev->dev_state, dev->hbm_state);
627 return -EPROTO;
628 }
629
630 dev->hbm_state = MEI_HBM_STARTED;
631
632 if (mei_hbm_enum_clients_req(dev)) {
633 dev_err(&dev->pdev->dev, "hbm: start: failed to send enumeration request\n");
634 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200635 }
636
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300637 wake_up_interruptible(&dev->wait_recvd_msg);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200638 break;
639
640 case CLIENT_CONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200641 dev_dbg(&dev->pdev->dev, "hbm: client connect response: message received.\n");
642
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200643 connect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200644 mei_hbm_cl_connect_res(dev, connect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200645 wake_up(&dev->wait_recvd_msg);
646 break;
647
648 case CLIENT_DISCONNECT_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200649 dev_dbg(&dev->pdev->dev, "hbm: client disconnect response: message received.\n");
650
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200651 disconnect_res = (struct hbm_client_connect_response *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200652 mei_hbm_cl_disconnect_res(dev, disconnect_res);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200653 wake_up(&dev->wait_recvd_msg);
654 break;
655
656 case MEI_FLOW_CONTROL_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200657 dev_dbg(&dev->pdev->dev, "hbm: client flow control response: message received.\n");
658
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200659 flow_control = (struct hbm_flow_control *) mei_msg;
Tomas Winkler6bbda152012-12-25 19:06:12 +0200660 mei_hbm_cl_flow_control_res(dev, flow_control);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200661 break;
662
663 case HOST_CLIENT_PROPERTIES_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200664 dev_dbg(&dev->pdev->dev, "hbm: properties response: message received.\n");
665
666 dev->init_clients_timer = 0;
667
668 if (dev->me_clients == NULL) {
669 dev_err(&dev->pdev->dev, "hbm: properties response: mei_clients not allocated\n");
670 return -EPROTO;
671 }
672
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200673 props_res = (struct hbm_props_response *)mei_msg;
674 me_client = &dev->me_clients[dev->me_client_presentation_num];
675
Tomas Winkler544f9462014-01-08 20:19:21 +0200676 if (props_res->status) {
677 dev_err(&dev->pdev->dev, "hbm: properties response: wrong status = %d\n",
678 props_res->status);
679 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200680 }
681
682 if (me_client->client_id != props_res->address) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200683 dev_err(&dev->pdev->dev, "hbm: properties response: address mismatch %d ?= %d\n",
684 me_client->client_id, props_res->address);
685 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200686 }
687
688 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300689 dev->hbm_state != MEI_HBM_CLIENT_PROPERTIES) {
Tomas Winkler544f9462014-01-08 20:19:21 +0200690 dev_err(&dev->pdev->dev, "hbm: properties response: state mismatch, [%d, %d]\n",
691 dev->dev_state, dev->hbm_state);
692 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200693 }
694
695 me_client->props = props_res->client_properties;
696 dev->me_client_index++;
697 dev->me_client_presentation_num++;
698
Tomas Winkler8120e722012-12-25 19:06:11 +0200699 /* request property for the next client */
Tomas Winkler544f9462014-01-08 20:19:21 +0200700 if (mei_hbm_prop_req(dev))
701 return -EIO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200702
703 break;
704
705 case HOST_ENUM_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200706 dev_dbg(&dev->pdev->dev, "hbm: enumeration response: message received\n");
707
708 dev->init_clients_timer = 0;
709
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200710 enum_res = (struct hbm_host_enum_response *) mei_msg;
Tomas Winkler23f5a322013-09-02 03:11:01 +0300711 BUILD_BUG_ON(sizeof(dev->me_clients_map)
712 < sizeof(enum_res->valid_addresses));
713 memcpy(dev->me_clients_map, enum_res->valid_addresses,
714 sizeof(enum_res->valid_addresses));
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200715
Tomas Winkler544f9462014-01-08 20:19:21 +0200716 if (dev->dev_state != MEI_DEV_INIT_CLIENTS ||
717 dev->hbm_state != MEI_HBM_ENUM_CLIENTS) {
718 dev_err(&dev->pdev->dev, "hbm: enumeration response: state mismatch, [%d, %d]\n",
719 dev->dev_state, dev->hbm_state);
720 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200721 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200722
723 if (mei_hbm_me_cl_allocate(dev)) {
724 dev_err(&dev->pdev->dev, "hbm: enumeration response: cannot allocate clients array\n");
725 return -ENOMEM;
726 }
727
728 dev->hbm_state = MEI_HBM_CLIENT_PROPERTIES;
729
730 /* first property request */
731 if (mei_hbm_prop_req(dev))
732 return -EIO;
733
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200734 break;
735
736 case HOST_STOP_RES_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200737 dev_dbg(&dev->pdev->dev, "hbm: stop response: message received\n");
Tomas Winkler9b0d5ef2013-04-18 23:03:48 +0300738
Tomas Winkler544f9462014-01-08 20:19:21 +0200739 dev->init_clients_timer = 0;
740
741 if (dev->hbm_state != MEI_HBM_STOPPED) {
742 dev_err(&dev->pdev->dev, "hbm: stop response: state mismatch, [%d, %d]\n",
743 dev->dev_state, dev->hbm_state);
744 return -EPROTO;
745 }
746
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200747 dev->dev_state = MEI_DEV_DISABLED;
Tomas Winkler544f9462014-01-08 20:19:21 +0200748 dev_info(&dev->pdev->dev, "hbm: stop response: resetting.\n");
749 /* force the reset */
750 return -EPROTO;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200751 break;
752
753 case CLIENT_DISCONNECT_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200754 dev_dbg(&dev->pdev->dev, "hbm: disconnect request: message received\n");
755
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200756 disconnect_req = (struct hbm_client_connect_request *)mei_msg;
Tomas Winkler8120e722012-12-25 19:06:11 +0200757 mei_hbm_fw_disconnect_req(dev, disconnect_req);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200758 break;
759
760 case ME_STOP_REQ_CMD:
Tomas Winkler544f9462014-01-08 20:19:21 +0200761 dev_dbg(&dev->pdev->dev, "hbm: stop request: message received\n");
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200762
Tomas Winkler544f9462014-01-08 20:19:21 +0200763 dev->hbm_state = MEI_HBM_STOPPED;
Tomas Winklere46f1872012-12-25 19:06:10 +0200764 mei_hbm_stop_req_prepare(dev, &dev->wr_ext_msg.hdr,
765 dev->wr_ext_msg.data);
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200766 break;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200767 default:
768 BUG();
769 break;
770
771 }
Tomas Winkler544f9462014-01-08 20:19:21 +0200772 return 0;
Tomas Winklerbb1b0132012-12-25 19:06:07 +0200773}
774