synaptics: more support for semi-MT trackpads.
Several improvements to the Synaptics driver to support semi-multitouch trackpads and some other fixes: - Two finger scrolling support for "semi-MT" touchpads. Those include many of the older Synaptics touchpads before "true" multitouch support (indicated by capMultiFinger). Semi-MT touchpads can report a second finger position, but the X or Y coordinate may be swapped with some coordinate of the first finger. This is a result of how the hardware works internally. Therefore, all that can be reliably extracted is the bounding box of the two finger positions. Semi-MT touchpads can be recognized by the capAdvancedGestures capability bit. After setting the mode byte, advanced gestures mode has to be enabled. Then, data packets compatible with the capMultiFinger format are sent, so the same two finger scrolling code can be leveraged. Enabling advanced gestures mode on true multitouch touchpads should be harmless. Linux seems to always enable advanced gestures mode. - Put mode setting logic into own functions synaptics_preferred_mode() and synaptics_set_mode() to have this in one place. synaptics_passthrough_on() and synaptics_passthrough_off() currently always use 0xc1 as the mode byte, which may be wrong for touchpads that don't have capExtended. - Expose X and Y resolution of touchpad to userland. Also expose minimum and maximum X and Y coordinates. This is useful for programs in userspace that read raw PSM packets (with PSM_LEVEL_NATIVE enabled) and need to interpret the coordinates. - Also send "extended w mode" packets (see section 3.2.9 of 511-000275-01_RevB.pdf) to userspace if PSM_LEVEL_NATIVE is enabled. This is useful for userspace programs/drivers such as xf86-input-synaptics that can handle these packets. - Fix parsing of nExtendedQueries, and request extended/continued capability bits depending on this value. - capReportsMax, capClearPad, capAdvancedGestures and capCoveredPad must be extracted from status[0] and not status[2], I think. Submitted by: Jan Kokemüller jan.kokemueller at gmail.com
This commit is contained in:
parent
31825f28cf
commit
017d485987
Notes:
svn2git
2020-12-20 02:59:44 +00:00
svn path=/head/; revision=282734
@ -483,6 +483,8 @@ static probefunc_t enable_versapad;
|
||||
static void set_trackpoint_parameters(struct psm_softc *sc);
|
||||
static void synaptics_passthrough_on(struct psm_softc *sc);
|
||||
static void synaptics_passthrough_off(struct psm_softc *sc);
|
||||
static int synaptics_preferred_mode(struct psm_softc *sc);
|
||||
static void synaptics_set_mode(struct psm_softc *sc, int mode_byte);
|
||||
|
||||
static struct {
|
||||
int model;
|
||||
@ -933,14 +935,8 @@ doopen(struct psm_softc *sc, int command_byte)
|
||||
get_mouse_status(sc->kbdc, stat, 0, 3);
|
||||
if ((SYNAPTICS_VERSION_GE(sc->synhw, 7, 5) ||
|
||||
stat[1] == 0x47) &&
|
||||
stat[2] == 0x40) {
|
||||
/* Set the mode byte -- request wmode where
|
||||
* available */
|
||||
if (sc->synhw.capExtended)
|
||||
mouse_ext_command(sc->kbdc, 0xc1);
|
||||
else
|
||||
mouse_ext_command(sc->kbdc, 0xc0);
|
||||
set_mouse_sampling_rate(sc->kbdc, 20);
|
||||
stat[2] == 0x40) {
|
||||
synaptics_set_mode(sc, synaptics_preferred_mode(sc));
|
||||
VLOG(5, (LOG_DEBUG, "psm%d: Synaptis Absolute Mode "
|
||||
"hopefully restored\n",
|
||||
sc->unit));
|
||||
@ -2176,6 +2172,20 @@ psmioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag,
|
||||
(*(int *)addr > PSM_LEVEL_MAX))
|
||||
return (EINVAL);
|
||||
sc->mode.level = *(int *)addr;
|
||||
|
||||
if (sc->hw.model == MOUSE_MODEL_SYNAPTICS) {
|
||||
/*
|
||||
* If we are entering PSM_LEVEL_NATIVE, we want to
|
||||
* enable sending of "extended W mode" packets to
|
||||
* userland. Reset the mode of the touchpad so that the
|
||||
* change in the level is picked up.
|
||||
*/
|
||||
error = block_mouse_data(sc, &command_byte);
|
||||
if (error)
|
||||
return (error);
|
||||
synaptics_set_mode(sc, synaptics_preferred_mode(sc));
|
||||
unblock_mouse_data(sc, command_byte);
|
||||
}
|
||||
break;
|
||||
|
||||
case MOUSE_GETSTATUS:
|
||||
@ -2865,7 +2875,8 @@ proc_synaptics(struct psm_softc *sc, packetbuf_t *pb, mousestatus_t *ms,
|
||||
|
||||
/* Palm detection. */
|
||||
if (!(
|
||||
(sc->synhw.capMultiFinger && (w == 0 || w == 1)) ||
|
||||
((sc->synhw.capMultiFinger ||
|
||||
sc->synhw.capAdvancedGestures) && (w == 0 || w == 1)) ||
|
||||
(sc->synhw.capPalmDetect && w >= 4 && w <= max_width) ||
|
||||
(!sc->synhw.capPalmDetect && *z <= max_pressure) ||
|
||||
(sc->synhw.capPen && w == 2))) {
|
||||
@ -4192,7 +4203,8 @@ synaptics_sysctl_create_tree(struct psm_softc *sc)
|
||||
* physical area reserved for scrolling or when
|
||||
* there's no multi finger support.
|
||||
*/
|
||||
if (sc->synhw.verticalScroll || sc->synhw.capMultiFinger == 0)
|
||||
if (sc->synhw.verticalScroll || (sc->synhw.capMultiFinger == 0 &&
|
||||
sc->synhw.capAdvancedGestures == 0))
|
||||
sc->syninfo.two_finger_scroll = 0;
|
||||
else
|
||||
sc->syninfo.two_finger_scroll = 1;
|
||||
@ -4493,6 +4505,43 @@ synaptics_sysctl_create_tree(struct psm_softc *sc)
|
||||
"Turn off touchpad");
|
||||
}
|
||||
|
||||
static int
|
||||
synaptics_preferred_mode(struct psm_softc *sc) {
|
||||
int mode_byte;
|
||||
|
||||
mode_byte = 0xc0;
|
||||
|
||||
/* request wmode where available */
|
||||
if (sc->synhw.capExtended)
|
||||
mode_byte |= 1;
|
||||
|
||||
/*
|
||||
* Disable gesture processing when native packets are requested. This
|
||||
* enables sending of encapsulated "extended W mode" packets.
|
||||
*/
|
||||
if (sc->mode.level == PSM_LEVEL_NATIVE)
|
||||
mode_byte |= (1 << 2);
|
||||
|
||||
return mode_byte;
|
||||
}
|
||||
|
||||
static void
|
||||
synaptics_set_mode(struct psm_softc *sc, int mode_byte) {
|
||||
mouse_ext_command(sc->kbdc, mode_byte);
|
||||
|
||||
/* "Commit" the Set Mode Byte command sent above. */
|
||||
set_mouse_sampling_rate(sc->kbdc, 20);
|
||||
|
||||
/*
|
||||
* Enable advanced gestures mode if supported and we are not entering
|
||||
* passthrough mode.
|
||||
*/
|
||||
if (sc->synhw.capAdvancedGestures && !(mode_byte & (1 << 5))) {
|
||||
mouse_ext_command(sc->kbdc, 3);
|
||||
set_mouse_sampling_rate(sc->kbdc, 0xc8);
|
||||
}
|
||||
}
|
||||
|
||||
static int
|
||||
enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
{
|
||||
@ -4576,7 +4625,7 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
buttons = 0;
|
||||
synhw.capExtended = (status[0] & 0x80) != 0;
|
||||
if (synhw.capExtended) {
|
||||
synhw.nExtendedQueries = (status[0] & 0x70) != 0;
|
||||
synhw.nExtendedQueries = (status[0] & 0x70) >> 4;
|
||||
synhw.capMiddle = (status[0] & 0x04) != 0;
|
||||
synhw.capPassthrough = (status[2] & 0x80) != 0;
|
||||
synhw.capLowPower = (status[2] & 0x40) != 0;
|
||||
@ -4588,6 +4637,16 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
synhw.capMultiFinger = (status[2] & 0x02) != 0;
|
||||
synhw.capPalmDetect = (status[2] & 0x01) != 0;
|
||||
|
||||
if (!set_mouse_scaling(kbdc, 1))
|
||||
return (FALSE);
|
||||
if (mouse_ext_command(kbdc, 0x08) == 0)
|
||||
return (FALSE);
|
||||
if (get_mouse_status(kbdc, status, 0, 3) != 3)
|
||||
return (FALSE);
|
||||
|
||||
synhw.infoXupmm = status[0];
|
||||
synhw.infoYupmm = status[2];
|
||||
|
||||
if (verbose >= 2) {
|
||||
printf(" Extended capabilities:\n");
|
||||
printf(" capExtended: %d\n", synhw.capExtended);
|
||||
@ -4603,6 +4662,8 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
printf(" capBallistics: %d\n", synhw.capBallistics);
|
||||
printf(" capMultiFinger: %d\n", synhw.capMultiFinger);
|
||||
printf(" capPalmDetect: %d\n", synhw.capPalmDetect);
|
||||
printf(" infoXupmm: %d\n", synhw.infoXupmm);
|
||||
printf(" infoYupmm: %d\n", synhw.infoYupmm);
|
||||
}
|
||||
|
||||
/*
|
||||
@ -4610,7 +4671,9 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
* supports this number of extended queries. We can load
|
||||
* more information about buttons using query 0x09.
|
||||
*/
|
||||
if (synhw.capExtended && synhw.nExtendedQueries) {
|
||||
if (synhw.nExtendedQueries >= 1) {
|
||||
if (!set_mouse_scaling(kbdc, 1))
|
||||
return (FALSE);
|
||||
if (mouse_ext_command(kbdc, 0x09) == 0)
|
||||
return (FALSE);
|
||||
if (get_mouse_status(kbdc, status, 0, 3) != 3)
|
||||
@ -4619,6 +4682,7 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
synhw.horizontalScroll = (status[0] & 0x02) != 0;
|
||||
synhw.verticalWheel = (status[0] & 0x08) != 0;
|
||||
synhw.nExtendedButtons = (status[1] & 0xf0) >> 4;
|
||||
synhw.capEWmode = (status[0] & 0x04) != 0;
|
||||
if (verbose >= 2) {
|
||||
printf(" Extended model ID:\n");
|
||||
printf(" verticalScroll: %d\n",
|
||||
@ -4629,6 +4693,8 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
synhw.verticalWheel);
|
||||
printf(" nExtendedButtons: %d\n",
|
||||
synhw.nExtendedButtons);
|
||||
printf(" capEWmode: %d\n",
|
||||
synhw.capEWmode);
|
||||
}
|
||||
/*
|
||||
* Add the number of extended buttons to the total
|
||||
@ -4642,7 +4708,97 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
* add a fourth button to the total button count.
|
||||
*/
|
||||
buttons = synhw.capFourButtons ? 1 : 0;
|
||||
|
||||
/* Read the continued capabilities bits. */
|
||||
if (synhw.nExtendedQueries >= 4) {
|
||||
if (!set_mouse_scaling(kbdc, 1))
|
||||
return (FALSE);
|
||||
if (mouse_ext_command(kbdc, 0x0c) == 0)
|
||||
return (FALSE);
|
||||
if (get_mouse_status(kbdc, status, 0, 3) != 3)
|
||||
return (FALSE);
|
||||
|
||||
synhw.capClickPad = (status[1] & 0x01) << 1;
|
||||
synhw.capClickPad |= (status[0] & 0x10) != 0;
|
||||
synhw.capDeluxeLEDs = (status[1] & 0x02) != 0;
|
||||
synhw.noAbsoluteFilter = (status[1] & 0x04) != 0;
|
||||
synhw.capReportsV = (status[1] & 0x08) != 0;
|
||||
synhw.capUniformClickPad = (status[1] & 0x10) != 0;
|
||||
synhw.capReportsMin = (status[1] & 0x20) != 0;
|
||||
synhw.capInterTouch = (status[1] & 0x40) != 0;
|
||||
synhw.capReportsMax = (status[0] & 0x02) != 0;
|
||||
synhw.capClearPad = (status[0] & 0x04) != 0;
|
||||
synhw.capAdvancedGestures = (status[0] & 0x08) != 0;
|
||||
synhw.capCoveredPad = (status[0] & 0x80) != 0;
|
||||
|
||||
if (synhw.capReportsMax) {
|
||||
if (!set_mouse_scaling(kbdc, 1))
|
||||
return (FALSE);
|
||||
if (mouse_ext_command(kbdc, 0x0d) == 0)
|
||||
return (FALSE);
|
||||
if (get_mouse_status(kbdc, status, 0, 3) != 3)
|
||||
return (FALSE);
|
||||
|
||||
synhw.maximumXCoord = (status[0] << 5) |
|
||||
((status[1] & 0x0f) << 1);
|
||||
synhw.maximumYCoord = (status[2] << 5) |
|
||||
((status[1] & 0xf0) >> 3);
|
||||
}
|
||||
if (synhw.capReportsMin) {
|
||||
if (!set_mouse_scaling(kbdc, 1))
|
||||
return (FALSE);
|
||||
if (mouse_ext_command(kbdc, 0x0f) == 0)
|
||||
return (FALSE);
|
||||
if (get_mouse_status(kbdc, status, 0, 3) != 3)
|
||||
return (FALSE);
|
||||
|
||||
synhw.minimumXCoord = (status[0] << 5) |
|
||||
((status[1] & 0x0f) << 1);
|
||||
synhw.minimumYCoord = (status[2] << 5) |
|
||||
((status[1] & 0xf0) >> 3);
|
||||
}
|
||||
|
||||
if (verbose >= 2) {
|
||||
printf(" Continued capabilities:\n");
|
||||
printf(" capClickPad: %d\n",
|
||||
synhw.capClickPad);
|
||||
printf(" capDeluxeLEDs: %d\n",
|
||||
synhw.capDeluxeLEDs);
|
||||
printf(" noAbsoluteFilter: %d\n",
|
||||
synhw.noAbsoluteFilter);
|
||||
printf(" capReportsV: %d\n",
|
||||
synhw.capReportsV);
|
||||
printf(" capUniformClickPad: %d\n",
|
||||
synhw.capUniformClickPad);
|
||||
printf(" capReportsMin: %d\n",
|
||||
synhw.capReportsMin);
|
||||
printf(" capInterTouch: %d\n",
|
||||
synhw.capInterTouch);
|
||||
printf(" capReportsMax: %d\n",
|
||||
synhw.capReportsMax);
|
||||
printf(" capClearPad: %d\n",
|
||||
synhw.capClearPad);
|
||||
printf(" capAdvancedGestures: %d\n",
|
||||
synhw.capAdvancedGestures);
|
||||
printf(" capCoveredPad: %d\n",
|
||||
synhw.capCoveredPad);
|
||||
if (synhw.capReportsMax) {
|
||||
printf(" maximumXCoord: %d\n",
|
||||
synhw.maximumXCoord);
|
||||
printf(" maximumYCoord: %d\n",
|
||||
synhw.maximumYCoord);
|
||||
}
|
||||
if (synhw.capReportsMin) {
|
||||
printf(" minimumXCoord: %d\n",
|
||||
synhw.minimumXCoord);
|
||||
printf(" minimumYCoord: %d\n",
|
||||
synhw.minimumYCoord);
|
||||
}
|
||||
}
|
||||
buttons += synhw.capClickPad;
|
||||
}
|
||||
}
|
||||
|
||||
if (verbose >= 2) {
|
||||
if (synhw.capExtended)
|
||||
printf(" Additional Buttons: %d\n", buttons);
|
||||
@ -4650,42 +4806,6 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
printf(" No extended capabilities\n");
|
||||
}
|
||||
|
||||
/* Read the continued capabilities bits. */
|
||||
if (mouse_ext_command(kbdc, 0xc) != 0 &&
|
||||
get_mouse_status(kbdc, status, 0, 3) == 3) {
|
||||
synhw.capClickPad = (status[1] & 0x01) << 1;
|
||||
synhw.capClickPad |= (status[0] & 0x10) != 0;
|
||||
synhw.capDeluxeLEDs = (status[1] & 0x02) != 0;
|
||||
synhw.noAbsoluteFilter = (status[1] & 0x04) != 0;
|
||||
synhw.capReportsV = (status[1] & 0x08) != 0;
|
||||
synhw.capUniformClickPad = (status[1] & 0x10) != 0;
|
||||
synhw.capReportsMin = (status[1] & 0x20) != 0;
|
||||
synhw.capInterTouch = (status[1] & 0x40) != 0;
|
||||
synhw.capReportsMax = (status[2] & 0x02) != 0;
|
||||
synhw.capClearPad = (status[2] & 0x04) != 0;
|
||||
synhw.capAdvancedGestures = (status[2] & 0x08) != 0;
|
||||
synhw.capCoveredPad = (status[2] & 0x80) != 0;
|
||||
|
||||
if (verbose >= 2) {
|
||||
printf(" Continued capabilities:\n");
|
||||
printf(" capClickPad: %d\n", synhw.capClickPad);
|
||||
printf(" capDeluxeLEDs: %d\n", synhw.capDeluxeLEDs);
|
||||
printf(" noAbsoluteFilter: %d\n",
|
||||
synhw.noAbsoluteFilter);
|
||||
printf(" capReportsV: %d\n", synhw.capReportsV);
|
||||
printf(" capUniformClickPad: %d\n",
|
||||
synhw.capUniformClickPad);
|
||||
printf(" capReportsMin: %d\n", synhw.capReportsMin);
|
||||
printf(" capInterTouch: %d\n", synhw.capInterTouch);
|
||||
printf(" capReportsMax: %d\n", synhw.capReportsMax);
|
||||
printf(" capClearPad: %d\n", synhw.capClearPad);
|
||||
printf(" capAdvancedGestures: %d\n",
|
||||
synhw.capAdvancedGestures);
|
||||
printf(" capCoveredPad: %d\n", synhw.capCoveredPad);
|
||||
}
|
||||
buttons += synhw.capClickPad;
|
||||
}
|
||||
|
||||
/*
|
||||
* Add the default number of 3 buttons to the total
|
||||
* count of supported buttons reported above.
|
||||
@ -4713,15 +4833,10 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
if (!synaptics_support)
|
||||
return (FALSE);
|
||||
|
||||
/* Set the mode byte; request wmode where available. */
|
||||
mouse_ext_command(kbdc, synhw.capExtended ? 0xc1 : 0xc0);
|
||||
|
||||
/* "Commit" the Set Mode Byte command sent above. */
|
||||
set_mouse_sampling_rate(kbdc, 20);
|
||||
|
||||
VLOG(3, (LOG_DEBUG, "synaptics: END init (%d buttons)\n", buttons));
|
||||
|
||||
if (sc != NULL) {
|
||||
synaptics_set_mode(sc, synaptics_preferred_mode(sc));
|
||||
if (trackpoint_support && synhw.capPassthrough) {
|
||||
synaptics_passthrough_on(sc);
|
||||
enable_trackpoint(kbdc, sc);
|
||||
@ -4738,30 +4853,17 @@ enable_synaptics(KBDC kbdc, struct psm_softc *sc)
|
||||
static void
|
||||
synaptics_passthrough_on(struct psm_softc *sc)
|
||||
{
|
||||
int mode_byte;
|
||||
|
||||
mode_byte = 0xc1 | (1 << 5);
|
||||
VLOG(2, (LOG_NOTICE, "psm: setting pass-through mode. %d\n",
|
||||
mode_byte));
|
||||
mouse_ext_command(sc->kbdc, mode_byte);
|
||||
|
||||
/* "Commit" the Set Mode Byte command sent above. */
|
||||
set_mouse_sampling_rate(sc->kbdc, 20);
|
||||
VLOG(2, (LOG_NOTICE, "psm: setting pass-through mode.\n"));
|
||||
synaptics_set_mode(sc, synaptics_preferred_mode(sc) | (1 << 5));
|
||||
}
|
||||
|
||||
static void
|
||||
synaptics_passthrough_off(struct psm_softc *sc)
|
||||
{
|
||||
int mode_byte;
|
||||
|
||||
mode_byte = 0xc1;
|
||||
VLOG(2, (LOG_NOTICE, "psm: turning pass-through mode off.\n"));
|
||||
set_mouse_scaling(sc->kbdc, 2);
|
||||
set_mouse_scaling(sc->kbdc, 1);
|
||||
mouse_ext_command(sc->kbdc, mode_byte);
|
||||
|
||||
/* "Commit" the Set Mode Byte command sent above. */
|
||||
set_mouse_sampling_rate(sc->kbdc, 20);
|
||||
synaptics_set_mode(sc, synaptics_preferred_mode(sc));
|
||||
}
|
||||
|
||||
/* IBM/Lenovo TrackPoint */
|
||||
|
@ -128,6 +128,13 @@ typedef struct synapticshw {
|
||||
int verticalScroll;
|
||||
int horizontalScroll;
|
||||
int verticalWheel;
|
||||
int capEWmode;
|
||||
int minimumXCoord;
|
||||
int minimumYCoord;
|
||||
int maximumXCoord;
|
||||
int maximumYCoord;
|
||||
int infoXupmm;
|
||||
int infoYupmm;
|
||||
} synapticshw_t;
|
||||
|
||||
/* iftype */
|
||||
|
Loading…
Reference in New Issue
Block a user