diff options
Diffstat (limited to 'sys/dev/pckbc/pms.c')
-rw-r--r-- | sys/dev/pckbc/pms.c | 214 |
1 files changed, 212 insertions, 2 deletions
diff --git a/sys/dev/pckbc/pms.c b/sys/dev/pckbc/pms.c index 4c0e89423e2..0a717082042 100644 --- a/sys/dev/pckbc/pms.c +++ b/sys/dev/pckbc/pms.c @@ -1,4 +1,4 @@ -/* $OpenBSD: pms.c,v 1.42 2013/05/23 18:29:51 tobias Exp $ */ +/* $OpenBSD: pms.c,v 1.43 2013/05/31 19:21:09 jcs Exp $ */ /* $NetBSD: psm.c,v 1.11 2000/06/05 22:20:57 sommerfeld Exp $ */ /*- @@ -60,6 +60,7 @@ struct pms_protocol { #define PMS_ELANTECH_V1 4 #define PMS_ELANTECH_V2 5 #define PMS_ELANTECH_V3 6 +#define PMS_ELANTECH_V4 7 u_int packetsize; int (*enable)(struct pms_softc *); int (*ioctl)(struct pms_softc *, u_long, caddr_t, int, struct proc *); @@ -120,6 +121,12 @@ struct elantech_softc { int min_x, min_y; int max_x, max_y; + struct { + unsigned int x; + unsigned int y; + } mt[ELANTECH_MAX_FINGERS]; + int fingers[ELANTECH_MAX_FINGERS]; + int width; u_char parity[256]; u_char p1, p2, p3; @@ -254,14 +261,17 @@ void pms_proc_alps(struct pms_softc *); int pms_enable_elantech_v1(struct pms_softc *); int pms_enable_elantech_v2(struct pms_softc *); int pms_enable_elantech_v3(struct pms_softc *); +int pms_enable_elantech_v4(struct pms_softc *); int pms_ioctl_elantech(struct pms_softc *, u_long, caddr_t, int, struct proc *); int pms_sync_elantech_v1(struct pms_softc *, int); int pms_sync_elantech_v2(struct pms_softc *, int); int pms_sync_elantech_v3(struct pms_softc *, int); +int pms_sync_elantech_v4(struct pms_softc *, int); void pms_proc_elantech_v1(struct pms_softc *); void pms_proc_elantech_v2(struct pms_softc *); void pms_proc_elantech_v3(struct pms_softc *); +void pms_proc_elantech_v4(struct pms_softc *); int synaptics_set_mode(struct pms_softc *, int); int synaptics_query(struct pms_softc *, int, int *); @@ -276,10 +286,12 @@ void elantech_send_input(struct pms_softc *, int, int, int, int); int elantech_get_hwinfo_v1(struct pms_softc *); int elantech_get_hwinfo_v2(struct pms_softc *); int elantech_get_hwinfo_v3(struct pms_softc *); +int elantech_get_hwinfo_v4(struct pms_softc *); int elantech_ps2_cmd(struct pms_softc *, u_char); int elantech_set_absolute_mode_v1(struct pms_softc *); int elantech_set_absolute_mode_v2(struct pms_softc *); int elantech_set_absolute_mode_v3(struct pms_softc *); +int elantech_set_absolute_mode_v4(struct pms_softc *); struct cfattach pms_ca = { @@ -358,6 +370,15 @@ const struct pms_protocol pms_protocols[] = { pms_proc_elantech_v3, NULL }, + /* Elantech touchpad (hardware version 4) */ + { + PMS_ELANTECH_V4, 6, + pms_enable_elantech_v4, + pms_ioctl_elantech, + pms_sync_elantech_v4, + pms_proc_elantech_v4, + NULL + }, /* Microsoft IntelliMouse */ { PMS_INTELLI, 4, @@ -804,7 +825,8 @@ pmsinput(void *vsc, int data) sc->packet[sc->inputstate] = data; if (sc->protocol->sync(sc, data)) { #ifdef DIAGNOSTIC - printf("%s: not in sync yet, discard input\n", DEVNAME(sc)); + printf("%s: not in sync yet, discard input (state %d)\n", + DEVNAME(sc), sc->inputstate); #endif sc->inputstate = 0; return; @@ -1559,6 +1581,26 @@ elantech_set_absolute_mode_v3(struct pms_softc *sc) } int +elantech_set_absolute_mode_v4(struct pms_softc *sc) +{ + /* Enable absolute mode. Magic numbers from Linux driver. */ + if (elantech_ps2_cmd(sc, ELANTECH_PS2_CUSTOM_COMMAND) || + elantech_ps2_cmd(sc, ELANTECH_CMD_READ_WRITE_REG) || + elantech_ps2_cmd(sc, ELANTECH_PS2_CUSTOM_COMMAND) || + elantech_ps2_cmd(sc, 0x07) || + elantech_ps2_cmd(sc, ELANTECH_PS2_CUSTOM_COMMAND) || + elantech_ps2_cmd(sc, ELANTECH_CMD_READ_WRITE_REG) || + elantech_ps2_cmd(sc, ELANTECH_PS2_CUSTOM_COMMAND) || + elantech_ps2_cmd(sc, 0x01) || + pms_set_scaling(sc, 1)) + return (-1); + + /* v4 has no register 0x10 to read response from */ + + return (0); +} + +int elantech_get_hwinfo_v1(struct pms_softc *sc) { struct elantech_softc *elantech = sc->elantech; @@ -1678,6 +1720,44 @@ elantech_get_hwinfo_v3(struct pms_softc *sc) } int +elantech_get_hwinfo_v4(struct pms_softc *sc) +{ + struct elantech_softc *elantech = sc->elantech; + int fw_version; + u_char capabilities[3]; + u_char resp[3]; + + if (synaptics_query(sc, ELANTECH_QUE_FW_VER, &fw_version)) + return (-1); + + if (((fw_version & 0x0f0000) >> 16) != 6) + return (-1); + + elantech->flags |= ELANTECH_F_REPORTS_PRESSURE; + + if (elantech_set_absolute_mode_v4(sc)) + return (-1); + + if (pms_spec_cmd(sc, ELANTECH_QUE_CAPABILITIES) || + pms_get_status(sc, capabilities)) + return (-1); + + if (pms_spec_cmd(sc, ELANTECH_QUE_FW_ID) || + pms_get_status(sc, resp)) + return (-1); + + elantech->max_x = (resp[0] & 0x0f) << 8 | resp[1]; + elantech->max_y = (resp[0] & 0xf0) << 4 | resp[2]; + + if ((capabilities[1] < 2) || (capabilities[1] > elantech->max_x)) + return (-1); + + elantech->width = elantech->max_x / (capabilities[1] - 1); + + return (0); +} + +int elantech_ps2_cmd(struct pms_softc *sc, u_char command) { u_char cmd[1]; @@ -1821,6 +1901,43 @@ err: } int +pms_enable_elantech_v4(struct pms_softc *sc) +{ + struct elantech_softc *elantech = sc->elantech; + + if (elantech_knock(sc)) + goto err; + + if (sc->elantech == NULL) { + sc->elantech = elantech = malloc(sizeof(struct elantech_softc), + M_DEVBUF, M_WAITOK | M_ZERO); + if (elantech == NULL) { + printf("%s: elantech: not enough memory\n", + DEVNAME(sc)); + goto err; + } + + if (elantech_get_hwinfo_v4(sc)) + goto err; + + printf("%s: Elantech Clickpad, version %d\n", DEVNAME(sc), 4); + } else if (elantech_set_absolute_mode_v4(sc)) + goto err; + + return (1); + +err: + if (sc->elantech) { + free(sc->elantech, M_DEVBUF); + sc->elantech = NULL; + } + + pms_reset(sc); + + return (0); +} + +int pms_ioctl_elantech(struct pms_softc *sc, u_long cmd, caddr_t data, int flag, struct proc *p) { @@ -1958,6 +2075,15 @@ pms_sync_elantech_v3(struct pms_softc *sc, int data) return (0); } +int +pms_sync_elantech_v4(struct pms_softc *sc, int data) +{ + if (sc->inputstate == 0 && (data & 0x0c) != 0x04) + return (-1); + else + return (0); +} + void pms_proc_elantech_v1(struct pms_softc *sc) { @@ -2066,6 +2192,90 @@ pms_proc_elantech_v3(struct pms_softc *sc) } void +pms_proc_elantech_v4(struct pms_softc *sc) +{ + struct elantech_softc *elantech = sc->elantech; + int w, z, delta_x1 = 0, delta_x2 = 0, delta_y1 = 0, delta_y2 = 0; + int i, weight, finger, fingers = 0, id, sid; + + switch (sc->packet[3] & 0x1f) { + case ELANTECH_V4_PKT_STATUS: + fingers = sc->packet[1] & 0x1f; + for (i = 0; i < ELANTECH_MAX_FINGERS; i++) { + finger = ((fingers & (1 << i)) != 0); + if (elantech->fingers[i] && !finger) + /* notify that we lifted */ + elantech_send_input(sc, elantech->mt[i].x, + elantech->mt[i].y, 0, 0); + + elantech->fingers[i] = finger; + } + + break; + + case ELANTECH_V4_PKT_HEAD: + id = ((sc->packet[3] & 0xe0) >> 5) - 1; + if (id < 0) + return; + + for (i = 0; i < ELANTECH_MAX_FINGERS; i++) + if (elantech->fingers[i]) + fingers++; + + elantech->mt[id].x = ((sc->packet[1] & 0x0f) << 8) | + sc->packet[2]; + elantech->mt[id].y = (((sc->packet[4] & 0x0f) << 8) | + sc->packet[5]); + z = (sc->packet[1] & 0xf0) | ((sc->packet[4] & 0xf0) >> 4); + + elantech_send_input(sc, elantech->mt[id].x, elantech->mt[id].y, + z, fingers); + + break; + + case ELANTECH_V4_PKT_MOTION: + id = ((sc->packet[0] & 0xe0) >> 5) - 1; + if (id < 0) + return; + + sid = ((sc->packet[3] & 0xe0) >> 5) - 1; + weight = (sc->packet[0] & 0x10) ? ELANTECH_V4_WEIGHT_VALUE : 1; + + delta_x1 = (signed char)sc->packet[1]; + delta_y1 = (signed char)sc->packet[2]; + delta_x2 = (signed char)sc->packet[4]; + delta_y2 = (signed char)sc->packet[5]; + + elantech->mt[id].x += delta_x1 * weight; + elantech->mt[id].y -= delta_y1 * weight; + + for (i = 0; i < ELANTECH_MAX_FINGERS; i++) + if (elantech->fingers[i]) + fingers++; + + elantech_send_input(sc, elantech->mt[id].x, elantech->mt[id].y, + z, fingers); + + if (sid >= 0) { + elantech->mt[sid].x += delta_x2 * w; + elantech->mt[sid].y -= delta_y2 * w; + /* XXX: can only send one finger of input */ + /* + elantech_send_input(sc, elantech->mt[sid].x, + elantech->mt[sid].y, z, w); + */ + } + + break; + + default: + printf("%s: unknown packet type 0x%x\n", DEVNAME(sc), + sc->packet[3] & 0x1f); + return; + } +} + +void elantech_send_input(struct pms_softc *sc, int x, int y, int z, int w) { struct elantech_softc *elantech = sc->elantech; |