Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
1
fork

Configure Feed

Select the types of activity you want to include in your feed.

at 77dc2db6d1d2703ee4e83d4b3dbecf4e06a910e6 1510 lines 38 kB view raw
1/* 2 * PS/2 mouse driver 3 * 4 * Copyright (c) 1999-2002 Vojtech Pavlik 5 * Copyright (c) 2003-2004 Dmitry Torokhov 6 */ 7 8/* 9 * This program is free software; you can redistribute it and/or modify it 10 * under the terms of the GNU General Public License version 2 as published by 11 * the Free Software Foundation. 12 */ 13 14#include <linux/delay.h> 15#include <linux/module.h> 16#include <linux/moduleparam.h> 17#include <linux/slab.h> 18#include <linux/interrupt.h> 19#include <linux/input.h> 20#include <linux/serio.h> 21#include <linux/init.h> 22#include <linux/libps2.h> 23#include <linux/mutex.h> 24 25#include "psmouse.h" 26#include "synaptics.h" 27#include "logips2pp.h" 28#include "alps.h" 29#include "lifebook.h" 30#include "trackpoint.h" 31 32#define DRIVER_DESC "PS/2 mouse driver" 33 34MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>"); 35MODULE_DESCRIPTION(DRIVER_DESC); 36MODULE_LICENSE("GPL"); 37 38static unsigned int psmouse_max_proto = PSMOUSE_AUTO; 39static int psmouse_set_maxproto(const char *val, struct kernel_param *kp); 40static int psmouse_get_maxproto(char *buffer, struct kernel_param *kp); 41#define param_check_proto_abbrev(name, p) __param_check(name, p, unsigned int) 42#define param_set_proto_abbrev psmouse_set_maxproto 43#define param_get_proto_abbrev psmouse_get_maxproto 44module_param_named(proto, psmouse_max_proto, proto_abbrev, 0644); 45MODULE_PARM_DESC(proto, "Highest protocol extension to probe (bare, imps, exps, any). Useful for KVM switches."); 46 47static unsigned int psmouse_resolution = 200; 48module_param_named(resolution, psmouse_resolution, uint, 0644); 49MODULE_PARM_DESC(resolution, "Resolution, in dpi."); 50 51static unsigned int psmouse_rate = 100; 52module_param_named(rate, psmouse_rate, uint, 0644); 53MODULE_PARM_DESC(rate, "Report rate, in reports per second."); 54 55static unsigned int psmouse_smartscroll = 1; 56module_param_named(smartscroll, psmouse_smartscroll, bool, 0644); 57MODULE_PARM_DESC(smartscroll, "Logitech Smartscroll autorepeat, 1 = enabled (default), 0 = disabled."); 58 59static unsigned int psmouse_resetafter = 5; 60module_param_named(resetafter, psmouse_resetafter, uint, 0644); 61MODULE_PARM_DESC(resetafter, "Reset device after so many bad packets (0 = never)."); 62 63static unsigned int psmouse_resync_time; 64module_param_named(resync_time, psmouse_resync_time, uint, 0644); 65MODULE_PARM_DESC(resync_time, "How long can mouse stay idle before forcing resync (in seconds, 0 = never)."); 66 67PSMOUSE_DEFINE_ATTR(protocol, S_IWUSR | S_IRUGO, 68 NULL, 69 psmouse_attr_show_protocol, psmouse_attr_set_protocol); 70PSMOUSE_DEFINE_ATTR(rate, S_IWUSR | S_IRUGO, 71 (void *) offsetof(struct psmouse, rate), 72 psmouse_show_int_attr, psmouse_attr_set_rate); 73PSMOUSE_DEFINE_ATTR(resolution, S_IWUSR | S_IRUGO, 74 (void *) offsetof(struct psmouse, resolution), 75 psmouse_show_int_attr, psmouse_attr_set_resolution); 76PSMOUSE_DEFINE_ATTR(resetafter, S_IWUSR | S_IRUGO, 77 (void *) offsetof(struct psmouse, resetafter), 78 psmouse_show_int_attr, psmouse_set_int_attr); 79PSMOUSE_DEFINE_ATTR(resync_time, S_IWUSR | S_IRUGO, 80 (void *) offsetof(struct psmouse, resync_time), 81 psmouse_show_int_attr, psmouse_set_int_attr); 82 83static struct attribute *psmouse_attributes[] = { 84 &psmouse_attr_protocol.dattr.attr, 85 &psmouse_attr_rate.dattr.attr, 86 &psmouse_attr_resolution.dattr.attr, 87 &psmouse_attr_resetafter.dattr.attr, 88 &psmouse_attr_resync_time.dattr.attr, 89 NULL 90}; 91 92static struct attribute_group psmouse_attribute_group = { 93 .attrs = psmouse_attributes, 94}; 95 96__obsolete_setup("psmouse_noext"); 97__obsolete_setup("psmouse_resolution="); 98__obsolete_setup("psmouse_smartscroll="); 99__obsolete_setup("psmouse_resetafter="); 100__obsolete_setup("psmouse_rate="); 101 102/* 103 * psmouse_mutex protects all operations changing state of mouse 104 * (connecting, disconnecting, changing rate or resolution via 105 * sysfs). We could use a per-device semaphore but since there 106 * rarely more than one PS/2 mouse connected and since semaphore 107 * is taken in "slow" paths it is not worth it. 108 */ 109static DEFINE_MUTEX(psmouse_mutex); 110 111static struct workqueue_struct *kpsmoused_wq; 112 113struct psmouse_protocol { 114 enum psmouse_type type; 115 const char *name; 116 const char *alias; 117 int maxproto; 118 int (*detect)(struct psmouse *, int); 119 int (*init)(struct psmouse *); 120}; 121 122/* 123 * psmouse_process_byte() analyzes the PS/2 data stream and reports 124 * relevant events to the input module once full packet has arrived. 125 */ 126 127static psmouse_ret_t psmouse_process_byte(struct psmouse *psmouse, struct pt_regs *regs) 128{ 129 struct input_dev *dev = psmouse->dev; 130 unsigned char *packet = psmouse->packet; 131 132 if (psmouse->pktcnt < psmouse->pktsize) 133 return PSMOUSE_GOOD_DATA; 134 135/* 136 * Full packet accumulated, process it 137 */ 138 139 input_regs(dev, regs); 140 141/* 142 * Scroll wheel on IntelliMice, scroll buttons on NetMice 143 */ 144 145 if (psmouse->type == PSMOUSE_IMPS || psmouse->type == PSMOUSE_GENPS) 146 input_report_rel(dev, REL_WHEEL, -(signed char) packet[3]); 147 148/* 149 * Scroll wheel and buttons on IntelliMouse Explorer 150 */ 151 152 if (psmouse->type == PSMOUSE_IMEX) { 153 switch (packet[3] & 0xC0) { 154 case 0x80: /* vertical scroll on IntelliMouse Explorer 4.0 */ 155 input_report_rel(dev, REL_WHEEL, (int) (packet[3] & 32) - (int) (packet[3] & 31)); 156 break; 157 case 0x40: /* horizontal scroll on IntelliMouse Explorer 4.0 */ 158 input_report_rel(dev, REL_HWHEEL, (int) (packet[3] & 32) - (int) (packet[3] & 31)); 159 break; 160 case 0x00: 161 case 0xC0: 162 input_report_rel(dev, REL_WHEEL, (int) (packet[3] & 8) - (int) (packet[3] & 7)); 163 input_report_key(dev, BTN_SIDE, (packet[3] >> 4) & 1); 164 input_report_key(dev, BTN_EXTRA, (packet[3] >> 5) & 1); 165 break; 166 } 167 } 168 169/* 170 * Extra buttons on Genius NewNet 3D 171 */ 172 173 if (psmouse->type == PSMOUSE_GENPS) { 174 input_report_key(dev, BTN_SIDE, (packet[0] >> 6) & 1); 175 input_report_key(dev, BTN_EXTRA, (packet[0] >> 7) & 1); 176 } 177 178/* 179 * Extra button on ThinkingMouse 180 */ 181 if (psmouse->type == PSMOUSE_THINKPS) { 182 input_report_key(dev, BTN_EXTRA, (packet[0] >> 3) & 1); 183 /* Without this bit of weirdness moving up gives wildly high Y changes. */ 184 packet[1] |= (packet[0] & 0x40) << 1; 185 } 186 187/* 188 * Generic PS/2 Mouse 189 */ 190 191 input_report_key(dev, BTN_LEFT, packet[0] & 1); 192 input_report_key(dev, BTN_MIDDLE, (packet[0] >> 2) & 1); 193 input_report_key(dev, BTN_RIGHT, (packet[0] >> 1) & 1); 194 195 input_report_rel(dev, REL_X, packet[1] ? (int) packet[1] - (int) ((packet[0] << 4) & 0x100) : 0); 196 input_report_rel(dev, REL_Y, packet[2] ? (int) ((packet[0] << 3) & 0x100) - (int) packet[2] : 0); 197 198 input_sync(dev); 199 200 return PSMOUSE_FULL_PACKET; 201} 202 203/* 204 * __psmouse_set_state() sets new psmouse state and resets all flags. 205 */ 206 207static inline void __psmouse_set_state(struct psmouse *psmouse, enum psmouse_state new_state) 208{ 209 psmouse->state = new_state; 210 psmouse->pktcnt = psmouse->out_of_sync = 0; 211 psmouse->ps2dev.flags = 0; 212 psmouse->last = jiffies; 213} 214 215 216/* 217 * psmouse_set_state() sets new psmouse state and resets all flags and 218 * counters while holding serio lock so fighting with interrupt handler 219 * is not a concern. 220 */ 221 222static void psmouse_set_state(struct psmouse *psmouse, enum psmouse_state new_state) 223{ 224 serio_pause_rx(psmouse->ps2dev.serio); 225 __psmouse_set_state(psmouse, new_state); 226 serio_continue_rx(psmouse->ps2dev.serio); 227} 228 229/* 230 * psmouse_handle_byte() processes one byte of the input data stream 231 * by calling corresponding protocol handler. 232 */ 233 234static int psmouse_handle_byte(struct psmouse *psmouse, struct pt_regs *regs) 235{ 236 psmouse_ret_t rc = psmouse->protocol_handler(psmouse, regs); 237 238 switch (rc) { 239 case PSMOUSE_BAD_DATA: 240 if (psmouse->state == PSMOUSE_ACTIVATED) { 241 printk(KERN_WARNING "psmouse.c: %s at %s lost sync at byte %d\n", 242 psmouse->name, psmouse->phys, psmouse->pktcnt); 243 if (++psmouse->out_of_sync == psmouse->resetafter) { 244 __psmouse_set_state(psmouse, PSMOUSE_IGNORE); 245 printk(KERN_NOTICE "psmouse.c: issuing reconnect request\n"); 246 serio_reconnect(psmouse->ps2dev.serio); 247 return -1; 248 } 249 } 250 psmouse->pktcnt = 0; 251 break; 252 253 case PSMOUSE_FULL_PACKET: 254 psmouse->pktcnt = 0; 255 if (psmouse->out_of_sync) { 256 psmouse->out_of_sync = 0; 257 printk(KERN_NOTICE "psmouse.c: %s at %s - driver resynched.\n", 258 psmouse->name, psmouse->phys); 259 } 260 break; 261 262 case PSMOUSE_GOOD_DATA: 263 break; 264 } 265 return 0; 266} 267 268/* 269 * psmouse_interrupt() handles incoming characters, either passing them 270 * for normal processing or gathering them as command response. 271 */ 272 273static irqreturn_t psmouse_interrupt(struct serio *serio, 274 unsigned char data, unsigned int flags, struct pt_regs *regs) 275{ 276 struct psmouse *psmouse = serio_get_drvdata(serio); 277 278 if (psmouse->state == PSMOUSE_IGNORE) 279 goto out; 280 281 if (flags & (SERIO_PARITY|SERIO_TIMEOUT)) { 282 if (psmouse->state == PSMOUSE_ACTIVATED) 283 printk(KERN_WARNING "psmouse.c: bad data from KBC -%s%s\n", 284 flags & SERIO_TIMEOUT ? " timeout" : "", 285 flags & SERIO_PARITY ? " bad parity" : ""); 286 ps2_cmd_aborted(&psmouse->ps2dev); 287 goto out; 288 } 289 290 if (unlikely(psmouse->ps2dev.flags & PS2_FLAG_ACK)) 291 if (ps2_handle_ack(&psmouse->ps2dev, data)) 292 goto out; 293 294 if (unlikely(psmouse->ps2dev.flags & PS2_FLAG_CMD)) 295 if (ps2_handle_response(&psmouse->ps2dev, data)) 296 goto out; 297 298 if (psmouse->state <= PSMOUSE_RESYNCING) 299 goto out; 300 301 if (psmouse->state == PSMOUSE_ACTIVATED && 302 psmouse->pktcnt && time_after(jiffies, psmouse->last + HZ/2)) { 303 printk(KERN_INFO "psmouse.c: %s at %s lost synchronization, throwing %d bytes away.\n", 304 psmouse->name, psmouse->phys, psmouse->pktcnt); 305 psmouse->badbyte = psmouse->packet[0]; 306 __psmouse_set_state(psmouse, PSMOUSE_RESYNCING); 307 queue_work(kpsmoused_wq, &psmouse->resync_work); 308 goto out; 309 } 310 311 psmouse->packet[psmouse->pktcnt++] = data; 312/* 313 * Check if this is a new device announcement (0xAA 0x00) 314 */ 315 if (unlikely(psmouse->packet[0] == PSMOUSE_RET_BAT && psmouse->pktcnt <= 2)) { 316 if (psmouse->pktcnt == 1) { 317 psmouse->last = jiffies; 318 goto out; 319 } 320 321 if (psmouse->packet[1] == PSMOUSE_RET_ID) { 322 __psmouse_set_state(psmouse, PSMOUSE_IGNORE); 323 serio_reconnect(serio); 324 goto out; 325 } 326/* 327 * Not a new device, try processing first byte normally 328 */ 329 psmouse->pktcnt = 1; 330 if (psmouse_handle_byte(psmouse, regs)) 331 goto out; 332 333 psmouse->packet[psmouse->pktcnt++] = data; 334 } 335 336/* 337 * See if we need to force resync because mouse was idle for too long 338 */ 339 if (psmouse->state == PSMOUSE_ACTIVATED && 340 psmouse->pktcnt == 1 && psmouse->resync_time && 341 time_after(jiffies, psmouse->last + psmouse->resync_time * HZ)) { 342 psmouse->badbyte = psmouse->packet[0]; 343 __psmouse_set_state(psmouse, PSMOUSE_RESYNCING); 344 queue_work(kpsmoused_wq, &psmouse->resync_work); 345 goto out; 346 } 347 348 psmouse->last = jiffies; 349 psmouse_handle_byte(psmouse, regs); 350 351 out: 352 return IRQ_HANDLED; 353} 354 355 356/* 357 * psmouse_sliced_command() sends an extended PS/2 command to the mouse 358 * using sliced syntax, understood by advanced devices, such as Logitech 359 * or Synaptics touchpads. The command is encoded as: 360 * 0xE6 0xE8 rr 0xE8 ss 0xE8 tt 0xE8 uu where (rr*64)+(ss*16)+(tt*4)+uu 361 * is the command. 362 */ 363int psmouse_sliced_command(struct psmouse *psmouse, unsigned char command) 364{ 365 int i; 366 367 if (ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11)) 368 return -1; 369 370 for (i = 6; i >= 0; i -= 2) { 371 unsigned char d = (command >> i) & 3; 372 if (ps2_command(&psmouse->ps2dev, &d, PSMOUSE_CMD_SETRES)) 373 return -1; 374 } 375 376 return 0; 377} 378 379 380/* 381 * psmouse_reset() resets the mouse into power-on state. 382 */ 383int psmouse_reset(struct psmouse *psmouse) 384{ 385 unsigned char param[2]; 386 387 if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_RESET_BAT)) 388 return -1; 389 390 if (param[0] != PSMOUSE_RET_BAT && param[1] != PSMOUSE_RET_ID) 391 return -1; 392 393 return 0; 394} 395 396 397/* 398 * Genius NetMouse magic init. 399 */ 400static int genius_detect(struct psmouse *psmouse, int set_properties) 401{ 402 struct ps2dev *ps2dev = &psmouse->ps2dev; 403 unsigned char param[4]; 404 405 param[0] = 3; 406 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); 407 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); 408 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); 409 ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); 410 ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO); 411 412 if (param[0] != 0x00 || param[1] != 0x33 || param[2] != 0x55) 413 return -1; 414 415 if (set_properties) { 416 set_bit(BTN_EXTRA, psmouse->dev->keybit); 417 set_bit(BTN_SIDE, psmouse->dev->keybit); 418 set_bit(REL_WHEEL, psmouse->dev->relbit); 419 420 psmouse->vendor = "Genius"; 421 psmouse->name = "Mouse"; 422 psmouse->pktsize = 4; 423 } 424 425 return 0; 426} 427 428/* 429 * IntelliMouse magic init. 430 */ 431static int intellimouse_detect(struct psmouse *psmouse, int set_properties) 432{ 433 struct ps2dev *ps2dev = &psmouse->ps2dev; 434 unsigned char param[2]; 435 436 param[0] = 200; 437 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 438 param[0] = 100; 439 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 440 param[0] = 80; 441 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 442 ps2_command(ps2dev, param, PSMOUSE_CMD_GETID); 443 444 if (param[0] != 3) 445 return -1; 446 447 if (set_properties) { 448 set_bit(BTN_MIDDLE, psmouse->dev->keybit); 449 set_bit(REL_WHEEL, psmouse->dev->relbit); 450 451 if (!psmouse->vendor) psmouse->vendor = "Generic"; 452 if (!psmouse->name) psmouse->name = "Wheel Mouse"; 453 psmouse->pktsize = 4; 454 } 455 456 return 0; 457} 458 459/* 460 * Try IntelliMouse/Explorer magic init. 461 */ 462static int im_explorer_detect(struct psmouse *psmouse, int set_properties) 463{ 464 struct ps2dev *ps2dev = &psmouse->ps2dev; 465 unsigned char param[2]; 466 467 intellimouse_detect(psmouse, 0); 468 469 param[0] = 200; 470 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 471 param[0] = 200; 472 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 473 param[0] = 80; 474 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 475 ps2_command(ps2dev, param, PSMOUSE_CMD_GETID); 476 477 if (param[0] != 4) 478 return -1; 479 480/* Magic to enable horizontal scrolling on IntelliMouse 4.0 */ 481 param[0] = 200; 482 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 483 param[0] = 80; 484 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 485 param[0] = 40; 486 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 487 488 if (set_properties) { 489 set_bit(BTN_MIDDLE, psmouse->dev->keybit); 490 set_bit(REL_WHEEL, psmouse->dev->relbit); 491 set_bit(REL_HWHEEL, psmouse->dev->relbit); 492 set_bit(BTN_SIDE, psmouse->dev->keybit); 493 set_bit(BTN_EXTRA, psmouse->dev->keybit); 494 495 if (!psmouse->vendor) psmouse->vendor = "Generic"; 496 if (!psmouse->name) psmouse->name = "Explorer Mouse"; 497 psmouse->pktsize = 4; 498 } 499 500 return 0; 501} 502 503/* 504 * Kensington ThinkingMouse / ExpertMouse magic init. 505 */ 506static int thinking_detect(struct psmouse *psmouse, int set_properties) 507{ 508 struct ps2dev *ps2dev = &psmouse->ps2dev; 509 unsigned char param[2]; 510 static const unsigned char seq[] = { 20, 60, 40, 20, 20, 60, 40, 20, 20 }; 511 int i; 512 513 param[0] = 10; 514 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 515 param[0] = 0; 516 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES); 517 for (i = 0; i < ARRAY_SIZE(seq); i++) { 518 param[0] = seq[i]; 519 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRATE); 520 } 521 ps2_command(ps2dev, param, PSMOUSE_CMD_GETID); 522 523 if (param[0] != 2) 524 return -1; 525 526 if (set_properties) { 527 set_bit(BTN_EXTRA, psmouse->dev->keybit); 528 529 psmouse->vendor = "Kensington"; 530 psmouse->name = "ThinkingMouse"; 531 } 532 533 return 0; 534} 535 536/* 537 * Bare PS/2 protocol "detection". Always succeeds. 538 */ 539static int ps2bare_detect(struct psmouse *psmouse, int set_properties) 540{ 541 if (set_properties) { 542 if (!psmouse->vendor) psmouse->vendor = "Generic"; 543 if (!psmouse->name) psmouse->name = "Mouse"; 544 } 545 546 return 0; 547} 548 549 550/* 551 * psmouse_extensions() probes for any extensions to the basic PS/2 protocol 552 * the mouse may have. 553 */ 554 555static int psmouse_extensions(struct psmouse *psmouse, 556 unsigned int max_proto, int set_properties) 557{ 558 int synaptics_hardware = 0; 559 560/* 561 * We always check for lifebook because it does not disturb mouse 562 * (it only checks DMI information). 563 */ 564 if (lifebook_detect(psmouse, set_properties) == 0) { 565 if (max_proto > PSMOUSE_IMEX) { 566 if (!set_properties || lifebook_init(psmouse) == 0) 567 return PSMOUSE_LIFEBOOK; 568 } 569 } 570 571/* 572 * Try Kensington ThinkingMouse (we try first, because synaptics probe 573 * upsets the thinkingmouse). 574 */ 575 576 if (max_proto > PSMOUSE_IMEX && thinking_detect(psmouse, set_properties) == 0) 577 return PSMOUSE_THINKPS; 578 579/* 580 * Try Synaptics TouchPad 581 */ 582 if (max_proto > PSMOUSE_PS2 && synaptics_detect(psmouse, set_properties) == 0) { 583 synaptics_hardware = 1; 584 585 if (max_proto > PSMOUSE_IMEX) { 586 if (!set_properties || synaptics_init(psmouse) == 0) 587 return PSMOUSE_SYNAPTICS; 588/* 589 * Some Synaptics touchpads can emulate extended protocols (like IMPS/2). 590 * Unfortunately Logitech/Genius probes confuse some firmware versions so 591 * we'll have to skip them. 592 */ 593 max_proto = PSMOUSE_IMEX; 594 } 595/* 596 * Make sure that touchpad is in relative mode, gestures (taps) are enabled 597 */ 598 synaptics_reset(psmouse); 599 } 600 601/* 602 * Try ALPS TouchPad 603 */ 604 if (max_proto > PSMOUSE_IMEX) { 605 ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_RESET_DIS); 606 if (alps_detect(psmouse, set_properties) == 0) { 607 if (!set_properties || alps_init(psmouse) == 0) 608 return PSMOUSE_ALPS; 609/* 610 * Init failed, try basic relative protocols 611 */ 612 max_proto = PSMOUSE_IMEX; 613 } 614 } 615 616 if (max_proto > PSMOUSE_IMEX && genius_detect(psmouse, set_properties) == 0) 617 return PSMOUSE_GENPS; 618 619 if (max_proto > PSMOUSE_IMEX && ps2pp_init(psmouse, set_properties) == 0) 620 return PSMOUSE_PS2PP; 621 622 if (max_proto > PSMOUSE_IMEX && trackpoint_detect(psmouse, set_properties) == 0) 623 return PSMOUSE_TRACKPOINT; 624 625/* 626 * Reset to defaults in case the device got confused by extended 627 * protocol probes. Note that we do full reset becuase some mice 628 * put themselves to sleep when see PSMOUSE_RESET_DIS. 629 */ 630 psmouse_reset(psmouse); 631 632 if (max_proto >= PSMOUSE_IMEX && im_explorer_detect(psmouse, set_properties) == 0) 633 return PSMOUSE_IMEX; 634 635 if (max_proto >= PSMOUSE_IMPS && intellimouse_detect(psmouse, set_properties) == 0) 636 return PSMOUSE_IMPS; 637 638/* 639 * Okay, all failed, we have a standard mouse here. The number of the buttons 640 * is still a question, though. We assume 3. 641 */ 642 ps2bare_detect(psmouse, set_properties); 643 644 if (synaptics_hardware) { 645/* 646 * We detected Synaptics hardware but it did not respond to IMPS/2 probes. 647 * We need to reset the touchpad because if there is a track point on the 648 * pass through port it could get disabled while probing for protocol 649 * extensions. 650 */ 651 psmouse_reset(psmouse); 652 } 653 654 return PSMOUSE_PS2; 655} 656 657static const struct psmouse_protocol psmouse_protocols[] = { 658 { 659 .type = PSMOUSE_PS2, 660 .name = "PS/2", 661 .alias = "bare", 662 .maxproto = 1, 663 .detect = ps2bare_detect, 664 }, 665 { 666 .type = PSMOUSE_PS2PP, 667 .name = "PS2++", 668 .alias = "logitech", 669 .detect = ps2pp_init, 670 }, 671 { 672 .type = PSMOUSE_THINKPS, 673 .name = "ThinkPS/2", 674 .alias = "thinkps", 675 .detect = thinking_detect, 676 }, 677 { 678 .type = PSMOUSE_GENPS, 679 .name = "GenPS/2", 680 .alias = "genius", 681 .detect = genius_detect, 682 }, 683 { 684 .type = PSMOUSE_IMPS, 685 .name = "ImPS/2", 686 .alias = "imps", 687 .maxproto = 1, 688 .detect = intellimouse_detect, 689 }, 690 { 691 .type = PSMOUSE_IMEX, 692 .name = "ImExPS/2", 693 .alias = "exps", 694 .maxproto = 1, 695 .detect = im_explorer_detect, 696 }, 697 { 698 .type = PSMOUSE_SYNAPTICS, 699 .name = "SynPS/2", 700 .alias = "synaptics", 701 .detect = synaptics_detect, 702 .init = synaptics_init, 703 }, 704 { 705 .type = PSMOUSE_ALPS, 706 .name = "AlpsPS/2", 707 .alias = "alps", 708 .detect = alps_detect, 709 .init = alps_init, 710 }, 711 { 712 .type = PSMOUSE_LIFEBOOK, 713 .name = "LBPS/2", 714 .alias = "lifebook", 715 .init = lifebook_init, 716 }, 717 { 718 .type = PSMOUSE_TRACKPOINT, 719 .name = "TPPS/2", 720 .alias = "trackpoint", 721 .detect = trackpoint_detect, 722 }, 723 { 724 .type = PSMOUSE_AUTO, 725 .name = "auto", 726 .alias = "any", 727 .maxproto = 1, 728 }, 729}; 730 731static const struct psmouse_protocol *psmouse_protocol_by_type(enum psmouse_type type) 732{ 733 int i; 734 735 for (i = 0; i < ARRAY_SIZE(psmouse_protocols); i++) 736 if (psmouse_protocols[i].type == type) 737 return &psmouse_protocols[i]; 738 739 WARN_ON(1); 740 return &psmouse_protocols[0]; 741} 742 743static const struct psmouse_protocol *psmouse_protocol_by_name(const char *name, size_t len) 744{ 745 const struct psmouse_protocol *p; 746 int i; 747 748 for (i = 0; i < ARRAY_SIZE(psmouse_protocols); i++) { 749 p = &psmouse_protocols[i]; 750 751 if ((strlen(p->name) == len && !strncmp(p->name, name, len)) || 752 (strlen(p->alias) == len && !strncmp(p->alias, name, len))) 753 return &psmouse_protocols[i]; 754 } 755 756 return NULL; 757} 758 759 760/* 761 * psmouse_probe() probes for a PS/2 mouse. 762 */ 763 764static int psmouse_probe(struct psmouse *psmouse) 765{ 766 struct ps2dev *ps2dev = &psmouse->ps2dev; 767 unsigned char param[2]; 768 769/* 770 * First, we check if it's a mouse. It should send 0x00 or 0x03 771 * in case of an IntelliMouse in 4-byte mode or 0x04 for IM Explorer. 772 * Sunrex K8561 IR Keyboard/Mouse reports 0xff on second and subsequent 773 * ID queries, probably due to a firmware bug. 774 */ 775 776 param[0] = 0xa5; 777 if (ps2_command(ps2dev, param, PSMOUSE_CMD_GETID)) 778 return -1; 779 780 if (param[0] != 0x00 && param[0] != 0x03 && 781 param[0] != 0x04 && param[0] != 0xff) 782 return -1; 783 784/* 785 * Then we reset and disable the mouse so that it doesn't generate events. 786 */ 787 788 if (ps2_command(ps2dev, NULL, PSMOUSE_CMD_RESET_DIS)) 789 printk(KERN_WARNING "psmouse.c: Failed to reset mouse on %s\n", ps2dev->serio->phys); 790 791 return 0; 792} 793 794/* 795 * Here we set the mouse resolution. 796 */ 797 798void psmouse_set_resolution(struct psmouse *psmouse, unsigned int resolution) 799{ 800 static const unsigned char params[] = { 0, 1, 2, 2, 3 }; 801 unsigned char p; 802 803 if (resolution == 0 || resolution > 200) 804 resolution = 200; 805 806 p = params[resolution / 50]; 807 ps2_command(&psmouse->ps2dev, &p, PSMOUSE_CMD_SETRES); 808 psmouse->resolution = 25 << p; 809} 810 811/* 812 * Here we set the mouse report rate. 813 */ 814 815static void psmouse_set_rate(struct psmouse *psmouse, unsigned int rate) 816{ 817 static const unsigned char rates[] = { 200, 100, 80, 60, 40, 20, 10, 0 }; 818 unsigned char r; 819 int i = 0; 820 821 while (rates[i] > rate) i++; 822 r = rates[i]; 823 ps2_command(&psmouse->ps2dev, &r, PSMOUSE_CMD_SETRATE); 824 psmouse->rate = r; 825} 826 827/* 828 * psmouse_initialize() initializes the mouse to a sane state. 829 */ 830 831static void psmouse_initialize(struct psmouse *psmouse) 832{ 833/* 834 * We set the mouse into streaming mode. 835 */ 836 837 ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSTREAM); 838 839/* 840 * We set the mouse report rate, resolution and scaling. 841 */ 842 843 if (psmouse_max_proto != PSMOUSE_PS2) { 844 psmouse->set_rate(psmouse, psmouse->rate); 845 psmouse->set_resolution(psmouse, psmouse->resolution); 846 ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11); 847 } 848} 849 850/* 851 * psmouse_activate() enables the mouse so that we get motion reports from it. 852 */ 853 854static void psmouse_activate(struct psmouse *psmouse) 855{ 856 if (ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_ENABLE)) 857 printk(KERN_WARNING "psmouse.c: Failed to enable mouse on %s\n", 858 psmouse->ps2dev.serio->phys); 859 860 psmouse_set_state(psmouse, PSMOUSE_ACTIVATED); 861} 862 863 864/* 865 * psmouse_deactivate() puts the mouse into poll mode so that we don't get motion 866 * reports from it unless we explicitely request it. 867 */ 868 869static void psmouse_deactivate(struct psmouse *psmouse) 870{ 871 if (ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_DISABLE)) 872 printk(KERN_WARNING "psmouse.c: Failed to deactivate mouse on %s\n", 873 psmouse->ps2dev.serio->phys); 874 875 psmouse_set_state(psmouse, PSMOUSE_CMD_MODE); 876} 877 878/* 879 * psmouse_poll() - default poll hanlder. Everyone except for ALPS uses it. 880 */ 881 882static int psmouse_poll(struct psmouse *psmouse) 883{ 884 return ps2_command(&psmouse->ps2dev, psmouse->packet, 885 PSMOUSE_CMD_POLL | (psmouse->pktsize << 8)); 886} 887 888 889/* 890 * psmouse_resync() attempts to re-validate current protocol. 891 */ 892 893static void psmouse_resync(void *p) 894{ 895 struct psmouse *psmouse = p, *parent = NULL; 896 struct serio *serio = psmouse->ps2dev.serio; 897 psmouse_ret_t rc = PSMOUSE_GOOD_DATA; 898 int failed = 0, enabled = 0; 899 int i; 900 901 mutex_lock(&psmouse_mutex); 902 903 if (psmouse->state != PSMOUSE_RESYNCING) 904 goto out; 905 906 if (serio->parent && serio->id.type == SERIO_PS_PSTHRU) { 907 parent = serio_get_drvdata(serio->parent); 908 psmouse_deactivate(parent); 909 } 910 911/* 912 * Some mice don't ACK commands sent while they are in the middle of 913 * transmitting motion packet. To avoid delay we use ps2_sendbyte() 914 * instead of ps2_command() which would wait for 200ms for an ACK 915 * that may never come. 916 * As an additional quirk ALPS touchpads may not only forget to ACK 917 * disable command but will stop reporting taps, so if we see that 918 * mouse at least once ACKs disable we will do full reconnect if ACK 919 * is missing. 920 */ 921 psmouse->num_resyncs++; 922 923 if (ps2_sendbyte(&psmouse->ps2dev, PSMOUSE_CMD_DISABLE, 20)) { 924 if (psmouse->num_resyncs < 3 || psmouse->acks_disable_command) 925 failed = 1; 926 } else 927 psmouse->acks_disable_command = 1; 928 929/* 930 * Poll the mouse. If it was reset the packet will be shorter than 931 * psmouse->pktsize and ps2_command will fail. We do not expect and 932 * do not handle scenario when mouse "upgrades" its protocol while 933 * disconnected since it would require additional delay. If we ever 934 * see a mouse that does it we'll adjust the code. 935 */ 936 if (!failed) { 937 if (psmouse->poll(psmouse)) 938 failed = 1; 939 else { 940 psmouse_set_state(psmouse, PSMOUSE_CMD_MODE); 941 for (i = 0; i < psmouse->pktsize; i++) { 942 psmouse->pktcnt++; 943 rc = psmouse->protocol_handler(psmouse, NULL); 944 if (rc != PSMOUSE_GOOD_DATA) 945 break; 946 } 947 if (rc != PSMOUSE_FULL_PACKET) 948 failed = 1; 949 psmouse_set_state(psmouse, PSMOUSE_RESYNCING); 950 } 951 } 952/* 953 * Now try to enable mouse. We try to do that even if poll failed and also 954 * repeat our attempts 5 times, otherwise we may be left out with disabled 955 * mouse. 956 */ 957 for (i = 0; i < 5; i++) { 958 if (!ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_ENABLE)) { 959 enabled = 1; 960 break; 961 } 962 msleep(200); 963 } 964 965 if (!enabled) { 966 printk(KERN_WARNING "psmouse.c: failed to re-enable mouse on %s\n", 967 psmouse->ps2dev.serio->phys); 968 failed = 1; 969 } 970 971 if (failed) { 972 psmouse_set_state(psmouse, PSMOUSE_IGNORE); 973 printk(KERN_INFO "psmouse.c: resync failed, issuing reconnect request\n"); 974 serio_reconnect(serio); 975 } else 976 psmouse_set_state(psmouse, PSMOUSE_ACTIVATED); 977 978 if (parent) 979 psmouse_activate(parent); 980 out: 981 mutex_unlock(&psmouse_mutex); 982} 983 984/* 985 * psmouse_cleanup() resets the mouse into power-on state. 986 */ 987 988static void psmouse_cleanup(struct serio *serio) 989{ 990 struct psmouse *psmouse = serio_get_drvdata(serio); 991 992 psmouse_reset(psmouse); 993} 994 995/* 996 * psmouse_disconnect() closes and frees. 997 */ 998 999static void psmouse_disconnect(struct serio *serio) 1000{ 1001 struct psmouse *psmouse, *parent = NULL; 1002 1003 psmouse = serio_get_drvdata(serio); 1004 1005 sysfs_remove_group(&serio->dev.kobj, &psmouse_attribute_group); 1006 1007 mutex_lock(&psmouse_mutex); 1008 1009 psmouse_set_state(psmouse, PSMOUSE_CMD_MODE); 1010 1011 /* make sure we don't have a resync in progress */ 1012 mutex_unlock(&psmouse_mutex); 1013 flush_workqueue(kpsmoused_wq); 1014 mutex_lock(&psmouse_mutex); 1015 1016 if (serio->parent && serio->id.type == SERIO_PS_PSTHRU) { 1017 parent = serio_get_drvdata(serio->parent); 1018 psmouse_deactivate(parent); 1019 } 1020 1021 if (psmouse->disconnect) 1022 psmouse->disconnect(psmouse); 1023 1024 if (parent && parent->pt_deactivate) 1025 parent->pt_deactivate(parent); 1026 1027 psmouse_set_state(psmouse, PSMOUSE_IGNORE); 1028 1029 serio_close(serio); 1030 serio_set_drvdata(serio, NULL); 1031 input_unregister_device(psmouse->dev); 1032 kfree(psmouse); 1033 1034 if (parent) 1035 psmouse_activate(parent); 1036 1037 mutex_unlock(&psmouse_mutex); 1038} 1039 1040static int psmouse_switch_protocol(struct psmouse *psmouse, const struct psmouse_protocol *proto) 1041{ 1042 struct input_dev *input_dev = psmouse->dev; 1043 1044 input_dev->private = psmouse; 1045 input_dev->cdev.dev = &psmouse->ps2dev.serio->dev; 1046 1047 input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL); 1048 input_dev->keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); 1049 input_dev->relbit[0] = BIT(REL_X) | BIT(REL_Y); 1050 1051 psmouse->set_rate = psmouse_set_rate; 1052 psmouse->set_resolution = psmouse_set_resolution; 1053 psmouse->poll = psmouse_poll; 1054 psmouse->protocol_handler = psmouse_process_byte; 1055 psmouse->pktsize = 3; 1056 1057 if (proto && (proto->detect || proto->init)) { 1058 if (proto->detect && proto->detect(psmouse, 1) < 0) 1059 return -1; 1060 1061 if (proto->init && proto->init(psmouse) < 0) 1062 return -1; 1063 1064 psmouse->type = proto->type; 1065 } 1066 else 1067 psmouse->type = psmouse_extensions(psmouse, psmouse_max_proto, 1); 1068 1069 /* 1070 * If mouse's packet size is 3 there is no point in polling the 1071 * device in hopes to detect protocol reset - we won't get less 1072 * than 3 bytes response anyhow. 1073 */ 1074 if (psmouse->pktsize == 3) 1075 psmouse->resync_time = 0; 1076 1077 /* 1078 * Some smart KVMs fake response to POLL command returning just 1079 * 3 bytes and messing up our resync logic, so if initial poll 1080 * fails we won't try polling the device anymore. Hopefully 1081 * such KVM will maintain initially selected protocol. 1082 */ 1083 if (psmouse->resync_time && psmouse->poll(psmouse)) 1084 psmouse->resync_time = 0; 1085 1086 snprintf(psmouse->devname, sizeof(psmouse->devname), "%s %s %s", 1087 psmouse_protocol_by_type(psmouse->type)->name, psmouse->vendor, psmouse->name); 1088 1089 input_dev->name = psmouse->devname; 1090 input_dev->phys = psmouse->phys; 1091 input_dev->id.bustype = BUS_I8042; 1092 input_dev->id.vendor = 0x0002; 1093 input_dev->id.product = psmouse->type; 1094 input_dev->id.version = psmouse->model; 1095 1096 return 0; 1097} 1098 1099/* 1100 * psmouse_connect() is a callback from the serio module when 1101 * an unhandled serio port is found. 1102 */ 1103static int psmouse_connect(struct serio *serio, struct serio_driver *drv) 1104{ 1105 struct psmouse *psmouse, *parent = NULL; 1106 struct input_dev *input_dev; 1107 int retval = -ENOMEM; 1108 1109 mutex_lock(&psmouse_mutex); 1110 1111 /* 1112 * If this is a pass-through port deactivate parent so the device 1113 * connected to this port can be successfully identified 1114 */ 1115 if (serio->parent && serio->id.type == SERIO_PS_PSTHRU) { 1116 parent = serio_get_drvdata(serio->parent); 1117 psmouse_deactivate(parent); 1118 } 1119 1120 psmouse = kzalloc(sizeof(struct psmouse), GFP_KERNEL); 1121 input_dev = input_allocate_device(); 1122 if (!psmouse || !input_dev) 1123 goto out; 1124 1125 ps2_init(&psmouse->ps2dev, serio); 1126 INIT_WORK(&psmouse->resync_work, psmouse_resync, psmouse); 1127 psmouse->dev = input_dev; 1128 snprintf(psmouse->phys, sizeof(psmouse->phys), "%s/input0", serio->phys); 1129 1130 psmouse_set_state(psmouse, PSMOUSE_INITIALIZING); 1131 1132 serio_set_drvdata(serio, psmouse); 1133 1134 retval = serio_open(serio, drv); 1135 if (retval) 1136 goto out; 1137 1138 if (psmouse_probe(psmouse) < 0) { 1139 serio_close(serio); 1140 retval = -ENODEV; 1141 goto out; 1142 } 1143 1144 psmouse->rate = psmouse_rate; 1145 psmouse->resolution = psmouse_resolution; 1146 psmouse->resetafter = psmouse_resetafter; 1147 psmouse->resync_time = parent ? 0 : psmouse_resync_time; 1148 psmouse->smartscroll = psmouse_smartscroll; 1149 1150 psmouse_switch_protocol(psmouse, NULL); 1151 1152 psmouse_set_state(psmouse, PSMOUSE_CMD_MODE); 1153 psmouse_initialize(psmouse); 1154 1155 input_register_device(psmouse->dev); 1156 1157 if (parent && parent->pt_activate) 1158 parent->pt_activate(parent); 1159 1160 sysfs_create_group(&serio->dev.kobj, &psmouse_attribute_group); 1161 1162 psmouse_activate(psmouse); 1163 1164 retval = 0; 1165 1166out: 1167 if (retval) { 1168 serio_set_drvdata(serio, NULL); 1169 input_free_device(input_dev); 1170 kfree(psmouse); 1171 } 1172 1173 /* If this is a pass-through port the parent needs to be re-activated */ 1174 if (parent) 1175 psmouse_activate(parent); 1176 1177 mutex_unlock(&psmouse_mutex); 1178 return retval; 1179} 1180 1181 1182static int psmouse_reconnect(struct serio *serio) 1183{ 1184 struct psmouse *psmouse = serio_get_drvdata(serio); 1185 struct psmouse *parent = NULL; 1186 struct serio_driver *drv = serio->drv; 1187 int rc = -1; 1188 1189 if (!drv || !psmouse) { 1190 printk(KERN_DEBUG "psmouse: reconnect request, but serio is disconnected, ignoring...\n"); 1191 return -1; 1192 } 1193 1194 mutex_lock(&psmouse_mutex); 1195 1196 if (serio->parent && serio->id.type == SERIO_PS_PSTHRU) { 1197 parent = serio_get_drvdata(serio->parent); 1198 psmouse_deactivate(parent); 1199 } 1200 1201 psmouse_set_state(psmouse, PSMOUSE_INITIALIZING); 1202 1203 if (psmouse->reconnect) { 1204 if (psmouse->reconnect(psmouse)) 1205 goto out; 1206 } else if (psmouse_probe(psmouse) < 0 || 1207 psmouse->type != psmouse_extensions(psmouse, psmouse_max_proto, 0)) 1208 goto out; 1209 1210 /* ok, the device type (and capabilities) match the old one, 1211 * we can continue using it, complete intialization 1212 */ 1213 psmouse_set_state(psmouse, PSMOUSE_CMD_MODE); 1214 1215 psmouse_initialize(psmouse); 1216 1217 if (parent && parent->pt_activate) 1218 parent->pt_activate(parent); 1219 1220 psmouse_activate(psmouse); 1221 rc = 0; 1222 1223out: 1224 /* If this is a pass-through port the parent waits to be activated */ 1225 if (parent) 1226 psmouse_activate(parent); 1227 1228 mutex_unlock(&psmouse_mutex); 1229 return rc; 1230} 1231 1232static struct serio_device_id psmouse_serio_ids[] = { 1233 { 1234 .type = SERIO_8042, 1235 .proto = SERIO_ANY, 1236 .id = SERIO_ANY, 1237 .extra = SERIO_ANY, 1238 }, 1239 { 1240 .type = SERIO_PS_PSTHRU, 1241 .proto = SERIO_ANY, 1242 .id = SERIO_ANY, 1243 .extra = SERIO_ANY, 1244 }, 1245 { 0 } 1246}; 1247 1248MODULE_DEVICE_TABLE(serio, psmouse_serio_ids); 1249 1250static struct serio_driver psmouse_drv = { 1251 .driver = { 1252 .name = "psmouse", 1253 }, 1254 .description = DRIVER_DESC, 1255 .id_table = psmouse_serio_ids, 1256 .interrupt = psmouse_interrupt, 1257 .connect = psmouse_connect, 1258 .reconnect = psmouse_reconnect, 1259 .disconnect = psmouse_disconnect, 1260 .cleanup = psmouse_cleanup, 1261}; 1262 1263ssize_t psmouse_attr_show_helper(struct device *dev, struct device_attribute *devattr, 1264 char *buf) 1265{ 1266 struct serio *serio = to_serio_port(dev); 1267 struct psmouse_attribute *attr = to_psmouse_attr(devattr); 1268 struct psmouse *psmouse; 1269 int retval; 1270 1271 retval = serio_pin_driver(serio); 1272 if (retval) 1273 return retval; 1274 1275 if (serio->drv != &psmouse_drv) { 1276 retval = -ENODEV; 1277 goto out; 1278 } 1279 1280 psmouse = serio_get_drvdata(serio); 1281 1282 retval = attr->show(psmouse, attr->data, buf); 1283 1284out: 1285 serio_unpin_driver(serio); 1286 return retval; 1287} 1288 1289ssize_t psmouse_attr_set_helper(struct device *dev, struct device_attribute *devattr, 1290 const char *buf, size_t count) 1291{ 1292 struct serio *serio = to_serio_port(dev); 1293 struct psmouse_attribute *attr = to_psmouse_attr(devattr); 1294 struct psmouse *psmouse, *parent = NULL; 1295 int retval; 1296 1297 retval = serio_pin_driver(serio); 1298 if (retval) 1299 return retval; 1300 1301 if (serio->drv != &psmouse_drv) { 1302 retval = -ENODEV; 1303 goto out_unpin; 1304 } 1305 1306 retval = mutex_lock_interruptible(&psmouse_mutex); 1307 if (retval) 1308 goto out_unpin; 1309 1310 psmouse = serio_get_drvdata(serio); 1311 1312 if (psmouse->state == PSMOUSE_IGNORE) { 1313 retval = -ENODEV; 1314 goto out_unlock; 1315 } 1316 1317 if (serio->parent && serio->id.type == SERIO_PS_PSTHRU) { 1318 parent = serio_get_drvdata(serio->parent); 1319 psmouse_deactivate(parent); 1320 } 1321 1322 psmouse_deactivate(psmouse); 1323 1324 retval = attr->set(psmouse, attr->data, buf, count); 1325 1326 if (retval != -ENODEV) 1327 psmouse_activate(psmouse); 1328 1329 if (parent) 1330 psmouse_activate(parent); 1331 1332 out_unlock: 1333 mutex_unlock(&psmouse_mutex); 1334 out_unpin: 1335 serio_unpin_driver(serio); 1336 return retval; 1337} 1338 1339static ssize_t psmouse_show_int_attr(struct psmouse *psmouse, void *offset, char *buf) 1340{ 1341 unsigned long *field = (unsigned long *)((char *)psmouse + (size_t)offset); 1342 1343 return sprintf(buf, "%lu\n", *field); 1344} 1345 1346static ssize_t psmouse_set_int_attr(struct psmouse *psmouse, void *offset, const char *buf, size_t count) 1347{ 1348 unsigned long *field = (unsigned long *)((char *)psmouse + (size_t)offset); 1349 unsigned long value; 1350 char *rest; 1351 1352 value = simple_strtoul(buf, &rest, 10); 1353 if (*rest) 1354 return -EINVAL; 1355 1356 *field = value; 1357 1358 return count; 1359} 1360 1361static ssize_t psmouse_attr_show_protocol(struct psmouse *psmouse, void *data, char *buf) 1362{ 1363 return sprintf(buf, "%s\n", psmouse_protocol_by_type(psmouse->type)->name); 1364} 1365 1366static ssize_t psmouse_attr_set_protocol(struct psmouse *psmouse, void *data, const char *buf, size_t count) 1367{ 1368 struct serio *serio = psmouse->ps2dev.serio; 1369 struct psmouse *parent = NULL; 1370 struct input_dev *new_dev; 1371 const struct psmouse_protocol *proto; 1372 int retry = 0; 1373 1374 if (!(proto = psmouse_protocol_by_name(buf, count))) 1375 return -EINVAL; 1376 1377 if (psmouse->type == proto->type) 1378 return count; 1379 1380 if (!(new_dev = input_allocate_device())) 1381 return -ENOMEM; 1382 1383 while (serio->child) { 1384 if (++retry > 3) { 1385 printk(KERN_WARNING "psmouse: failed to destroy child port, protocol change aborted.\n"); 1386 input_free_device(new_dev); 1387 return -EIO; 1388 } 1389 1390 mutex_unlock(&psmouse_mutex); 1391 serio_unpin_driver(serio); 1392 serio_unregister_child_port(serio); 1393 serio_pin_driver_uninterruptible(serio); 1394 mutex_lock(&psmouse_mutex); 1395 1396 if (serio->drv != &psmouse_drv) { 1397 input_free_device(new_dev); 1398 return -ENODEV; 1399 } 1400 1401 if (psmouse->type == proto->type) { 1402 input_free_device(new_dev); 1403 return count; /* switched by other thread */ 1404 } 1405 } 1406 1407 if (serio->parent && serio->id.type == SERIO_PS_PSTHRU) { 1408 parent = serio_get_drvdata(serio->parent); 1409 if (parent->pt_deactivate) 1410 parent->pt_deactivate(parent); 1411 } 1412 1413 if (psmouse->disconnect) 1414 psmouse->disconnect(psmouse); 1415 1416 psmouse_set_state(psmouse, PSMOUSE_IGNORE); 1417 input_unregister_device(psmouse->dev); 1418 1419 psmouse->dev = new_dev; 1420 psmouse_set_state(psmouse, PSMOUSE_INITIALIZING); 1421 1422 if (psmouse_switch_protocol(psmouse, proto) < 0) { 1423 psmouse_reset(psmouse); 1424 /* default to PSMOUSE_PS2 */ 1425 psmouse_switch_protocol(psmouse, &psmouse_protocols[0]); 1426 } 1427 1428 psmouse_initialize(psmouse); 1429 psmouse_set_state(psmouse, PSMOUSE_CMD_MODE); 1430 1431 input_register_device(psmouse->dev); 1432 1433 if (parent && parent->pt_activate) 1434 parent->pt_activate(parent); 1435 1436 return count; 1437} 1438 1439static ssize_t psmouse_attr_set_rate(struct psmouse *psmouse, void *data, const char *buf, size_t count) 1440{ 1441 unsigned long value; 1442 char *rest; 1443 1444 value = simple_strtoul(buf, &rest, 10); 1445 if (*rest) 1446 return -EINVAL; 1447 1448 psmouse->set_rate(psmouse, value); 1449 return count; 1450} 1451 1452static ssize_t psmouse_attr_set_resolution(struct psmouse *psmouse, void *data, const char *buf, size_t count) 1453{ 1454 unsigned long value; 1455 char *rest; 1456 1457 value = simple_strtoul(buf, &rest, 10); 1458 if (*rest) 1459 return -EINVAL; 1460 1461 psmouse->set_resolution(psmouse, value); 1462 return count; 1463} 1464 1465 1466static int psmouse_set_maxproto(const char *val, struct kernel_param *kp) 1467{ 1468 const struct psmouse_protocol *proto; 1469 1470 if (!val) 1471 return -EINVAL; 1472 1473 proto = psmouse_protocol_by_name(val, strlen(val)); 1474 1475 if (!proto || !proto->maxproto) 1476 return -EINVAL; 1477 1478 *((unsigned int *)kp->arg) = proto->type; 1479 1480 return 0; 1481} 1482 1483static int psmouse_get_maxproto(char *buffer, struct kernel_param *kp) 1484{ 1485 int type = *((unsigned int *)kp->arg); 1486 1487 return sprintf(buffer, "%s\n", psmouse_protocol_by_type(type)->name); 1488} 1489 1490static int __init psmouse_init(void) 1491{ 1492 kpsmoused_wq = create_singlethread_workqueue("kpsmoused"); 1493 if (!kpsmoused_wq) { 1494 printk(KERN_ERR "psmouse: failed to create kpsmoused workqueue\n"); 1495 return -ENOMEM; 1496 } 1497 1498 serio_register_driver(&psmouse_drv); 1499 1500 return 0; 1501} 1502 1503static void __exit psmouse_exit(void) 1504{ 1505 serio_unregister_driver(&psmouse_drv); 1506 destroy_workqueue(kpsmoused_wq); 1507} 1508 1509module_init(psmouse_init); 1510module_exit(psmouse_exit);