1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/kernel.h>
17#include <linux/module.h>
18#include <linux/moduleparam.h>
19#include <linux/device.h>
20#include <linux/sched.h>
21#include <linux/watchdog.h>
22
23#include <linux/mei.h>
24
25#include "mei_dev.h"
26#include "hbm.h"
27#include "client.h"
28
29static const u8 mei_start_wd_params[] = { 0x02, 0x12, 0x13, 0x10 };
30static const u8 mei_stop_wd_params[] = { 0x02, 0x02, 0x14, 0x10 };
31
32
33
34
35#define INTEL_AMT_WATCHDOG_ID "INTCAMT"
36
37
38const uuid_le mei_wd_guid = UUID_LE(0x05B79A6F, 0x4628, 0x4D7F, 0x89,
39 0x9D, 0xA9, 0x15, 0x14, 0xCB,
40 0x32, 0xAB);
41
42static void mei_wd_set_start_timeout(struct mei_device *dev, u16 timeout)
43{
44 dev_dbg(dev->dev, "wd: set timeout=%d.\n", timeout);
45 memcpy(dev->wd_data, mei_start_wd_params, MEI_WD_HDR_SIZE);
46 memcpy(dev->wd_data + MEI_WD_HDR_SIZE, &timeout, sizeof(u16));
47}
48
49
50
51
52
53
54
55
56
57
58int mei_wd_host_init(struct mei_device *dev)
59{
60 struct mei_cl *cl = &dev->wd_cl;
61 struct mei_me_client *me_cl;
62 int ret;
63
64 mei_cl_init(cl, dev);
65
66 dev->wd_timeout = MEI_WD_DEFAULT_TIMEOUT;
67 dev->wd_state = MEI_WD_IDLE;
68
69
70
71 me_cl = mei_me_cl_by_uuid(dev, &mei_wd_guid);
72 if (!me_cl) {
73 dev_info(dev->dev, "wd: failed to find the client\n");
74 return -ENOTTY;
75 }
76
77 cl->me_client_id = me_cl->client_id;
78 cl->cl_uuid = me_cl->props.protocol_name;
79 mei_me_cl_put(me_cl);
80
81 ret = mei_cl_link(cl, MEI_WD_HOST_CLIENT_ID);
82
83 if (ret < 0) {
84 dev_info(dev->dev, "wd: failed link client\n");
85 return ret;
86 }
87
88 ret = mei_cl_connect(cl, NULL);
89
90 if (ret) {
91 dev_err(dev->dev, "wd: failed to connect = %d\n", ret);
92 mei_cl_unlink(cl);
93 return ret;
94 }
95
96 ret = mei_watchdog_register(dev);
97 if (ret) {
98 mei_cl_disconnect(cl);
99 mei_cl_unlink(cl);
100 }
101 return ret;
102}
103
104
105
106
107
108
109
110
111
112
113
114int mei_wd_send(struct mei_device *dev)
115{
116 struct mei_cl *cl = &dev->wd_cl;
117 struct mei_msg_hdr hdr;
118 int ret;
119
120 hdr.host_addr = cl->host_client_id;
121 hdr.me_addr = cl->me_client_id;
122 hdr.msg_complete = 1;
123 hdr.reserved = 0;
124 hdr.internal = 0;
125
126 if (!memcmp(dev->wd_data, mei_start_wd_params, MEI_WD_HDR_SIZE))
127 hdr.length = MEI_WD_START_MSG_SIZE;
128 else if (!memcmp(dev->wd_data, mei_stop_wd_params, MEI_WD_HDR_SIZE))
129 hdr.length = MEI_WD_STOP_MSG_SIZE;
130 else {
131 dev_err(dev->dev, "wd: invalid message is to be sent, aborting\n");
132 return -EINVAL;
133 }
134
135 ret = mei_write_message(dev, &hdr, dev->wd_data);
136 if (ret) {
137 dev_err(dev->dev, "wd: write message failed\n");
138 return ret;
139 }
140
141 ret = mei_cl_flow_ctrl_reduce(cl);
142 if (ret) {
143 dev_err(dev->dev, "wd: flow_ctrl_reduce failed.\n");
144 return ret;
145 }
146
147 return 0;
148}
149
150
151
152
153
154
155
156
157
158
159
160
161int mei_wd_stop(struct mei_device *dev)
162{
163 struct mei_cl *cl = &dev->wd_cl;
164 int ret;
165
166 if (!mei_cl_is_connected(cl) ||
167 dev->wd_state != MEI_WD_RUNNING)
168 return 0;
169
170 memcpy(dev->wd_data, mei_stop_wd_params, MEI_WD_STOP_MSG_SIZE);
171
172 dev->wd_state = MEI_WD_STOPPING;
173
174 ret = mei_cl_flow_ctrl_creds(cl);
175 if (ret < 0)
176 goto err;
177
178 if (ret && mei_hbuf_acquire(dev)) {
179 ret = mei_wd_send(dev);
180 if (ret)
181 goto err;
182 dev->wd_pending = false;
183 } else {
184 dev->wd_pending = true;
185 }
186
187 mutex_unlock(&dev->device_lock);
188
189 ret = wait_event_timeout(dev->wait_stop_wd,
190 dev->wd_state == MEI_WD_IDLE,
191 msecs_to_jiffies(MEI_WD_STOP_TIMEOUT));
192 mutex_lock(&dev->device_lock);
193 if (dev->wd_state != MEI_WD_IDLE) {
194
195 ret = -ETIME;
196 dev_warn(dev->dev, "wd: stop failed to complete ret=%d\n", ret);
197 goto err;
198 }
199 dev_dbg(dev->dev, "wd: stop completed after %u msec\n",
200 MEI_WD_STOP_TIMEOUT - jiffies_to_msecs(ret));
201 return 0;
202err:
203 return ret;
204}
205
206
207
208
209
210
211
212
213static int mei_wd_ops_start(struct watchdog_device *wd_dev)
214{
215 struct mei_device *dev;
216 struct mei_cl *cl;
217 int err = -ENODEV;
218
219 dev = watchdog_get_drvdata(wd_dev);
220 if (!dev)
221 return -ENODEV;
222
223 cl = &dev->wd_cl;
224
225 mutex_lock(&dev->device_lock);
226
227 if (dev->dev_state != MEI_DEV_ENABLED) {
228 dev_dbg(dev->dev, "wd: dev_state != MEI_DEV_ENABLED dev_state = %s\n",
229 mei_dev_state_str(dev->dev_state));
230 goto end_unlock;
231 }
232
233 if (!mei_cl_is_connected(cl)) {
234 cl_dbg(dev, cl, "MEI Driver is not connected to Watchdog Client\n");
235 goto end_unlock;
236 }
237
238 mei_wd_set_start_timeout(dev, dev->wd_timeout);
239
240 err = 0;
241end_unlock:
242 mutex_unlock(&dev->device_lock);
243 return err;
244}
245
246
247
248
249
250
251
252
253static int mei_wd_ops_stop(struct watchdog_device *wd_dev)
254{
255 struct mei_device *dev;
256
257 dev = watchdog_get_drvdata(wd_dev);
258 if (!dev)
259 return -ENODEV;
260
261 mutex_lock(&dev->device_lock);
262 mei_wd_stop(dev);
263 mutex_unlock(&dev->device_lock);
264
265 return 0;
266}
267
268
269
270
271
272
273
274
275static int mei_wd_ops_ping(struct watchdog_device *wd_dev)
276{
277 struct mei_device *dev;
278 struct mei_cl *cl;
279 int ret;
280
281 dev = watchdog_get_drvdata(wd_dev);
282 if (!dev)
283 return -ENODEV;
284
285 cl = &dev->wd_cl;
286
287 mutex_lock(&dev->device_lock);
288
289 if (!mei_cl_is_connected(cl)) {
290 cl_err(dev, cl, "wd: not connected.\n");
291 ret = -ENODEV;
292 goto end;
293 }
294
295 dev->wd_state = MEI_WD_RUNNING;
296
297 ret = mei_cl_flow_ctrl_creds(cl);
298 if (ret < 0)
299 goto end;
300
301
302 if (ret && mei_hbuf_acquire(dev)) {
303 dev_dbg(dev->dev, "wd: sending ping\n");
304
305 ret = mei_wd_send(dev);
306 if (ret)
307 goto end;
308 dev->wd_pending = false;
309 } else {
310 dev->wd_pending = true;
311 }
312
313end:
314 mutex_unlock(&dev->device_lock);
315 return ret;
316}
317
318
319
320
321
322
323
324
325
326static int mei_wd_ops_set_timeout(struct watchdog_device *wd_dev,
327 unsigned int timeout)
328{
329 struct mei_device *dev;
330
331 dev = watchdog_get_drvdata(wd_dev);
332 if (!dev)
333 return -ENODEV;
334
335
336 if (timeout < MEI_WD_MIN_TIMEOUT || timeout > MEI_WD_MAX_TIMEOUT)
337 return -EINVAL;
338
339 mutex_lock(&dev->device_lock);
340
341 dev->wd_timeout = timeout;
342 wd_dev->timeout = timeout;
343 mei_wd_set_start_timeout(dev, dev->wd_timeout);
344
345 mutex_unlock(&dev->device_lock);
346
347 return 0;
348}
349
350
351
352
353static const struct watchdog_ops wd_ops = {
354 .owner = THIS_MODULE,
355 .start = mei_wd_ops_start,
356 .stop = mei_wd_ops_stop,
357 .ping = mei_wd_ops_ping,
358 .set_timeout = mei_wd_ops_set_timeout,
359};
360static const struct watchdog_info wd_info = {
361 .identity = INTEL_AMT_WATCHDOG_ID,
362 .options = WDIOF_KEEPALIVEPING |
363 WDIOF_SETTIMEOUT |
364 WDIOF_ALARMONLY,
365};
366
367static struct watchdog_device amt_wd_dev = {
368 .info = &wd_info,
369 .ops = &wd_ops,
370 .timeout = MEI_WD_DEFAULT_TIMEOUT,
371 .min_timeout = MEI_WD_MIN_TIMEOUT,
372 .max_timeout = MEI_WD_MAX_TIMEOUT,
373};
374
375
376int mei_watchdog_register(struct mei_device *dev)
377{
378
379 int ret;
380
381
382 mutex_unlock(&dev->device_lock);
383 ret = watchdog_register_device(&amt_wd_dev);
384 mutex_lock(&dev->device_lock);
385 if (ret) {
386 dev_err(dev->dev, "wd: unable to register watchdog device = %d.\n",
387 ret);
388 return ret;
389 }
390
391 dev_dbg(dev->dev, "wd: successfully register watchdog interface.\n");
392 watchdog_set_drvdata(&amt_wd_dev, dev);
393 return 0;
394}
395
396void mei_watchdog_unregister(struct mei_device *dev)
397{
398 if (watchdog_get_drvdata(&amt_wd_dev) == NULL)
399 return;
400
401 watchdog_set_drvdata(&amt_wd_dev, NULL);
402 watchdog_unregister_device(&amt_wd_dev);
403}
404
405