1
2
3
4
5
6
7
8
9
10
11
12#include <linux/bitops.h>
13#include <linux/input.h>
14#include <linux/serio.h>
15#include <linux/libps2.h>
16#include <linux/types.h>
17#include "psmouse.h"
18#include "logips2pp.h"
19
20
21#define PS2PP_KIND_WHEEL 1
22#define PS2PP_KIND_MX 2
23#define PS2PP_KIND_TP3 3
24#define PS2PP_KIND_TRACKMAN 4
25
26
27#define PS2PP_WHEEL BIT(0)
28#define PS2PP_HWHEEL BIT(1)
29#define PS2PP_SIDE_BTN BIT(2)
30#define PS2PP_EXTRA_BTN BIT(3)
31#define PS2PP_TASK_BTN BIT(4)
32#define PS2PP_NAV_BTN BIT(5)
33
34struct ps2pp_info {
35 u8 model;
36 u8 kind;
37 u16 features;
38};
39
40
41
42
43
44static psmouse_ret_t ps2pp_process_byte(struct psmouse *psmouse)
45{
46 struct input_dev *dev = psmouse->dev;
47 u8 *packet = psmouse->packet;
48
49 if (psmouse->pktcnt < 3)
50 return PSMOUSE_GOOD_DATA;
51
52
53
54
55
56 if ((packet[0] & 0x48) == 0x48 && (packet[1] & 0x02) == 0x02) {
57
58
59 switch ((packet[1] >> 4) | (packet[0] & 0x30)) {
60
61 case 0x0d:
62
63 input_report_rel(dev,
64 packet[2] & 0x80 ? REL_HWHEEL : REL_WHEEL,
65 -sign_extend32(packet[2], 3));
66 input_report_key(dev, BTN_SIDE, packet[2] & BIT(4));
67 input_report_key(dev, BTN_EXTRA, packet[2] & BIT(5));
68
69 break;
70
71 case 0x0e:
72
73 input_report_key(dev, BTN_SIDE, packet[2] & BIT(0));
74 input_report_key(dev, BTN_EXTRA, packet[2] & BIT(1));
75 input_report_key(dev, BTN_TASK, packet[2] & BIT(2));
76 input_report_key(dev, BTN_BACK, packet[2] & BIT(3));
77 input_report_key(dev, BTN_FORWARD, packet[2] & BIT(4));
78
79 break;
80
81 case 0x0f:
82
83 input_report_rel(dev,
84 packet[2] & 0x08 ? REL_HWHEEL : REL_WHEEL,
85 -sign_extend32(packet[2] >> 4, 3));
86 packet[0] = packet[2] | BIT(3);
87 break;
88
89 default:
90 psmouse_dbg(psmouse,
91 "Received PS2++ packet #%x, but don't know how to handle.\n",
92 (packet[1] >> 4) | (packet[0] & 0x30));
93 break;
94 }
95
96 psmouse_report_standard_buttons(dev, packet[0]);
97
98 } else {
99
100 psmouse_report_standard_packet(dev, packet);
101 }
102
103 input_sync(dev);
104
105 return PSMOUSE_FULL_PACKET;
106
107}
108
109
110
111
112
113
114
115
116static int ps2pp_cmd(struct psmouse *psmouse, u8 *param, u8 command)
117{
118 int error;
119
120 error = ps2_sliced_command(&psmouse->ps2dev, command);
121 if (error)
122 return error;
123
124 error = ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_POLL | 0x0300);
125 if (error)
126 return error;
127
128 return 0;
129}
130
131
132
133
134
135
136
137
138
139static void ps2pp_set_smartscroll(struct psmouse *psmouse, bool smartscroll)
140{
141 struct ps2dev *ps2dev = &psmouse->ps2dev;
142 u8 param[4];
143
144 ps2pp_cmd(psmouse, param, 0x32);
145
146 param[0] = 0;
147 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
148 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
149 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
150
151 param[0] = smartscroll;
152 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
153}
154
155static ssize_t ps2pp_attr_show_smartscroll(struct psmouse *psmouse,
156 void *data, char *buf)
157{
158 return sprintf(buf, "%d\n", psmouse->smartscroll);
159}
160
161static ssize_t ps2pp_attr_set_smartscroll(struct psmouse *psmouse, void *data,
162 const char *buf, size_t count)
163{
164 unsigned int value;
165 int err;
166
167 err = kstrtouint(buf, 10, &value);
168 if (err)
169 return err;
170
171 if (value > 1)
172 return -EINVAL;
173
174 ps2pp_set_smartscroll(psmouse, value);
175 psmouse->smartscroll = value;
176 return count;
177}
178
179PSMOUSE_DEFINE_ATTR(smartscroll, S_IWUSR | S_IRUGO, NULL,
180 ps2pp_attr_show_smartscroll, ps2pp_attr_set_smartscroll);
181
182
183
184
185
186
187
188static void ps2pp_set_resolution(struct psmouse *psmouse,
189 unsigned int resolution)
190{
191 if (resolution > 400) {
192 struct ps2dev *ps2dev = &psmouse->ps2dev;
193 u8 param = 3;
194
195 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
196 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
197 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
198 ps2_command(ps2dev, ¶m, PSMOUSE_CMD_SETRES);
199 psmouse->resolution = 800;
200 } else
201 psmouse_set_resolution(psmouse, resolution);
202}
203
204static void ps2pp_disconnect(struct psmouse *psmouse)
205{
206 device_remove_file(&psmouse->ps2dev.serio->dev,
207 &psmouse_attr_smartscroll.dattr);
208}
209
210static const struct ps2pp_info *get_model_info(unsigned char model)
211{
212 static const struct ps2pp_info ps2pp_list[] = {
213 { 1, 0, 0 },
214 { 12, 0, PS2PP_SIDE_BTN},
215 { 13, 0, 0 },
216 { 15, PS2PP_KIND_MX,
217 PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
218 PS2PP_EXTRA_BTN | PS2PP_NAV_BTN | PS2PP_HWHEEL },
219 { 40, 0, PS2PP_SIDE_BTN },
220 { 41, 0, PS2PP_SIDE_BTN },
221 { 42, 0, PS2PP_SIDE_BTN },
222 { 43, 0, PS2PP_SIDE_BTN },
223 { 50, 0, 0 },
224 { 51, 0, 0 },
225 { 52, PS2PP_KIND_WHEEL, PS2PP_SIDE_BTN | PS2PP_WHEEL },
226 { 53, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
227 { 56, PS2PP_KIND_WHEEL, PS2PP_SIDE_BTN | PS2PP_WHEEL },
228 { 61, PS2PP_KIND_MX,
229 PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
230 PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
231 { 66, PS2PP_KIND_MX,
232 PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
233 PS2PP_EXTRA_BTN | PS2PP_NAV_BTN | PS2PP_HWHEEL },
234 { 72, PS2PP_KIND_TRACKMAN, 0 },
235 { 73, PS2PP_KIND_TRACKMAN, PS2PP_SIDE_BTN },
236 { 75, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
237 { 76, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
238 { 79, PS2PP_KIND_TRACKMAN, PS2PP_WHEEL },
239 { 80, PS2PP_KIND_WHEEL, PS2PP_SIDE_BTN | PS2PP_WHEEL },
240 { 81, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
241 { 83, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
242 { 85, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
243 { 86, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
244 { 87, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
245 { 88, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
246 { 96, 0, 0 },
247 { 97, PS2PP_KIND_TP3, PS2PP_WHEEL | PS2PP_HWHEEL },
248 { 99, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
249 { 100, PS2PP_KIND_MX,
250 PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
251 PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
252 { 111, PS2PP_KIND_MX, PS2PP_WHEEL | PS2PP_SIDE_BTN },
253 { 112, PS2PP_KIND_MX,
254 PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
255 PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
256 { 114, PS2PP_KIND_MX,
257 PS2PP_WHEEL | PS2PP_SIDE_BTN |
258 PS2PP_TASK_BTN | PS2PP_EXTRA_BTN }
259 };
260 int i;
261
262 for (i = 0; i < ARRAY_SIZE(ps2pp_list); i++)
263 if (model == ps2pp_list[i].model)
264 return &ps2pp_list[i];
265
266 return NULL;
267}
268
269
270
271
272
273static void ps2pp_set_model_properties(struct psmouse *psmouse,
274 const struct ps2pp_info *model_info,
275 bool using_ps2pp)
276{
277 struct input_dev *input_dev = psmouse->dev;
278
279 if (model_info->features & PS2PP_SIDE_BTN)
280 input_set_capability(input_dev, EV_KEY, BTN_SIDE);
281
282 if (model_info->features & PS2PP_EXTRA_BTN)
283 input_set_capability(input_dev, EV_KEY, BTN_EXTRA);
284
285 if (model_info->features & PS2PP_TASK_BTN)
286 input_set_capability(input_dev, EV_KEY, BTN_TASK);
287
288 if (model_info->features & PS2PP_NAV_BTN) {
289 input_set_capability(input_dev, EV_KEY, BTN_FORWARD);
290 input_set_capability(input_dev, EV_KEY, BTN_BACK);
291 }
292
293 if (model_info->features & PS2PP_WHEEL)
294 input_set_capability(input_dev, EV_REL, REL_WHEEL);
295
296 if (model_info->features & PS2PP_HWHEEL)
297 input_set_capability(input_dev, EV_REL, REL_HWHEEL);
298
299 switch (model_info->kind) {
300
301 case PS2PP_KIND_WHEEL:
302 psmouse->name = "Wheel Mouse";
303 break;
304
305 case PS2PP_KIND_MX:
306 psmouse->name = "MX Mouse";
307 break;
308
309 case PS2PP_KIND_TP3:
310 psmouse->name = "TouchPad 3";
311 break;
312
313 case PS2PP_KIND_TRACKMAN:
314 psmouse->name = "TrackMan";
315 break;
316
317 default:
318
319
320
321
322
323 if (using_ps2pp)
324 psmouse->name = "Mouse";
325 break;
326 }
327}
328
329static int ps2pp_setup_protocol(struct psmouse *psmouse,
330 const struct ps2pp_info *model_info)
331{
332 int error;
333
334 psmouse->protocol_handler = ps2pp_process_byte;
335 psmouse->pktsize = 3;
336
337 if (model_info->kind != PS2PP_KIND_TP3) {
338 psmouse->set_resolution = ps2pp_set_resolution;
339 psmouse->disconnect = ps2pp_disconnect;
340
341 error = device_create_file(&psmouse->ps2dev.serio->dev,
342 &psmouse_attr_smartscroll.dattr);
343 if (error) {
344 psmouse_err(psmouse,
345 "failed to create smartscroll sysfs attribute, error: %d\n",
346 error);
347 return error;
348 }
349 }
350
351 return 0;
352}
353
354
355
356
357
358
359
360int ps2pp_detect(struct psmouse *psmouse, bool set_properties)
361{
362 struct ps2dev *ps2dev = &psmouse->ps2dev;
363 const struct ps2pp_info *model_info;
364 u8 param[4];
365 u8 model, buttons;
366 bool use_ps2pp = false;
367 int error;
368
369 param[0] = 0;
370 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
371 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
372 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
373 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
374 param[1] = 0;
375 ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO);
376
377 model = ((param[0] >> 4) & 0x07) | ((param[0] << 3) & 0x78);
378 buttons = param[1];
379
380 if (!model || !buttons)
381 return -ENXIO;
382
383 model_info = get_model_info(model);
384 if (model_info) {
385
386
387
388
389 if (model_info->kind == PS2PP_KIND_TP3) {
390
391
392 param[0] = 0x11; param[1] = 0x04; param[2] = 0x68;
393 ps2_command(ps2dev, param, 0x30d1);
394
395 param[0] = 0x11; param[1] = 0x05; param[2] = 0x0b;
396 ps2_command(ps2dev, param, 0x30d1);
397
398 param[0] = 0x11; param[1] = 0x09; param[2] = 0xc3;
399 ps2_command(ps2dev, param, 0x30d1);
400
401 param[0] = 0;
402 if (!ps2_command(ps2dev, param, 0x13d1) &&
403 param[0] == 0x06 && param[1] == 0x00 &&
404 param[2] == 0x14) {
405 use_ps2pp = true;
406 }
407
408 } else {
409
410 param[0] = param[1] = param[2] = 0;
411 ps2pp_cmd(psmouse, param, 0x39);
412 ps2pp_cmd(psmouse, param, 0xDB);
413
414 if ((param[0] & 0x78) == 0x48 &&
415 (param[1] & 0xf3) == 0xc2 &&
416 (param[2] & 0x03) == ((param[1] >> 2) & 3)) {
417 ps2pp_set_smartscroll(psmouse, false);
418 use_ps2pp = true;
419 }
420 }
421
422 } else {
423 psmouse_warn(psmouse,
424 "Detected unknown Logitech mouse model %d\n",
425 model);
426 }
427
428 if (set_properties) {
429 psmouse->vendor = "Logitech";
430 psmouse->model = model;
431
432 if (use_ps2pp) {
433 error = ps2pp_setup_protocol(psmouse, model_info);
434 if (error)
435 return error;
436 }
437
438 if (buttons >= 3)
439 input_set_capability(psmouse->dev, EV_KEY, BTN_MIDDLE);
440
441 if (model_info)
442 ps2pp_set_model_properties(psmouse, model_info, use_ps2pp);
443 }
444
445 return use_ps2pp ? 0 : -ENXIO;
446}
447
448