2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Logitech PS/2++ mouse driver
|
|
|
|
*
|
|
|
|
* Copyright (c) 1999-2003 Vojtech Pavlik <vojtech@suse.cz>
|
|
|
|
* Copyright (c) 2003 Eric Wong <eric@yhbt.net>
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms of the GNU General Public License version 2 as published by
|
|
|
|
* the Free Software Foundation.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/input.h>
|
|
|
|
#include <linux/serio.h>
|
|
|
|
#include <linux/libps2.h>
|
|
|
|
#include "psmouse.h"
|
|
|
|
#include "logips2pp.h"
|
|
|
|
|
|
|
|
/* Logitech mouse types */
|
|
|
|
#define PS2PP_KIND_WHEEL 1
|
|
|
|
#define PS2PP_KIND_MX 2
|
|
|
|
#define PS2PP_KIND_TP3 3
|
2006-05-30 11:29:19 +08:00
|
|
|
#define PS2PP_KIND_TRACKMAN 4
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/* Logitech mouse features */
|
|
|
|
#define PS2PP_WHEEL 0x01
|
|
|
|
#define PS2PP_HWHEEL 0x02
|
|
|
|
#define PS2PP_SIDE_BTN 0x04
|
|
|
|
#define PS2PP_EXTRA_BTN 0x08
|
|
|
|
#define PS2PP_TASK_BTN 0x10
|
|
|
|
#define PS2PP_NAV_BTN 0x20
|
|
|
|
|
|
|
|
struct ps2pp_info {
|
2006-08-09 11:37:18 +08:00
|
|
|
u8 model;
|
|
|
|
u8 kind;
|
|
|
|
u16 features;
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Process a PS2++ or PS2T++ packet.
|
|
|
|
*/
|
|
|
|
|
IRQ: Maintain regs pointer globally rather than passing to IRQ handlers
Maintain a per-CPU global "struct pt_regs *" variable which can be used instead
of passing regs around manually through all ~1800 interrupt handlers in the
Linux kernel.
The regs pointer is used in few places, but it potentially costs both stack
space and code to pass it around. On the FRV arch, removing the regs parameter
from all the genirq function results in a 20% speed up of the IRQ exit path
(ie: from leaving timer_interrupt() to leaving do_IRQ()).
Where appropriate, an arch may override the generic storage facility and do
something different with the variable. On FRV, for instance, the address is
maintained in GR28 at all times inside the kernel as part of general exception
handling.
Having looked over the code, it appears that the parameter may be handed down
through up to twenty or so layers of functions. Consider a USB character
device attached to a USB hub, attached to a USB controller that posts its
interrupts through a cascaded auxiliary interrupt controller. A character
device driver may want to pass regs to the sysrq handler through the input
layer which adds another few layers of parameter passing.
I've build this code with allyesconfig for x86_64 and i386. I've runtested the
main part of the code on FRV and i386, though I can't test most of the drivers.
I've also done partial conversion for powerpc and MIPS - these at least compile
with minimal configurations.
This will affect all archs. Mostly the changes should be relatively easy.
Take do_IRQ(), store the regs pointer at the beginning, saving the old one:
struct pt_regs *old_regs = set_irq_regs(regs);
And put the old one back at the end:
set_irq_regs(old_regs);
Don't pass regs through to generic_handle_irq() or __do_IRQ().
In timer_interrupt(), this sort of change will be necessary:
- update_process_times(user_mode(regs));
- profile_tick(CPU_PROFILING, regs);
+ update_process_times(user_mode(get_irq_regs()));
+ profile_tick(CPU_PROFILING);
I'd like to move update_process_times()'s use of get_irq_regs() into itself,
except that i386, alone of the archs, uses something other than user_mode().
Some notes on the interrupt handling in the drivers:
(*) input_dev() is now gone entirely. The regs pointer is no longer stored in
the input_dev struct.
(*) finish_unlinks() in drivers/usb/host/ohci-q.c needs checking. It does
something different depending on whether it's been supplied with a regs
pointer or not.
(*) Various IRQ handler function pointers have been moved to type
irq_handler_t.
Signed-Off-By: David Howells <dhowells@redhat.com>
(cherry picked from 1b16e7ac850969f38b375e511e3fa2f474a33867 commit)
2006-10-05 21:55:46 +08:00
|
|
|
static psmouse_ret_t ps2pp_process_byte(struct psmouse *psmouse)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2005-09-15 15:01:44 +08:00
|
|
|
struct input_dev *dev = psmouse->dev;
|
2005-04-17 06:20:36 +08:00
|
|
|
unsigned char *packet = psmouse->packet;
|
|
|
|
|
|
|
|
if (psmouse->pktcnt < 3)
|
|
|
|
return PSMOUSE_GOOD_DATA;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Full packet accumulated, process it
|
|
|
|
*/
|
|
|
|
|
|
|
|
if ((packet[0] & 0x48) == 0x48 && (packet[1] & 0x02) == 0x02) {
|
|
|
|
|
|
|
|
/* Logitech extended packet */
|
|
|
|
switch ((packet[1] >> 4) | (packet[0] & 0x30)) {
|
|
|
|
|
|
|
|
case 0x0d: /* Mouse extra info */
|
|
|
|
|
|
|
|
input_report_rel(dev, packet[2] & 0x80 ? REL_HWHEEL : REL_WHEEL,
|
|
|
|
(int) (packet[2] & 8) - (int) (packet[2] & 7));
|
|
|
|
input_report_key(dev, BTN_SIDE, (packet[2] >> 4) & 1);
|
|
|
|
input_report_key(dev, BTN_EXTRA, (packet[2] >> 5) & 1);
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x0e: /* buttons 4, 5, 6, 7, 8, 9, 10 info */
|
|
|
|
|
|
|
|
input_report_key(dev, BTN_SIDE, (packet[2]) & 1);
|
|
|
|
input_report_key(dev, BTN_EXTRA, (packet[2] >> 1) & 1);
|
|
|
|
input_report_key(dev, BTN_BACK, (packet[2] >> 3) & 1);
|
|
|
|
input_report_key(dev, BTN_FORWARD, (packet[2] >> 4) & 1);
|
|
|
|
input_report_key(dev, BTN_TASK, (packet[2] >> 2) & 1);
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x0f: /* TouchPad extra info */
|
|
|
|
|
|
|
|
input_report_rel(dev, packet[2] & 0x08 ? REL_HWHEEL : REL_WHEEL,
|
|
|
|
(int) ((packet[2] >> 4) & 8) - (int) ((packet[2] >> 4) & 7));
|
|
|
|
packet[0] = packet[2] | 0x08;
|
|
|
|
break;
|
|
|
|
|
|
|
|
#ifdef DEBUG
|
|
|
|
default:
|
|
|
|
printk(KERN_WARNING "psmouse.c: Received PS2++ packet #%x, but don't know how to handle.\n",
|
|
|
|
(packet[1] >> 4) | (packet[0] & 0x30));
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
/* Standard PS/2 motion data */
|
|
|
|
input_report_rel(dev, REL_X, packet[1] ? (int) packet[1] - (int) ((packet[0] << 4) & 0x100) : 0);
|
|
|
|
input_report_rel(dev, REL_Y, packet[2] ? (int) ((packet[0] << 3) & 0x100) - (int) packet[2] : 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
input_report_key(dev, BTN_LEFT, packet[0] & 1);
|
|
|
|
input_report_key(dev, BTN_MIDDLE, (packet[0] >> 2) & 1);
|
|
|
|
input_report_key(dev, BTN_RIGHT, (packet[0] >> 1) & 1);
|
|
|
|
|
|
|
|
input_sync(dev);
|
|
|
|
|
|
|
|
return PSMOUSE_FULL_PACKET;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* ps2pp_cmd() sends a PS2++ command, sliced into two bit
|
|
|
|
* pieces through the SETRES command. This is needed to send extended
|
|
|
|
* commands to mice on notebooks that try to understand the PS/2 protocol
|
|
|
|
* Ugly.
|
|
|
|
*/
|
|
|
|
|
|
|
|
static int ps2pp_cmd(struct psmouse *psmouse, unsigned char *param, unsigned char command)
|
|
|
|
{
|
|
|
|
if (psmouse_sliced_command(psmouse, command))
|
|
|
|
return -1;
|
|
|
|
|
2006-01-14 13:27:37 +08:00
|
|
|
if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_POLL | 0x0300))
|
2005-04-17 06:20:36 +08:00
|
|
|
return -1;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* SmartScroll / CruiseControl for some newer Logitech mice Defaults to
|
|
|
|
* enabled if we do nothing to it. Of course I put this in because I want it
|
|
|
|
* disabled :P
|
|
|
|
* 1 - enabled (if previously disabled, also default)
|
|
|
|
* 0 - disabled
|
|
|
|
*/
|
|
|
|
|
2009-09-10 10:13:20 +08:00
|
|
|
static void ps2pp_set_smartscroll(struct psmouse *psmouse, bool smartscroll)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct ps2dev *ps2dev = &psmouse->ps2dev;
|
|
|
|
unsigned char param[4];
|
|
|
|
|
|
|
|
ps2pp_cmd(psmouse, param, 0x32);
|
|
|
|
|
|
|
|
param[0] = 0;
|
|
|
|
ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
|
|
|
|
ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
|
|
|
|
ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
|
|
|
|
|
|
|
|
param[0] = smartscroll;
|
|
|
|
ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
|
|
|
|
}
|
|
|
|
|
2009-09-10 10:13:20 +08:00
|
|
|
static ssize_t ps2pp_attr_show_smartscroll(struct psmouse *psmouse,
|
|
|
|
void *data, char *buf)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2009-09-10 10:13:20 +08:00
|
|
|
return sprintf(buf, "%d\n", psmouse->smartscroll);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2009-09-10 10:13:20 +08:00
|
|
|
static ssize_t ps2pp_attr_set_smartscroll(struct psmouse *psmouse, void *data,
|
|
|
|
const char *buf, size_t count)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
unsigned long value;
|
|
|
|
|
2008-08-10 12:29:25 +08:00
|
|
|
if (strict_strtoul(buf, 10, &value) || value > 1)
|
2005-04-17 06:20:36 +08:00
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
ps2pp_set_smartscroll(psmouse, value);
|
|
|
|
psmouse->smartscroll = value;
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2005-09-04 14:40:20 +08:00
|
|
|
PSMOUSE_DEFINE_ATTR(smartscroll, S_IWUSR | S_IRUGO, NULL,
|
|
|
|
ps2pp_attr_show_smartscroll, ps2pp_attr_set_smartscroll);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Support 800 dpi resolution _only_ if the user wants it (there are good
|
|
|
|
* reasons to not use it even if the mouse supports it, and of course there are
|
|
|
|
* also good reasons to use it, let the user decide).
|
|
|
|
*/
|
|
|
|
|
|
|
|
static void ps2pp_set_resolution(struct psmouse *psmouse, unsigned int resolution)
|
|
|
|
{
|
|
|
|
if (resolution > 400) {
|
|
|
|
struct ps2dev *ps2dev = &psmouse->ps2dev;
|
|
|
|
unsigned char param = 3;
|
|
|
|
|
|
|
|
ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
|
|
|
|
ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
|
|
|
|
ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
|
|
|
|
ps2_command(ps2dev, ¶m, PSMOUSE_CMD_SETRES);
|
|
|
|
psmouse->resolution = 800;
|
|
|
|
} else
|
|
|
|
psmouse_set_resolution(psmouse, resolution);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ps2pp_disconnect(struct psmouse *psmouse)
|
|
|
|
{
|
2005-09-04 14:40:20 +08:00
|
|
|
device_remove_file(&psmouse->ps2dev.serio->dev, &psmouse_attr_smartscroll.dattr);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2006-08-09 11:37:18 +08:00
|
|
|
static const struct ps2pp_info *get_model_info(unsigned char model)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2006-08-09 11:37:18 +08:00
|
|
|
static const struct ps2pp_info ps2pp_list[] = {
|
2007-04-12 13:33:19 +08:00
|
|
|
{ 1, 0, 0 }, /* Simple 2-button mouse */
|
2005-04-17 06:20:36 +08:00
|
|
|
{ 12, 0, PS2PP_SIDE_BTN},
|
|
|
|
{ 13, 0, 0 },
|
|
|
|
{ 15, PS2PP_KIND_MX, /* MX1000 */
|
|
|
|
PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
|
|
|
|
PS2PP_EXTRA_BTN | PS2PP_NAV_BTN | PS2PP_HWHEEL },
|
|
|
|
{ 40, 0, PS2PP_SIDE_BTN },
|
|
|
|
{ 41, 0, PS2PP_SIDE_BTN },
|
|
|
|
{ 42, 0, PS2PP_SIDE_BTN },
|
|
|
|
{ 43, 0, PS2PP_SIDE_BTN },
|
|
|
|
{ 50, 0, 0 },
|
|
|
|
{ 51, 0, 0 },
|
|
|
|
{ 52, PS2PP_KIND_WHEEL, PS2PP_SIDE_BTN | PS2PP_WHEEL },
|
|
|
|
{ 53, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
2006-08-09 11:37:18 +08:00
|
|
|
{ 56, PS2PP_KIND_WHEEL, PS2PP_SIDE_BTN | PS2PP_WHEEL }, /* Cordless MouseMan Wheel */
|
2005-04-17 06:20:36 +08:00
|
|
|
{ 61, PS2PP_KIND_MX, /* MX700 */
|
|
|
|
PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
|
|
|
|
PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
|
2005-11-03 11:52:45 +08:00
|
|
|
{ 66, PS2PP_KIND_MX, /* MX3100 reciver */
|
|
|
|
PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
|
|
|
|
PS2PP_EXTRA_BTN | PS2PP_NAV_BTN | PS2PP_HWHEEL },
|
2007-05-09 11:34:18 +08:00
|
|
|
{ 72, PS2PP_KIND_TRACKMAN, 0 }, /* T-CH11: TrackMan Marble */
|
2005-04-17 06:20:36 +08:00
|
|
|
{ 73, 0, PS2PP_SIDE_BTN },
|
|
|
|
{ 75, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
|
|
|
{ 76, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
2006-05-30 11:29:19 +08:00
|
|
|
{ 79, PS2PP_KIND_TRACKMAN, PS2PP_WHEEL }, /* TrackMan with wheel */
|
2005-04-17 06:20:36 +08:00
|
|
|
{ 80, PS2PP_KIND_WHEEL, PS2PP_SIDE_BTN | PS2PP_WHEEL },
|
|
|
|
{ 81, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
|
|
|
{ 83, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
2005-12-12 01:41:22 +08:00
|
|
|
{ 85, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
2005-09-04 14:40:55 +08:00
|
|
|
{ 86, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
2005-12-21 14:02:54 +08:00
|
|
|
{ 87, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
2005-04-17 06:20:36 +08:00
|
|
|
{ 88, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
|
|
|
{ 96, 0, 0 },
|
|
|
|
{ 97, PS2PP_KIND_TP3, PS2PP_WHEEL | PS2PP_HWHEEL },
|
2006-02-15 13:48:58 +08:00
|
|
|
{ 99, PS2PP_KIND_WHEEL, PS2PP_WHEEL },
|
2005-04-17 06:20:36 +08:00
|
|
|
{ 100, PS2PP_KIND_MX, /* MX510 */
|
|
|
|
PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
|
|
|
|
PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
|
2006-08-05 10:52:13 +08:00
|
|
|
{ 111, PS2PP_KIND_MX, PS2PP_WHEEL | PS2PP_SIDE_BTN }, /* MX300 reports task button as side */
|
2005-04-17 06:20:36 +08:00
|
|
|
{ 112, PS2PP_KIND_MX, /* MX500 */
|
|
|
|
PS2PP_WHEEL | PS2PP_SIDE_BTN | PS2PP_TASK_BTN |
|
|
|
|
PS2PP_EXTRA_BTN | PS2PP_NAV_BTN },
|
|
|
|
{ 114, PS2PP_KIND_MX, /* MX310 */
|
|
|
|
PS2PP_WHEEL | PS2PP_SIDE_BTN |
|
2006-08-09 11:37:18 +08:00
|
|
|
PS2PP_TASK_BTN | PS2PP_EXTRA_BTN }
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
int i;
|
|
|
|
|
2006-08-09 11:37:18 +08:00
|
|
|
for (i = 0; i < ARRAY_SIZE(ps2pp_list); i++)
|
2005-04-17 06:20:36 +08:00
|
|
|
if (model == ps2pp_list[i].model)
|
|
|
|
return &ps2pp_list[i];
|
|
|
|
|
|
|
|
printk(KERN_WARNING "logips2pp: Detected unknown logitech mouse model %d\n", model);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Set up input device's properties based on the detected mouse model.
|
|
|
|
*/
|
|
|
|
|
2006-08-09 11:37:18 +08:00
|
|
|
static void ps2pp_set_model_properties(struct psmouse *psmouse,
|
|
|
|
const struct ps2pp_info *model_info,
|
2009-09-10 10:13:20 +08:00
|
|
|
bool using_ps2pp)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2005-09-15 15:01:44 +08:00
|
|
|
struct input_dev *input_dev = psmouse->dev;
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
if (model_info->features & PS2PP_SIDE_BTN)
|
2009-09-10 10:13:20 +08:00
|
|
|
__set_bit(BTN_SIDE, input_dev->keybit);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (model_info->features & PS2PP_EXTRA_BTN)
|
2009-09-10 10:13:20 +08:00
|
|
|
__set_bit(BTN_EXTRA, input_dev->keybit);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (model_info->features & PS2PP_TASK_BTN)
|
2009-09-10 10:13:20 +08:00
|
|
|
__set_bit(BTN_TASK, input_dev->keybit);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (model_info->features & PS2PP_NAV_BTN) {
|
2009-09-10 10:13:20 +08:00
|
|
|
__set_bit(BTN_FORWARD, input_dev->keybit);
|
|
|
|
__set_bit(BTN_BACK, input_dev->keybit);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (model_info->features & PS2PP_WHEEL)
|
2009-09-10 10:13:20 +08:00
|
|
|
__set_bit(REL_WHEEL, input_dev->relbit);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (model_info->features & PS2PP_HWHEEL)
|
2009-09-10 10:13:20 +08:00
|
|
|
__set_bit(REL_HWHEEL, input_dev->relbit);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
switch (model_info->kind) {
|
|
|
|
case PS2PP_KIND_WHEEL:
|
|
|
|
psmouse->name = "Wheel Mouse";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case PS2PP_KIND_MX:
|
|
|
|
psmouse->name = "MX Mouse";
|
|
|
|
break;
|
|
|
|
|
|
|
|
case PS2PP_KIND_TP3:
|
|
|
|
psmouse->name = "TouchPad 3";
|
|
|
|
break;
|
|
|
|
|
2006-05-30 11:29:19 +08:00
|
|
|
case PS2PP_KIND_TRACKMAN:
|
|
|
|
psmouse->name = "TrackMan";
|
|
|
|
break;
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
default:
|
|
|
|
/*
|
|
|
|
* Set name to "Mouse" only when using PS2++,
|
|
|
|
* otherwise let other protocols define suitable
|
|
|
|
* name
|
|
|
|
*/
|
|
|
|
if (using_ps2pp)
|
|
|
|
psmouse->name = "Mouse";
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Logitech magic init. Detect whether the mouse is a Logitech one
|
|
|
|
* and its exact model and try turning on extended protocol for ones
|
|
|
|
* that support it.
|
|
|
|
*/
|
|
|
|
|
2009-09-10 10:13:20 +08:00
|
|
|
int ps2pp_init(struct psmouse *psmouse, bool set_properties)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct ps2dev *ps2dev = &psmouse->ps2dev;
|
|
|
|
unsigned char param[4];
|
|
|
|
unsigned char model, buttons;
|
2006-08-09 11:37:18 +08:00
|
|
|
const struct ps2pp_info *model_info;
|
2009-09-10 10:13:20 +08:00
|
|
|
bool use_ps2pp = false;
|
2006-11-03 12:59:40 +08:00
|
|
|
int error;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
param[0] = 0;
|
|
|
|
ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
|
|
|
|
ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
|
|
|
|
ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
|
|
|
|
ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11);
|
|
|
|
param[1] = 0;
|
|
|
|
ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO);
|
|
|
|
|
|
|
|
model = ((param[0] >> 4) & 0x07) | ((param[0] << 3) & 0x78);
|
|
|
|
buttons = param[1];
|
|
|
|
|
2007-04-12 13:32:22 +08:00
|
|
|
if (!model || !buttons)
|
|
|
|
return -1;
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((model_info = get_model_info(model)) != NULL) {
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Do Logitech PS2++ / PS2T++ magic init.
|
|
|
|
*/
|
2006-08-09 11:37:18 +08:00
|
|
|
if (model_info->kind == PS2PP_KIND_TP3) { /* Touch Pad 3 */
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/* Unprotect RAM */
|
|
|
|
param[0] = 0x11; param[1] = 0x04; param[2] = 0x68;
|
|
|
|
ps2_command(ps2dev, param, 0x30d1);
|
|
|
|
/* Enable features */
|
|
|
|
param[0] = 0x11; param[1] = 0x05; param[2] = 0x0b;
|
|
|
|
ps2_command(ps2dev, param, 0x30d1);
|
|
|
|
/* Enable PS2++ */
|
|
|
|
param[0] = 0x11; param[1] = 0x09; param[2] = 0xc3;
|
|
|
|
ps2_command(ps2dev, param, 0x30d1);
|
|
|
|
|
|
|
|
param[0] = 0;
|
|
|
|
if (!ps2_command(ps2dev, param, 0x13d1) &&
|
|
|
|
param[0] == 0x06 && param[1] == 0x00 && param[2] == 0x14) {
|
2009-09-10 10:13:20 +08:00
|
|
|
use_ps2pp = true;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
} else {
|
|
|
|
|
|
|
|
param[0] = param[1] = param[2] = 0;
|
|
|
|
ps2pp_cmd(psmouse, param, 0x39); /* Magic knock */
|
|
|
|
ps2pp_cmd(psmouse, param, 0xDB);
|
|
|
|
|
|
|
|
if ((param[0] & 0x78) == 0x48 &&
|
|
|
|
(param[1] & 0xf3) == 0xc2 &&
|
|
|
|
(param[2] & 0x03) == ((param[1] >> 2) & 3)) {
|
2009-09-10 10:13:20 +08:00
|
|
|
ps2pp_set_smartscroll(psmouse, false);
|
|
|
|
use_ps2pp = true;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (set_properties) {
|
|
|
|
psmouse->vendor = "Logitech";
|
|
|
|
psmouse->model = model;
|
|
|
|
|
|
|
|
if (use_ps2pp) {
|
|
|
|
psmouse->protocol_handler = ps2pp_process_byte;
|
|
|
|
psmouse->pktsize = 3;
|
|
|
|
|
|
|
|
if (model_info->kind != PS2PP_KIND_TP3) {
|
|
|
|
psmouse->set_resolution = ps2pp_set_resolution;
|
|
|
|
psmouse->disconnect = ps2pp_disconnect;
|
|
|
|
|
2006-11-03 12:59:40 +08:00
|
|
|
error = device_create_file(&psmouse->ps2dev.serio->dev,
|
|
|
|
&psmouse_attr_smartscroll.dattr);
|
|
|
|
if (error) {
|
|
|
|
printk(KERN_ERR
|
|
|
|
"logips2pp.c: failed to create smartscroll "
|
|
|
|
"sysfs attribute, error: %d\n", error);
|
|
|
|
return -1;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (buttons < 3)
|
2009-09-10 10:13:20 +08:00
|
|
|
__clear_bit(BTN_MIDDLE, psmouse->dev->keybit);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (model_info)
|
|
|
|
ps2pp_set_model_properties(psmouse, model_info, use_ps2pp);
|
|
|
|
}
|
|
|
|
|
|
|
|
return use_ps2pp ? 0 : -1;
|
|
|
|
}
|
|
|
|
|