1
2
3
4
5
6#include <linux/ctype.h>
7#include <linux/delay.h>
8#include <linux/device.h>
9#include <linux/fs.h>
10#include <linux/kobject.h>
11#include <linux/module.h>
12#include <linux/platform_data/cros_ec_commands.h>
13#include <linux/platform_data/cros_ec_proto.h>
14#include <linux/platform_device.h>
15#include <linux/sched.h>
16#include <linux/types.h>
17#include <linux/uaccess.h>
18#include <linux/slab.h>
19
20#define DRV_NAME "cros-ec-lightbar"
21
22
23static unsigned long lb_interval_jiffies = 50 * HZ / 1000;
24
25
26
27
28
29static bool userspace_control;
30
31static ssize_t interval_msec_show(struct device *dev,
32 struct device_attribute *attr, char *buf)
33{
34 unsigned long msec = lb_interval_jiffies * 1000 / HZ;
35
36 return scnprintf(buf, PAGE_SIZE, "%lu\n", msec);
37}
38
39static ssize_t interval_msec_store(struct device *dev,
40 struct device_attribute *attr,
41 const char *buf, size_t count)
42{
43 unsigned long msec;
44
45 if (kstrtoul(buf, 0, &msec))
46 return -EINVAL;
47
48 lb_interval_jiffies = msec * HZ / 1000;
49
50 return count;
51}
52
53static DEFINE_MUTEX(lb_mutex);
54
55static int lb_throttle(void)
56{
57 static unsigned long last_access;
58 unsigned long now, next_timeslot;
59 long delay;
60 int ret = 0;
61
62 mutex_lock(&lb_mutex);
63
64 now = jiffies;
65 next_timeslot = last_access + lb_interval_jiffies;
66
67 if (time_before(now, next_timeslot)) {
68 delay = (long)(next_timeslot) - (long)now;
69 set_current_state(TASK_INTERRUPTIBLE);
70 if (schedule_timeout(delay) > 0) {
71
72 ret = -EINTR;
73 goto out;
74 }
75 now = jiffies;
76 }
77
78 last_access = now;
79out:
80 mutex_unlock(&lb_mutex);
81
82 return ret;
83}
84
85static struct cros_ec_command *alloc_lightbar_cmd_msg(struct cros_ec_dev *ec)
86{
87 struct cros_ec_command *msg;
88 int len;
89
90 len = max(sizeof(struct ec_params_lightbar),
91 sizeof(struct ec_response_lightbar));
92
93 msg = kmalloc(sizeof(*msg) + len, GFP_KERNEL);
94 if (!msg)
95 return NULL;
96
97 msg->version = 0;
98 msg->command = EC_CMD_LIGHTBAR_CMD + ec->cmd_offset;
99 msg->outsize = sizeof(struct ec_params_lightbar);
100 msg->insize = sizeof(struct ec_response_lightbar);
101
102 return msg;
103}
104
105static int get_lightbar_version(struct cros_ec_dev *ec,
106 uint32_t *ver_ptr, uint32_t *flg_ptr)
107{
108 struct ec_params_lightbar *param;
109 struct ec_response_lightbar *resp;
110 struct cros_ec_command *msg;
111 int ret;
112
113 msg = alloc_lightbar_cmd_msg(ec);
114 if (!msg)
115 return 0;
116
117 param = (struct ec_params_lightbar *)msg->data;
118 param->cmd = LIGHTBAR_CMD_VERSION;
119 msg->outsize = sizeof(param->cmd);
120 msg->result = sizeof(resp->version);
121 ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
122 if (ret < 0 && ret != -EINVAL) {
123 ret = 0;
124 goto exit;
125 }
126
127 switch (msg->result) {
128 case EC_RES_INVALID_PARAM:
129
130 if (ver_ptr)
131 *ver_ptr = 0;
132 if (flg_ptr)
133 *flg_ptr = 0;
134 ret = 1;
135 goto exit;
136
137 case EC_RES_SUCCESS:
138 resp = (struct ec_response_lightbar *)msg->data;
139
140
141 if (ver_ptr)
142 *ver_ptr = resp->version.num;
143 if (flg_ptr)
144 *flg_ptr = resp->version.flags;
145 ret = 1;
146 goto exit;
147 }
148
149
150 ret = 0;
151exit:
152 kfree(msg);
153 return ret;
154}
155
156static ssize_t version_show(struct device *dev,
157 struct device_attribute *attr, char *buf)
158{
159 uint32_t version = 0, flags = 0;
160 struct cros_ec_dev *ec = to_cros_ec_dev(dev);
161 int ret;
162
163 ret = lb_throttle();
164 if (ret)
165 return ret;
166
167
168 if (!get_lightbar_version(ec, &version, &flags))
169 return -EIO;
170
171 return scnprintf(buf, PAGE_SIZE, "%d %d\n", version, flags);
172}
173
174static ssize_t brightness_store(struct device *dev,
175 struct device_attribute *attr,
176 const char *buf, size_t count)
177{
178 struct ec_params_lightbar *param;
179 struct cros_ec_command *msg;
180 int ret;
181 unsigned int val;
182 struct cros_ec_dev *ec = to_cros_ec_dev(dev);
183
184 if (kstrtouint(buf, 0, &val))
185 return -EINVAL;
186
187 msg = alloc_lightbar_cmd_msg(ec);
188 if (!msg)
189 return -ENOMEM;
190
191 param = (struct ec_params_lightbar *)msg->data;
192 param->cmd = LIGHTBAR_CMD_SET_BRIGHTNESS;
193 param->set_brightness.num = val;
194 ret = lb_throttle();
195 if (ret)
196 goto exit;
197
198 ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
199 if (ret < 0)
200 goto exit;
201
202 ret = count;
203exit:
204 kfree(msg);
205 return ret;
206}
207
208
209
210
211
212
213
214
215
216static ssize_t led_rgb_store(struct device *dev, struct device_attribute *attr,
217 const char *buf, size_t count)
218{
219 struct ec_params_lightbar *param;
220 struct cros_ec_command *msg;
221 struct cros_ec_dev *ec = to_cros_ec_dev(dev);
222 unsigned int val[4];
223 int ret, i = 0, j = 0, ok = 0;
224
225 msg = alloc_lightbar_cmd_msg(ec);
226 if (!msg)
227 return -ENOMEM;
228
229 do {
230
231 while (*buf && isspace(*buf))
232 buf++;
233
234 if (!*buf)
235 break;
236
237 ret = sscanf(buf, "%i", &val[i++]);
238 if (ret == 0)
239 goto exit;
240
241 if (i == 4) {
242 param = (struct ec_params_lightbar *)msg->data;
243 param->cmd = LIGHTBAR_CMD_SET_RGB;
244 param->set_rgb.led = val[0];
245 param->set_rgb.red = val[1];
246 param->set_rgb.green = val[2];
247 param->set_rgb.blue = val[3];
248
249
250
251
252 if ((j++ % 4) == 0) {
253 ret = lb_throttle();
254 if (ret)
255 goto exit;
256 }
257
258 ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
259 if (ret < 0)
260 goto exit;
261
262 i = 0;
263 ok = 1;
264 }
265
266
267 while (*buf && !isspace(*buf))
268 buf++;
269
270 } while (*buf);
271
272exit:
273 kfree(msg);
274 return (ok && i == 0) ? count : -EINVAL;
275}
276
277static char const *seqname[] = {
278 "ERROR", "S5", "S3", "S0", "S5S3", "S3S0",
279 "S0S3", "S3S5", "STOP", "RUN", "KONAMI",
280 "TAP", "PROGRAM",
281};
282
283static ssize_t sequence_show(struct device *dev,
284 struct device_attribute *attr, char *buf)
285{
286 struct ec_params_lightbar *param;
287 struct ec_response_lightbar *resp;
288 struct cros_ec_command *msg;
289 int ret;
290 struct cros_ec_dev *ec = to_cros_ec_dev(dev);
291
292 msg = alloc_lightbar_cmd_msg(ec);
293 if (!msg)
294 return -ENOMEM;
295
296 param = (struct ec_params_lightbar *)msg->data;
297 param->cmd = LIGHTBAR_CMD_GET_SEQ;
298 ret = lb_throttle();
299 if (ret)
300 goto exit;
301
302 ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
303 if (ret < 0) {
304 ret = scnprintf(buf, PAGE_SIZE, "XFER / EC ERROR %d / %d\n",
305 ret, msg->result);
306 goto exit;
307 }
308
309 resp = (struct ec_response_lightbar *)msg->data;
310 if (resp->get_seq.num >= ARRAY_SIZE(seqname))
311 ret = scnprintf(buf, PAGE_SIZE, "%d\n", resp->get_seq.num);
312 else
313 ret = scnprintf(buf, PAGE_SIZE, "%s\n",
314 seqname[resp->get_seq.num]);
315
316exit:
317 kfree(msg);
318 return ret;
319}
320
321static int lb_send_empty_cmd(struct cros_ec_dev *ec, uint8_t cmd)
322{
323 struct ec_params_lightbar *param;
324 struct cros_ec_command *msg;
325 int ret;
326
327 msg = alloc_lightbar_cmd_msg(ec);
328 if (!msg)
329 return -ENOMEM;
330
331 param = (struct ec_params_lightbar *)msg->data;
332 param->cmd = cmd;
333
334 ret = lb_throttle();
335 if (ret)
336 goto error;
337
338 ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
339 if (ret < 0)
340 goto error;
341
342 ret = 0;
343error:
344 kfree(msg);
345
346 return ret;
347}
348
349static int lb_manual_suspend_ctrl(struct cros_ec_dev *ec, uint8_t enable)
350{
351 struct ec_params_lightbar *param;
352 struct cros_ec_command *msg;
353 int ret;
354
355 msg = alloc_lightbar_cmd_msg(ec);
356 if (!msg)
357 return -ENOMEM;
358
359 param = (struct ec_params_lightbar *)msg->data;
360
361 param->cmd = LIGHTBAR_CMD_MANUAL_SUSPEND_CTRL;
362 param->manual_suspend_ctrl.enable = enable;
363
364 ret = lb_throttle();
365 if (ret)
366 goto error;
367
368 ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
369 if (ret < 0)
370 goto error;
371
372 ret = 0;
373error:
374 kfree(msg);
375
376 return ret;
377}
378
379static ssize_t sequence_store(struct device *dev, struct device_attribute *attr,
380 const char *buf, size_t count)
381{
382 struct ec_params_lightbar *param;
383 struct cros_ec_command *msg;
384 unsigned int num;
385 int ret, len;
386 struct cros_ec_dev *ec = to_cros_ec_dev(dev);
387
388 for (len = 0; len < count; len++)
389 if (!isalnum(buf[len]))
390 break;
391
392 for (num = 0; num < ARRAY_SIZE(seqname); num++)
393 if (!strncasecmp(seqname[num], buf, len))
394 break;
395
396 if (num >= ARRAY_SIZE(seqname)) {
397 ret = kstrtouint(buf, 0, &num);
398 if (ret)
399 return ret;
400 }
401
402 msg = alloc_lightbar_cmd_msg(ec);
403 if (!msg)
404 return -ENOMEM;
405
406 param = (struct ec_params_lightbar *)msg->data;
407 param->cmd = LIGHTBAR_CMD_SEQ;
408 param->seq.num = num;
409 ret = lb_throttle();
410 if (ret)
411 goto exit;
412
413 ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
414 if (ret < 0)
415 goto exit;
416
417 ret = count;
418exit:
419 kfree(msg);
420 return ret;
421}
422
423static ssize_t program_store(struct device *dev, struct device_attribute *attr,
424 const char *buf, size_t count)
425{
426 int extra_bytes, max_size, ret;
427 struct ec_params_lightbar *param;
428 struct cros_ec_command *msg;
429 struct cros_ec_dev *ec = to_cros_ec_dev(dev);
430
431
432
433
434
435
436
437
438 extra_bytes = sizeof(*param) - sizeof(param->set_program.data);
439 max_size = min(EC_LB_PROG_LEN, ec->ec_dev->max_request - extra_bytes);
440 if (count > max_size) {
441 dev_err(dev, "Program is %u bytes, too long to send (max: %u)",
442 (unsigned int)count, max_size);
443
444 return -EINVAL;
445 }
446
447 msg = alloc_lightbar_cmd_msg(ec);
448 if (!msg)
449 return -ENOMEM;
450
451 ret = lb_throttle();
452 if (ret)
453 goto exit;
454
455 dev_info(dev, "Copying %zu byte program to EC", count);
456
457 param = (struct ec_params_lightbar *)msg->data;
458 param->cmd = LIGHTBAR_CMD_SET_PROGRAM;
459
460 param->set_program.size = count;
461 memcpy(param->set_program.data, buf, count);
462
463
464
465
466
467
468 msg->outsize = count + extra_bytes;
469
470 ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
471 if (ret < 0)
472 goto exit;
473
474 ret = count;
475exit:
476 kfree(msg);
477
478 return ret;
479}
480
481static ssize_t userspace_control_show(struct device *dev,
482 struct device_attribute *attr,
483 char *buf)
484{
485 return scnprintf(buf, PAGE_SIZE, "%d\n", userspace_control);
486}
487
488static ssize_t userspace_control_store(struct device *dev,
489 struct device_attribute *attr,
490 const char *buf,
491 size_t count)
492{
493 bool enable;
494 int ret;
495
496 ret = strtobool(buf, &enable);
497 if (ret < 0)
498 return ret;
499
500 userspace_control = enable;
501
502 return count;
503}
504
505
506
507static DEVICE_ATTR_RW(interval_msec);
508static DEVICE_ATTR_RO(version);
509static DEVICE_ATTR_WO(brightness);
510static DEVICE_ATTR_WO(led_rgb);
511static DEVICE_ATTR_RW(sequence);
512static DEVICE_ATTR_WO(program);
513static DEVICE_ATTR_RW(userspace_control);
514
515static struct attribute *__lb_cmds_attrs[] = {
516 &dev_attr_interval_msec.attr,
517 &dev_attr_version.attr,
518 &dev_attr_brightness.attr,
519 &dev_attr_led_rgb.attr,
520 &dev_attr_sequence.attr,
521 &dev_attr_program.attr,
522 &dev_attr_userspace_control.attr,
523 NULL,
524};
525
526static const struct attribute_group cros_ec_lightbar_attr_group = {
527 .name = "lightbar",
528 .attrs = __lb_cmds_attrs,
529};
530
531static int cros_ec_lightbar_probe(struct platform_device *pd)
532{
533 struct cros_ec_dev *ec_dev = dev_get_drvdata(pd->dev.parent);
534 struct cros_ec_platform *pdata = dev_get_platdata(ec_dev->dev);
535 struct device *dev = &pd->dev;
536 int ret;
537
538
539
540
541
542 if (strcmp(pdata->ec_name, CROS_EC_DEV_NAME) != 0)
543 return -ENODEV;
544
545
546
547
548
549 if (!get_lightbar_version(ec_dev, NULL, NULL))
550 return -ENODEV;
551
552
553 lb_manual_suspend_ctrl(ec_dev, 1);
554
555 ret = sysfs_create_group(&ec_dev->class_dev.kobj,
556 &cros_ec_lightbar_attr_group);
557 if (ret < 0)
558 dev_err(dev, "failed to create %s attributes. err=%d\n",
559 cros_ec_lightbar_attr_group.name, ret);
560
561 return ret;
562}
563
564static int cros_ec_lightbar_remove(struct platform_device *pd)
565{
566 struct cros_ec_dev *ec_dev = dev_get_drvdata(pd->dev.parent);
567
568 sysfs_remove_group(&ec_dev->class_dev.kobj,
569 &cros_ec_lightbar_attr_group);
570
571
572 lb_manual_suspend_ctrl(ec_dev, 0);
573
574 return 0;
575}
576
577static int __maybe_unused cros_ec_lightbar_resume(struct device *dev)
578{
579 struct cros_ec_dev *ec_dev = dev_get_drvdata(dev->parent);
580
581 if (userspace_control)
582 return 0;
583
584 return lb_send_empty_cmd(ec_dev, LIGHTBAR_CMD_RESUME);
585}
586
587static int __maybe_unused cros_ec_lightbar_suspend(struct device *dev)
588{
589 struct cros_ec_dev *ec_dev = dev_get_drvdata(dev->parent);
590
591 if (userspace_control)
592 return 0;
593
594 return lb_send_empty_cmd(ec_dev, LIGHTBAR_CMD_SUSPEND);
595}
596
597static SIMPLE_DEV_PM_OPS(cros_ec_lightbar_pm_ops,
598 cros_ec_lightbar_suspend, cros_ec_lightbar_resume);
599
600static struct platform_driver cros_ec_lightbar_driver = {
601 .driver = {
602 .name = DRV_NAME,
603 .pm = &cros_ec_lightbar_pm_ops,
604 },
605 .probe = cros_ec_lightbar_probe,
606 .remove = cros_ec_lightbar_remove,
607};
608
609module_platform_driver(cros_ec_lightbar_driver);
610
611MODULE_LICENSE("GPL");
612MODULE_DESCRIPTION("Expose the Chromebook Pixel's lightbar to userspace");
613MODULE_ALIAS("platform:" DRV_NAME);
614