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 | |
32 | void 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 | |
50 | static 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 | |
78 | static 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 | |
96 | int 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; |
137 | err: |
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 | |
148 | void 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 | |