]>
Commit | Line | Data |
---|---|---|
24c9d96d | 1 | // SPDX-License-Identifier: GPL-2.0-only |
fabdbf2f BP |
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 | * * | |
fabdbf2f BP |
8 | ***************************************************************************/ |
9 | ||
10 | #include <linux/hid.h> | |
11 | #include <linux/hid-debug.h> | |
12 | #include <linux/input.h> | |
13 | #include "hid-ids.h" | |
fabdbf2f BP |
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); | |
a93ab849 | 45 | if (!(data->status & PICOLCD_FAILED)) |
d8814272 | 46 | hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT); |
fabdbf2f BP |
47 | spin_unlock_irqrestore(&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; | |
ee79a8f8 | 59 | hdev = to_hid_device(dev); |
fabdbf2f | 60 | data = hid_get_drvdata(hdev); |
b07072e6 BP |
61 | if (!data) |
62 | return; | |
fabdbf2f BP |
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; | |
ee79a8f8 | 86 | hdev = to_hid_device(dev); |
fabdbf2f BP |
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(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(name, name_sz, "%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(dev, data->led[i]); | |
129 | if (ret) { | |
130 | data->led[i] = NULL; | |
131 | kfree(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); | |
143 | kfree(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); | |
159 | kfree(led); | |
160 | } | |
161 | } | |
162 | ||
163 |