1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/delay.h>
17#include <linux/kernel.h>
18#include <linux/module.h>
19#include <linux/mfd/cros_ec.h>
20#include <linux/mfd/cros_ec_commands.h>
21#include <linux/of.h>
22#include <linux/platform_device.h>
23#include <linux/slab.h>
24#include <linux/spi/spi.h>
25
26
27
28#define EC_MSG_HEADER 0xec
29
30
31
32
33
34
35
36
37
38
39#define EC_MSG_PREAMBLE_COUNT 32
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57#define EC_MSG_DEADLINE_MS 100
58
59
60
61
62
63
64
65
66#define EC_SPI_RECOVERY_TIME_NS (200 * 1000)
67
68
69
70
71
72#define EC_REBOOT_DELAY_MS 50
73
74
75
76
77
78
79
80
81
82
83struct cros_ec_spi {
84 struct spi_device *spi;
85 s64 last_transfer_ns;
86 unsigned int end_of_msg_delay;
87};
88
89static void debug_packet(struct device *dev, const char *name, u8 *ptr,
90 int len)
91{
92#ifdef DEBUG
93 int i;
94
95 dev_dbg(dev, "%s: ", name);
96 for (i = 0; i < len; i++)
97 pr_cont(" %02x", ptr[i]);
98
99 pr_cont("\n");
100#endif
101}
102
103
104
105
106
107
108
109
110
111
112
113
114
115static int cros_ec_spi_receive_response(struct cros_ec_device *ec_dev,
116 int need_len)
117{
118 struct cros_ec_spi *ec_spi = ec_dev->priv;
119 struct spi_transfer trans;
120 struct spi_message msg;
121 u8 *ptr, *end;
122 int ret;
123 unsigned long deadline;
124 int todo;
125
126
127 deadline = jiffies + msecs_to_jiffies(EC_MSG_DEADLINE_MS);
128 while (true) {
129 unsigned long start_jiffies = jiffies;
130
131 memset(&trans, 0, sizeof(trans));
132 trans.cs_change = 1;
133 trans.rx_buf = ptr = ec_dev->din;
134 trans.len = EC_MSG_PREAMBLE_COUNT;
135
136 spi_message_init(&msg);
137 spi_message_add_tail(&trans, &msg);
138 ret = spi_sync(ec_spi->spi, &msg);
139 if (ret < 0) {
140 dev_err(ec_dev->dev, "spi transfer failed: %d\n", ret);
141 return ret;
142 }
143
144 for (end = ptr + EC_MSG_PREAMBLE_COUNT; ptr != end; ptr++) {
145 if (*ptr == EC_MSG_HEADER) {
146 dev_dbg(ec_dev->dev, "msg found at %zd\n",
147 ptr - ec_dev->din);
148 break;
149 }
150 }
151 if (ptr != end)
152 break;
153
154
155
156
157
158
159 if (time_after(start_jiffies, deadline)) {
160 dev_warn(ec_dev->dev, "EC failed to respond in time\n");
161 return -ETIMEDOUT;
162 }
163 }
164
165
166
167
168
169 todo = end - ++ptr;
170 BUG_ON(todo < 0 || todo > ec_dev->din_size);
171 todo = min(todo, need_len);
172 memmove(ec_dev->din, ptr, todo);
173 ptr = ec_dev->din + todo;
174 dev_dbg(ec_dev->dev, "need %d, got %d bytes from preamble\n",
175 need_len, todo);
176 need_len -= todo;
177
178
179 while (need_len > 0) {
180
181
182
183
184
185
186 todo = min(need_len, 256);
187 dev_dbg(ec_dev->dev, "loop, todo=%d, need_len=%d, ptr=%zd\n",
188 todo, need_len, ptr - ec_dev->din);
189
190 memset(&trans, 0, sizeof(trans));
191 trans.cs_change = 1;
192 trans.rx_buf = ptr;
193 trans.len = todo;
194 spi_message_init(&msg);
195 spi_message_add_tail(&trans, &msg);
196
197
198 BUG_ON((u8 *)trans.rx_buf - ec_dev->din + todo >
199 ec_dev->din_size);
200 ret = spi_sync(ec_spi->spi, &msg);
201 if (ret < 0) {
202 dev_err(ec_dev->dev, "spi transfer failed: %d\n", ret);
203 return ret;
204 }
205
206 debug_packet(ec_dev->dev, "interim", ptr, todo);
207 ptr += todo;
208 need_len -= todo;
209 }
210
211 dev_dbg(ec_dev->dev, "loop done, ptr=%zd\n", ptr - ec_dev->din);
212
213 return 0;
214}
215
216
217
218
219
220
221
222static int cros_ec_cmd_xfer_spi(struct cros_ec_device *ec_dev,
223 struct cros_ec_command *ec_msg)
224{
225 struct cros_ec_spi *ec_spi = ec_dev->priv;
226 struct spi_transfer trans;
227 struct spi_message msg;
228 int i, len;
229 u8 *ptr;
230 int sum;
231 int ret = 0, final_ret;
232
233 len = cros_ec_prepare_tx(ec_dev, ec_msg);
234 dev_dbg(ec_dev->dev, "prepared, len=%d\n", len);
235
236
237 if (ec_spi->last_transfer_ns) {
238 unsigned long delay;
239
240 delay = ktime_get_ns() - ec_spi->last_transfer_ns;
241 if (delay < EC_SPI_RECOVERY_TIME_NS)
242 ndelay(EC_SPI_RECOVERY_TIME_NS - delay);
243 }
244
245
246 debug_packet(ec_dev->dev, "out", ec_dev->dout, len);
247 memset(&trans, 0, sizeof(trans));
248 trans.tx_buf = ec_dev->dout;
249 trans.len = len;
250 trans.cs_change = 1;
251 spi_message_init(&msg);
252 spi_message_add_tail(&trans, &msg);
253 ret = spi_sync(ec_spi->spi, &msg);
254
255
256 if (!ret) {
257 ret = cros_ec_spi_receive_response(ec_dev,
258 ec_msg->insize + EC_MSG_TX_PROTO_BYTES);
259 } else {
260 dev_err(ec_dev->dev, "spi transfer failed: %d\n", ret);
261 }
262
263
264
265
266
267 spi_message_init(&msg);
268 memset(&trans, 0, sizeof(trans));
269 trans.delay_usecs = ec_spi->end_of_msg_delay;
270 spi_message_add_tail(&trans, &msg);
271
272 final_ret = spi_sync(ec_spi->spi, &msg);
273 ec_spi->last_transfer_ns = ktime_get_ns();
274 if (!ret)
275 ret = final_ret;
276 if (ret < 0) {
277 dev_err(ec_dev->dev, "spi transfer failed: %d\n", ret);
278 goto exit;
279 }
280
281 ptr = ec_dev->din;
282
283
284 ec_msg->result = ptr[0];
285 ret = cros_ec_check_result(ec_dev, ec_msg);
286 if (ret)
287 goto exit;
288
289 len = ptr[1];
290 sum = ptr[0] + ptr[1];
291 if (len > ec_msg->insize) {
292 dev_err(ec_dev->dev, "packet too long (%d bytes, expected %d)",
293 len, ec_msg->insize);
294 ret = -ENOSPC;
295 goto exit;
296 }
297
298
299 for (i = 0; i < len; i++) {
300 sum += ptr[i + 2];
301 if (ec_msg->insize)
302 ec_msg->indata[i] = ptr[i + 2];
303 }
304 sum &= 0xff;
305
306 debug_packet(ec_dev->dev, "in", ptr, len + 3);
307
308 if (sum != ptr[len + 2]) {
309 dev_err(ec_dev->dev,
310 "bad packet checksum, expected %02x, got %02x\n",
311 sum, ptr[len + 2]);
312 ret = -EBADMSG;
313 goto exit;
314 }
315
316 ret = len;
317exit:
318 if (ec_msg->command == EC_CMD_REBOOT_EC)
319 msleep(EC_REBOOT_DELAY_MS);
320
321 return ret;
322}
323
324static void cros_ec_spi_dt_probe(struct cros_ec_spi *ec_spi, struct device *dev)
325{
326 struct device_node *np = dev->of_node;
327 u32 val;
328 int ret;
329
330 ret = of_property_read_u32(np, "google,cros-ec-spi-msg-delay", &val);
331 if (!ret)
332 ec_spi->end_of_msg_delay = val;
333}
334
335static int cros_ec_spi_probe(struct spi_device *spi)
336{
337 struct device *dev = &spi->dev;
338 struct cros_ec_device *ec_dev;
339 struct cros_ec_spi *ec_spi;
340 int err;
341
342 spi->bits_per_word = 8;
343 spi->mode = SPI_MODE_0;
344 err = spi_setup(spi);
345 if (err < 0)
346 return err;
347
348 ec_spi = devm_kzalloc(dev, sizeof(*ec_spi), GFP_KERNEL);
349 if (ec_spi == NULL)
350 return -ENOMEM;
351 ec_spi->spi = spi;
352 ec_dev = devm_kzalloc(dev, sizeof(*ec_dev), GFP_KERNEL);
353 if (!ec_dev)
354 return -ENOMEM;
355
356
357 cros_ec_spi_dt_probe(ec_spi, dev);
358
359 spi_set_drvdata(spi, ec_dev);
360 ec_dev->dev = dev;
361 ec_dev->priv = ec_spi;
362 ec_dev->irq = spi->irq;
363 ec_dev->cmd_xfer = cros_ec_cmd_xfer_spi;
364 ec_dev->ec_name = ec_spi->spi->modalias;
365 ec_dev->phys_name = dev_name(&ec_spi->spi->dev);
366 ec_dev->parent = &ec_spi->spi->dev;
367 ec_dev->din_size = EC_MSG_BYTES + EC_MSG_PREAMBLE_COUNT;
368 ec_dev->dout_size = EC_MSG_BYTES;
369
370 err = cros_ec_register(ec_dev);
371 if (err) {
372 dev_err(dev, "cannot register EC\n");
373 return err;
374 }
375
376 device_init_wakeup(&spi->dev, true);
377
378 return 0;
379}
380
381static int cros_ec_spi_remove(struct spi_device *spi)
382{
383 struct cros_ec_device *ec_dev;
384
385 ec_dev = spi_get_drvdata(spi);
386 cros_ec_remove(ec_dev);
387
388 return 0;
389}
390
391#ifdef CONFIG_PM_SLEEP
392static int cros_ec_spi_suspend(struct device *dev)
393{
394 struct cros_ec_device *ec_dev = dev_get_drvdata(dev);
395
396 return cros_ec_suspend(ec_dev);
397}
398
399static int cros_ec_spi_resume(struct device *dev)
400{
401 struct cros_ec_device *ec_dev = dev_get_drvdata(dev);
402
403 return cros_ec_resume(ec_dev);
404}
405#endif
406
407static SIMPLE_DEV_PM_OPS(cros_ec_spi_pm_ops, cros_ec_spi_suspend,
408 cros_ec_spi_resume);
409
410static const struct spi_device_id cros_ec_spi_id[] = {
411 { "cros-ec-spi", 0 },
412 { }
413};
414MODULE_DEVICE_TABLE(spi, cros_ec_spi_id);
415
416static struct spi_driver cros_ec_driver_spi = {
417 .driver = {
418 .name = "cros-ec-spi",
419 .owner = THIS_MODULE,
420 .pm = &cros_ec_spi_pm_ops,
421 },
422 .probe = cros_ec_spi_probe,
423 .remove = cros_ec_spi_remove,
424 .id_table = cros_ec_spi_id,
425};
426
427module_spi_driver(cros_ec_driver_spi);
428
429MODULE_LICENSE("GPL v2");
430MODULE_DESCRIPTION("ChromeOS EC multi function device (SPI)");
431