Input: hgpk - fix powersave mode

Recent testing of this codepath showed that it wasn't working,
perhaps due to changes within the input layer. This fixes it.

Signed-off-by: Daniel Drake <dsd@laptop.org>
Signed-off-by: Dmitry Torokhov <dtor@mail.ru>

diff --git a/drivers/input/mouse/hgpk.c b/drivers/input/mouse/hgpk.c
index 1beb5da4f0f32dd09b1f46bf85a55d4d710d6a2e..95577c15ae56b68f832381f29f158dd7d81d34eb 100644 (file)
--- a/drivers/input/mouse/hgpk.c
+++ b/drivers/input/mouse/hgpk.c
@@ -689,11 +689,15 @@ static int hgpk_force_recalibrate(struct psmouse *psmouse)
 }
 
 /*
- * This kills power to the touchpad; according to ALPS, current consumption
- * goes down to 50uA after running this.  To turn power back on, we drive
- * MS-DAT low.
+ * This puts the touchpad in a power saving mode; according to ALPS, current
+ * consumption goes down to 50uA after running this.  To turn power back on,
+ * we drive MS-DAT low.  Measuring with a 1mA resolution ammeter says that
+ * the current on the SUS_3.3V rail drops from 3mA or 4mA to 0 when we do this.
+ *
+ * We have no formal spec that details this operation -- the low-power
+ * sequence came from a long-lost email trail.
  */
-static int hgpk_toggle_power(struct psmouse *psmouse, int enable)
+static int hgpk_toggle_powersave(struct psmouse *psmouse, int enable)
 {
        struct ps2dev *ps2dev = &psmouse->ps2dev;
        int timeo;
@@ -711,13 +715,13 @@ static int hgpk_toggle_power(struct psmouse *psmouse, int enable)
                 * the controller.  Once we get an ACK back from it, it
                 * means we can continue with the touchpad re-init.  ALPS
                 * tells us that 1s should be long enough, so set that as
-                * the upper bound.
+                * the upper bound. (in practice, it takes about 3 loops.)
                 */
                for (timeo = 20; timeo > 0; timeo--) {
                        if (!ps2_sendbyte(&psmouse->ps2dev,
                                        PSMOUSE_CMD_DISABLE, 20))
                                break;
-                       msleep(50);
+                       msleep(25);
                }
 
                err = hgpk_reset_device(psmouse, false);
@@ -729,10 +733,9 @@ static int hgpk_toggle_power(struct psmouse *psmouse, int enable)
                /* should be all set, enable the touchpad */
                ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_ENABLE);
                psmouse_set_state(psmouse, PSMOUSE_ACTIVATED);
-
+               hgpk_dbg(psmouse, "Touchpad powered up.\n");
        } else {
                hgpk_dbg(psmouse, "Powering off touchpad.\n");
-               psmouse_set_state(psmouse, PSMOUSE_IGNORE);
 
                if (ps2_command(ps2dev, NULL, 0xec) ||
                    ps2_command(ps2dev, NULL, 0xec) ||
@@ -740,6 +743,8 @@ static int hgpk_toggle_power(struct psmouse *psmouse, int enable)
                        return -1;
                }
 
+               psmouse_set_state(psmouse, PSMOUSE_IGNORE);
+
                /* probably won't see an ACK, the touchpad will be off */
                ps2_sendbyte(&psmouse->ps2dev, 0xec, 20);
        }
@@ -755,6 +760,8 @@ static int hgpk_poll(struct psmouse *psmouse)
 
 static int hgpk_reconnect(struct psmouse *psmouse)
 {
+       struct hgpk_data *priv = psmouse->private;
+
        /*
         * During suspend/resume the ps2 rails remain powered.  We don't want
         * to do a reset because it's flush data out of buffers; however,
@@ -765,6 +772,7 @@ static int hgpk_reconnect(struct psmouse *psmouse)
                                PM_EVENT_ON)
                        return 0;
 
+       priv->powered = 1;
        return hgpk_reset_device(psmouse, false);
 }
 
@@ -791,7 +799,7 @@ static ssize_t hgpk_set_powered(struct psmouse *psmouse, void *data,
                 * hgpk_toggle_power will deal w/ state so
                 * we're not racing w/ irq
                 */
-               err = hgpk_toggle_power(psmouse, value);
+               err = hgpk_toggle_powersave(psmouse, value);
                if (!err)
                        priv->powered = value;
        }