1// SPDX-License-Identifier: GPL-2.0-only
2/***************************************************************************
3 * Copyright (C) 2010-2012 by Bruno Prémont <bonbons@linux-vserver.org> *
4 * *
5 * Based on Logitech G13 driver (v0.4) *
6 * Copyright (C) 2009 by Rick L. Vinyard, Jr. <rvinyard@cs.nmsu.edu> *
7 * *
8 ***************************************************************************/
9
10#include <linux/hid.h>
11#include <linux/hid-debug.h>
12#include <linux/input.h>
13#include "hid-ids.h"
14
15#include <linux/fb.h>
16#include <linux/vmalloc.h>
17#include <linux/backlight.h>
18#include <linux/lcd.h>
19
20#include <linux/leds.h>
21
22#include <linux/seq_file.h>
23#include <linux/debugfs.h>
24
25#include <linux/completion.h>
26#include <linux/uaccess.h>
27#include <linux/module.h>
28
29#include "hid-picolcd.h"
30
31
32void picolcd_leds_set(struct picolcd_data *data)
33{
34 struct hid_report *report;
35 unsigned long flags;
36
37 if (!data->led[0])
38 return;
39 report = picolcd_out_report(REPORT_LED_STATE, data->hdev);
40 if (!report || report->maxfield != 1 || report->field[0]->report_count != 1)
41 return;
42
43 spin_lock_irqsave(&data->lock, flags);
44 hid_set_field(report->field[0], 0, data->led_state);
45 if (!(data->status & PICOLCD_FAILED))
46 hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
47 spin_unlock_irqrestore(lock: &data->lock, flags);
48}
49
50static void picolcd_led_set_brightness(struct led_classdev *led_cdev,
51 enum led_brightness value)
52{
53 struct device *dev;
54 struct hid_device *hdev;
55 struct picolcd_data *data;
56 int i, state = 0;
57
58 dev = led_cdev->dev->parent;
59 hdev = to_hid_device(dev);
60 data = hid_get_drvdata(hdev);
61 if (!data)
62 return;
63 for (i = 0; i < 8; i++) {
64 if (led_cdev != data->led[i])
65 continue;
66 state = (data->led_state >> i) & 1;
67 if (value == LED_OFF && state) {
68 data->led_state &= ~(1 << i);
69 picolcd_leds_set(data);
70 } else if (value != LED_OFF && !state) {
71 data->led_state |= 1 << i;
72 picolcd_leds_set(data);
73 }
74 break;
75 }
76}
77
78static enum led_brightness picolcd_led_get_brightness(struct led_classdev *led_cdev)
79{
80 struct device *dev;
81 struct hid_device *hdev;
82 struct picolcd_data *data;
83 int i, value = 0;
84
85 dev = led_cdev->dev->parent;
86 hdev = to_hid_device(dev);
87 data = hid_get_drvdata(hdev);
88 for (i = 0; i < 8; i++)
89 if (led_cdev == data->led[i]) {
90 value = (data->led_state >> i) & 1;
91 break;
92 }
93 return value ? LED_FULL : LED_OFF;
94}
95
96int picolcd_init_leds(struct picolcd_data *data, struct hid_report *report)
97{
98 struct device *dev = &data->hdev->dev;
99 struct led_classdev *led;
100 size_t name_sz = strlen(dev_name(dev)) + 8;
101 char *name;
102 int i, ret = 0;
103
104 if (!report)
105 return -ENODEV;
106 if (report->maxfield != 1 || report->field[0]->report_count != 1 ||
107 report->field[0]->report_size != 8) {
108 dev_err(dev, "unsupported LED_STATE report");
109 return -EINVAL;
110 }
111
112 for (i = 0; i < 8; i++) {
113 led = kzalloc(size: sizeof(struct led_classdev)+name_sz, GFP_KERNEL);
114 if (!led) {
115 dev_err(dev, "can't allocate memory for LED %d\n", i);
116 ret = -ENOMEM;
117 goto err;
118 }
119 name = (void *)(&led[1]);
120 snprintf(buf: name, size: name_sz, fmt: "%s::GPO%d", dev_name(dev), i);
121 led->name = name;
122 led->brightness = 0;
123 led->max_brightness = 1;
124 led->brightness_get = picolcd_led_get_brightness;
125 led->brightness_set = picolcd_led_set_brightness;
126
127 data->led[i] = led;
128 ret = led_classdev_register(parent: dev, led_cdev: data->led[i]);
129 if (ret) {
130 data->led[i] = NULL;
131 kfree(objp: led);
132 dev_err(dev, "can't register LED %d\n", i);
133 goto err;
134 }
135 }
136 return 0;
137err:
138 for (i = 0; i < 8; i++)
139 if (data->led[i]) {
140 led = data->led[i];
141 data->led[i] = NULL;
142 led_classdev_unregister(led_cdev: led);
143 kfree(objp: led);
144 }
145 return ret;
146}
147
148void picolcd_exit_leds(struct picolcd_data *data)
149{
150 struct led_classdev *led;
151 int i;
152
153 for (i = 0; i < 8; i++) {
154 led = data->led[i];
155 data->led[i] = NULL;
156 if (!led)
157 continue;
158 led_classdev_unregister(led_cdev: led);
159 kfree(objp: led);
160 }
161}
162
163
164

source code of linux/drivers/hid/hid-picolcd_leds.c