1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
77
78#include <linux/module.h>
79#include <linux/kernel.h>
80#include <linux/dmi.h>
81#include <linux/spinlock.h>
82#include <linux/platform_device.h>
83#include <linux/input.h>
84#include <linux/io.h>
85#include <linux/ioport.h>
86#include <linux/i8042.h>
87#include <linux/serio.h>
88
89#define IDEAPAD_BASE 0xff29
90
91static bool force;
92module_param(force, bool, 0);
93MODULE_PARM_DESC(force, "Force driver load, ignore DMI data");
94
95static DEFINE_SPINLOCK(io_lock);
96
97static struct input_dev *slidebar_input_dev;
98static struct platform_device *slidebar_platform_dev;
99
100static u8 slidebar_pos_get(void)
101{
102 u8 res;
103 unsigned long flags;
104
105 spin_lock_irqsave(&io_lock, flags);
106 outb(0xf4, 0xff29);
107 outb(0xbf, 0xff2a);
108 res = inb(0xff2b);
109 spin_unlock_irqrestore(&io_lock, flags);
110
111 return res;
112}
113
114static u8 slidebar_mode_get(void)
115{
116 u8 res;
117 unsigned long flags;
118
119 spin_lock_irqsave(&io_lock, flags);
120 outb(0xf7, 0xff29);
121 outb(0x8b, 0xff2a);
122 res = inb(0xff2b);
123 spin_unlock_irqrestore(&io_lock, flags);
124
125 return res;
126}
127
128static void slidebar_mode_set(u8 mode)
129{
130 unsigned long flags;
131
132 spin_lock_irqsave(&io_lock, flags);
133 outb(0xf7, 0xff29);
134 outb(0x8b, 0xff2a);
135 outb(mode, 0xff2b);
136 spin_unlock_irqrestore(&io_lock, flags);
137}
138
139static bool slidebar_i8042_filter(unsigned char data, unsigned char str,
140 struct serio *port)
141{
142 static bool extended = false;
143
144
145 if (str & I8042_STR_AUXDATA)
146 return false;
147
148
149 if (data == 0xe0) {
150 extended = true;
151 return true;
152 }
153
154 if (!extended)
155 return false;
156
157 extended = false;
158
159 if (likely((data & 0x7f) != 0x3b)) {
160 serio_interrupt(port, 0xe0, 0);
161 return false;
162 }
163
164 if (data & 0x80) {
165 input_report_key(slidebar_input_dev, BTN_TOUCH, 0);
166 } else {
167 input_report_key(slidebar_input_dev, BTN_TOUCH, 1);
168 input_report_abs(slidebar_input_dev, ABS_X, slidebar_pos_get());
169 }
170 input_sync(slidebar_input_dev);
171
172 return true;
173}
174
175static ssize_t show_slidebar_mode(struct device *dev,
176 struct device_attribute *attr,
177 char *buf)
178{
179 return sprintf(buf, "%x\n", slidebar_mode_get());
180}
181
182static ssize_t store_slidebar_mode(struct device *dev,
183 struct device_attribute *attr,
184 const char *buf, size_t count)
185{
186 u8 mode;
187 int error;
188
189 error = kstrtou8(buf, 0, &mode);
190 if (error)
191 return error;
192
193 slidebar_mode_set(mode);
194
195 return count;
196}
197
198static DEVICE_ATTR(slidebar_mode, S_IWUSR | S_IRUGO,
199 show_slidebar_mode, store_slidebar_mode);
200
201static struct attribute *ideapad_attrs[] = {
202 &dev_attr_slidebar_mode.attr,
203 NULL
204};
205
206static struct attribute_group ideapad_attr_group = {
207 .attrs = ideapad_attrs
208};
209
210static const struct attribute_group *ideapad_attr_groups[] = {
211 &ideapad_attr_group,
212 NULL
213};
214
215static int __init ideapad_probe(struct platform_device* pdev)
216{
217 int err;
218
219 if (!request_region(IDEAPAD_BASE, 3, "ideapad_slidebar")) {
220 dev_err(&pdev->dev, "IO ports are busy\n");
221 return -EBUSY;
222 }
223
224 slidebar_input_dev = input_allocate_device();
225 if (!slidebar_input_dev) {
226 dev_err(&pdev->dev, "Failed to allocate input device\n");
227 err = -ENOMEM;
228 goto err_release_ports;
229 }
230
231 slidebar_input_dev->name = "IdeaPad Slidebar";
232 slidebar_input_dev->id.bustype = BUS_HOST;
233 slidebar_input_dev->dev.parent = &pdev->dev;
234 input_set_capability(slidebar_input_dev, EV_KEY, BTN_TOUCH);
235 input_set_capability(slidebar_input_dev, EV_ABS, ABS_X);
236 input_set_abs_params(slidebar_input_dev, ABS_X, 0, 0xff, 0, 0);
237
238 err = i8042_install_filter(slidebar_i8042_filter);
239 if (err) {
240 dev_err(&pdev->dev,
241 "Failed to install i8042 filter: %d\n", err);
242 goto err_free_dev;
243 }
244
245 err = input_register_device(slidebar_input_dev);
246 if (err) {
247 dev_err(&pdev->dev,
248 "Failed to register input device: %d\n", err);
249 goto err_remove_filter;
250 }
251
252 return 0;
253
254err_remove_filter:
255 i8042_remove_filter(slidebar_i8042_filter);
256err_free_dev:
257 input_free_device(slidebar_input_dev);
258err_release_ports:
259 release_region(IDEAPAD_BASE, 3);
260 return err;
261}
262
263static int ideapad_remove(struct platform_device *pdev)
264{
265 i8042_remove_filter(slidebar_i8042_filter);
266 input_unregister_device(slidebar_input_dev);
267 release_region(IDEAPAD_BASE, 3);
268
269 return 0;
270}
271
272static struct platform_driver slidebar_drv = {
273 .driver = {
274 .name = "ideapad_slidebar",
275 .owner = THIS_MODULE,
276 },
277 .remove = ideapad_remove,
278};
279
280static int __init ideapad_dmi_check(const struct dmi_system_id *id)
281{
282 pr_info("Laptop model '%s'\n", id->ident);
283 return 1;
284}
285
286static const struct dmi_system_id ideapad_dmi[] __initconst = {
287 {
288 .ident = "Lenovo IdeaPad Y550",
289 .matches = {
290 DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"),
291 DMI_MATCH(DMI_PRODUCT_NAME, "20017"),
292 DMI_MATCH(DMI_PRODUCT_VERSION, "Lenovo IdeaPad Y550")
293 },
294 .callback = ideapad_dmi_check
295 },
296 {
297 .ident = "Lenovo IdeaPad Y550P",
298 .matches = {
299 DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"),
300 DMI_MATCH(DMI_PRODUCT_NAME, "20035"),
301 DMI_MATCH(DMI_PRODUCT_VERSION, "Lenovo IdeaPad Y550P")
302 },
303 .callback = ideapad_dmi_check
304 },
305 { NULL, }
306};
307MODULE_DEVICE_TABLE(dmi, ideapad_dmi);
308
309static int __init slidebar_init(void)
310{
311 int err;
312
313 if (!force && !dmi_check_system(ideapad_dmi)) {
314 pr_err("DMI does not match\n");
315 return -ENODEV;
316 }
317
318 slidebar_platform_dev = platform_device_alloc("ideapad_slidebar", -1);
319 if (!slidebar_platform_dev) {
320 pr_err("Not enough memory\n");
321 return -ENOMEM;
322 }
323
324 slidebar_platform_dev->dev.groups = ideapad_attr_groups;
325
326 err = platform_device_add(slidebar_platform_dev);
327 if (err) {
328 pr_err("Failed to register platform device\n");
329 goto err_free_dev;
330 }
331
332 err = platform_driver_probe(&slidebar_drv, ideapad_probe);
333 if (err) {
334 pr_err("Failed to register platform driver\n");
335 goto err_delete_dev;
336 }
337
338 return 0;
339
340err_delete_dev:
341 platform_device_del(slidebar_platform_dev);
342err_free_dev:
343 platform_device_put(slidebar_platform_dev);
344 return err;
345}
346
347static void __exit slidebar_exit(void)
348{
349 platform_device_unregister(slidebar_platform_dev);
350 platform_driver_unregister(&slidebar_drv);
351}
352
353module_init(slidebar_init);
354module_exit(slidebar_exit);
355
356MODULE_AUTHOR("Andrey Moiseev <o2g.org.ru@gmail.com>");
357MODULE_DESCRIPTION("Slidebar input support for some Lenovo IdeaPad laptops");
358MODULE_LICENSE("GPL");
359
