The EC command for enable/disable is not an EC command. Instead it needs
to be send to the mouse.

Signed-off-by: Marc Dietrich <[email protected]>
---
 drivers/staging/nvec/nvec_ps2.c |   16 +++++++---------
 1 file changed, 7 insertions(+), 9 deletions(-)

diff --git a/drivers/staging/nvec/nvec_ps2.c b/drivers/staging/nvec/nvec_ps2.c
index 88dd288..b1a5a96 100644
--- a/drivers/staging/nvec/nvec_ps2.c
+++ b/drivers/staging/nvec/nvec_ps2.c
@@ -25,6 +25,9 @@
 #define STOP_STREAMING {'\x06', '\x04'}
 #define SEND_COMMAND   {'\x06', '\x01', '\xf4', '\x01'}
 
+#define ENABLE_MOUSE   0xf4
+#define DISABLE_MOUSE  0xf5
+
 #ifdef NVEC_PS2_DEBUG
 #define NVEC_PHD(str, buf, len) \
        print_hex_dump(KERN_DEBUG, str, DUMP_PREFIX_NONE, \
@@ -133,27 +136,22 @@ static int nvec_mouse_remove(struct platform_device *pdev)
 #ifdef CONFIG_PM_SLEEP
 static int nvec_mouse_suspend(struct device *dev)
 {
-       struct platform_device *pdev = to_platform_device(dev);
-       struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent);
-
        /* disable mouse */
-       nvec_write_async(nvec, "\x06\xf4", 2);
+       ps2_sendcommand(ps2_dev.ser_dev, DISABLE_MOUSE);
 
        /* send cancel autoreceive */
-       nvec_write_async(nvec, "\x06\x04", 2);
+       ps2_stopstreaming(ps2_dev.ser_dev);
 
        return 0;
 }
 
 static int nvec_mouse_resume(struct device *dev)
 {
-       struct platform_device *pdev = to_platform_device(dev);
-       struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent);
-
+       /* start streaming */
        ps2_startstreaming(ps2_dev.ser_dev);
 
        /* enable mouse */
-       nvec_write_async(nvec, "\x06\xf5", 2);
+       ps2_sendcommand(ps2_dev.ser_dev, ENABLE_MOUSE);
 
        return 0;
 }
-- 
1.7.9.5

_______________________________________________
devel mailing list
[email protected]
http://driverdev.linuxdriverproject.org/mailman/listinfo/devel

Reply via email to