Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 1 | /* |
| 2 | * nvec_ps2: mouse driver for a NVIDIA compliant embedded controller |
| 3 | * |
| 4 | * Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.launchpad.net> |
| 5 | * |
| 6 | * Authors: Pierre-Hugues Husson <phhusson@free.fr> |
| 7 | * Ilya Petrov <ilya.muromec@gmail.com> |
| 8 | * Marc Dietrich <marvin24@gmx.de> |
| 9 | * |
| 10 | * This file is subject to the terms and conditions of the GNU General Public |
| 11 | * License. See the file "COPYING" in the main directory of this archive |
| 12 | * for more details. |
| 13 | * |
| 14 | */ |
| 15 | |
Julian Andres Klode | 7974035 | 2011-09-27 19:00:39 +0200 | [diff] [blame] | 16 | #include <linux/module.h> |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 17 | #include <linux/slab.h> |
| 18 | #include <linux/serio.h> |
| 19 | #include <linux/delay.h> |
Marc Dietrich | f686e9a | 2011-08-24 20:23:07 +0200 | [diff] [blame] | 20 | #include <linux/platform_device.h> |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 21 | |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 22 | #include "nvec.h" |
| 23 | |
Marc Dietrich | 93eff83 | 2013-01-27 17:43:43 +0100 | [diff] [blame] | 24 | #define PACKET_SIZE 6 |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 25 | |
Marc Dietrich | 93eff83 | 2013-01-27 17:43:43 +0100 | [diff] [blame] | 26 | #define ENABLE_MOUSE 0xf4 |
| 27 | #define DISABLE_MOUSE 0xf5 |
| 28 | #define PSMOUSE_RST 0xff |
Marc Dietrich | 85a9052 | 2013-01-27 17:43:42 +0100 | [diff] [blame] | 29 | |
Marc Dietrich | 0eedab7 | 2011-12-26 17:57:35 +0100 | [diff] [blame] | 30 | #ifdef NVEC_PS2_DEBUG |
| 31 | #define NVEC_PHD(str, buf, len) \ |
| 32 | print_hex_dump(KERN_DEBUG, str, DUMP_PREFIX_NONE, \ |
| 33 | 16, 1, buf, len, false) |
| 34 | #else |
| 35 | #define NVEC_PHD(str, buf, len) |
| 36 | #endif |
| 37 | |
Marc Dietrich | 93eff83 | 2013-01-27 17:43:43 +0100 | [diff] [blame] | 38 | enum ps2_subcmds { |
| 39 | SEND_COMMAND = 1, |
| 40 | RECEIVE_N, |
| 41 | AUTO_RECEIVE_N, |
| 42 | CANCEL_AUTO_RECEIVE, |
| 43 | }; |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 44 | |
| 45 | struct nvec_ps2 { |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 46 | struct serio *ser_dev; |
| 47 | struct notifier_block notifier; |
| 48 | struct nvec_chip *nvec; |
| 49 | }; |
| 50 | |
| 51 | static struct nvec_ps2 ps2_dev; |
| 52 | |
| 53 | static int ps2_startstreaming(struct serio *ser_dev) |
| 54 | { |
Marc Dietrich | 93eff83 | 2013-01-27 17:43:43 +0100 | [diff] [blame] | 55 | unsigned char buf[] = { NVEC_PS2, AUTO_RECEIVE_N, PACKET_SIZE }; |
Pawel Lebioda | fa79961 | 2014-07-03 21:15:57 +0200 | [diff] [blame] | 56 | |
Julian Andres Klode | ff006d1 | 2011-09-27 19:01:02 +0200 | [diff] [blame] | 57 | return nvec_write_async(ps2_dev.nvec, buf, sizeof(buf)); |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 58 | } |
| 59 | |
| 60 | static void ps2_stopstreaming(struct serio *ser_dev) |
| 61 | { |
Marc Dietrich | 93eff83 | 2013-01-27 17:43:43 +0100 | [diff] [blame] | 62 | unsigned char buf[] = { NVEC_PS2, CANCEL_AUTO_RECEIVE }; |
Pawel Lebioda | fa79961 | 2014-07-03 21:15:57 +0200 | [diff] [blame] | 63 | |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 64 | nvec_write_async(ps2_dev.nvec, buf, sizeof(buf)); |
| 65 | } |
| 66 | |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 67 | static int ps2_sendcommand(struct serio *ser_dev, unsigned char cmd) |
| 68 | { |
Marc Dietrich | 93eff83 | 2013-01-27 17:43:43 +0100 | [diff] [blame] | 69 | unsigned char buf[] = { NVEC_PS2, SEND_COMMAND, ENABLE_MOUSE, 1 }; |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 70 | |
| 71 | buf[2] = cmd & 0xff; |
| 72 | |
| 73 | dev_dbg(&ser_dev->dev, "Sending ps2 cmd %02x\n", cmd); |
Julian Andres Klode | ff006d1 | 2011-09-27 19:01:02 +0200 | [diff] [blame] | 74 | return nvec_write_async(ps2_dev.nvec, buf, sizeof(buf)); |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 75 | } |
| 76 | |
| 77 | static int nvec_ps2_notifier(struct notifier_block *nb, |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 78 | unsigned long event_type, void *data) |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 79 | { |
| 80 | int i; |
| 81 | unsigned char *msg = (unsigned char *)data; |
| 82 | |
| 83 | switch (event_type) { |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 84 | case NVEC_PS2_EVT: |
Julian Andres Klode | 1e46e62 | 2011-09-27 19:01:03 +0200 | [diff] [blame] | 85 | for (i = 0; i < msg[1]; i++) |
| 86 | serio_interrupt(ps2_dev.ser_dev, msg[2 + i], 0); |
Marc Dietrich | 0eedab7 | 2011-12-26 17:57:35 +0100 | [diff] [blame] | 87 | NVEC_PHD("ps/2 mouse event: ", &msg[2], msg[1]); |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 88 | return NOTIFY_STOP; |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 89 | |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 90 | case NVEC_PS2: |
Marc Dietrich | 0eedab7 | 2011-12-26 17:57:35 +0100 | [diff] [blame] | 91 | if (msg[2] == 1) { |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 92 | for (i = 0; i < (msg[1] - 2); i++) |
| 93 | serio_interrupt(ps2_dev.ser_dev, msg[i + 4], 0); |
Marc Dietrich | 0eedab7 | 2011-12-26 17:57:35 +0100 | [diff] [blame] | 94 | NVEC_PHD("ps/2 mouse reply: ", &msg[4], msg[1] - 2); |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 95 | } |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 96 | |
Marc Dietrich | 0eedab7 | 2011-12-26 17:57:35 +0100 | [diff] [blame] | 97 | else if (msg[1] != 2) /* !ack */ |
| 98 | NVEC_PHD("unhandled mouse event: ", msg, msg[1] + 2); |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 99 | return NOTIFY_STOP; |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 100 | } |
| 101 | |
| 102 | return NOTIFY_DONE; |
| 103 | } |
| 104 | |
Bill Pemberton | 4662080 | 2012-11-19 13:22:07 -0500 | [diff] [blame] | 105 | static int nvec_mouse_probe(struct platform_device *pdev) |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 106 | { |
Marc Dietrich | f686e9a | 2011-08-24 20:23:07 +0200 | [diff] [blame] | 107 | struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent); |
Marc Dietrich | f5e3352 | 2012-06-24 23:25:16 +0200 | [diff] [blame] | 108 | struct serio *ser_dev; |
Marc Dietrich | 93eff83 | 2013-01-27 17:43:43 +0100 | [diff] [blame] | 109 | char mouse_reset[] = { NVEC_PS2, SEND_COMMAND, PSMOUSE_RST, 3 }; |
Marc Dietrich | f5e3352 | 2012-06-24 23:25:16 +0200 | [diff] [blame] | 110 | |
Himangi Saraogi | e534f3e | 2014-03-07 21:39:27 +0530 | [diff] [blame] | 111 | ser_dev = devm_kzalloc(&pdev->dev, sizeof(struct serio), GFP_KERNEL); |
Somya Anand | 4c42d97 | 2015-03-16 19:34:11 +0530 | [diff] [blame] | 112 | if (!ser_dev) |
Marc Dietrich | f5e3352 | 2012-06-24 23:25:16 +0200 | [diff] [blame] | 113 | return -ENOMEM; |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 114 | |
Marc Dietrich | 36b30d6 | 2011-12-26 17:57:37 +0100 | [diff] [blame] | 115 | ser_dev->id.type = SERIO_PS_PSTHRU; |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 116 | ser_dev->write = ps2_sendcommand; |
Marc Dietrich | 34ba143 | 2011-12-26 17:57:33 +0100 | [diff] [blame] | 117 | ser_dev->start = ps2_startstreaming; |
| 118 | ser_dev->stop = ps2_stopstreaming; |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 119 | |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 120 | strlcpy(ser_dev->name, "nvec mouse", sizeof(ser_dev->name)); |
| 121 | strlcpy(ser_dev->phys, "nvec", sizeof(ser_dev->phys)); |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 122 | |
| 123 | ps2_dev.ser_dev = ser_dev; |
| 124 | ps2_dev.notifier.notifier_call = nvec_ps2_notifier; |
| 125 | ps2_dev.nvec = nvec; |
| 126 | nvec_register_notifier(nvec, &ps2_dev.notifier, 0); |
| 127 | |
| 128 | serio_register_port(ser_dev); |
| 129 | |
| 130 | /* mouse reset */ |
Marc Dietrich | 93eff83 | 2013-01-27 17:43:43 +0100 | [diff] [blame] | 131 | nvec_write_async(nvec, mouse_reset, sizeof(mouse_reset)); |
Marc Dietrich | 32890b9 | 2011-05-19 16:34:42 +0200 | [diff] [blame] | 132 | |
| 133 | return 0; |
| 134 | } |
Marc Dietrich | f686e9a | 2011-08-24 20:23:07 +0200 | [diff] [blame] | 135 | |
Bill Pemberton | 1a6a8a8 | 2012-11-19 13:26:41 -0500 | [diff] [blame] | 136 | static int nvec_mouse_remove(struct platform_device *pdev) |
Marc Dietrich | 3cdde3a | 2012-06-24 23:25:21 +0200 | [diff] [blame] | 137 | { |
Marc Dietrich | c2b62f6 | 2013-04-29 23:14:52 +0200 | [diff] [blame] | 138 | struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent); |
| 139 | |
| 140 | ps2_sendcommand(ps2_dev.ser_dev, DISABLE_MOUSE); |
| 141 | ps2_stopstreaming(ps2_dev.ser_dev); |
| 142 | nvec_unregister_notifier(nvec, &ps2_dev.notifier); |
Marc Dietrich | 3cdde3a | 2012-06-24 23:25:21 +0200 | [diff] [blame] | 143 | serio_unregister_port(ps2_dev.ser_dev); |
| 144 | |
| 145 | return 0; |
| 146 | } |
| 147 | |
Marc Dietrich | ebefae2 | 2012-06-24 23:25:19 +0200 | [diff] [blame] | 148 | #ifdef CONFIG_PM_SLEEP |
| 149 | static int nvec_mouse_suspend(struct device *dev) |
Marc Dietrich | d1b5342 | 2011-12-26 17:57:32 +0100 | [diff] [blame] | 150 | { |
Marc Dietrich | a573298 | 2011-12-26 17:57:36 +0100 | [diff] [blame] | 151 | /* disable mouse */ |
Marc Dietrich | 85a9052 | 2013-01-27 17:43:42 +0100 | [diff] [blame] | 152 | ps2_sendcommand(ps2_dev.ser_dev, DISABLE_MOUSE); |
Marc Dietrich | a573298 | 2011-12-26 17:57:36 +0100 | [diff] [blame] | 153 | |
Marc Dietrich | d1b5342 | 2011-12-26 17:57:32 +0100 | [diff] [blame] | 154 | /* send cancel autoreceive */ |
Marc Dietrich | 85a9052 | 2013-01-27 17:43:42 +0100 | [diff] [blame] | 155 | ps2_stopstreaming(ps2_dev.ser_dev); |
Marc Dietrich | d1b5342 | 2011-12-26 17:57:32 +0100 | [diff] [blame] | 156 | |
| 157 | return 0; |
| 158 | } |
| 159 | |
Marc Dietrich | ebefae2 | 2012-06-24 23:25:19 +0200 | [diff] [blame] | 160 | static int nvec_mouse_resume(struct device *dev) |
Marc Dietrich | d1b5342 | 2011-12-26 17:57:32 +0100 | [diff] [blame] | 161 | { |
Marc Dietrich | 85a9052 | 2013-01-27 17:43:42 +0100 | [diff] [blame] | 162 | /* start streaming */ |
Marc Dietrich | d1b5342 | 2011-12-26 17:57:32 +0100 | [diff] [blame] | 163 | ps2_startstreaming(ps2_dev.ser_dev); |
| 164 | |
Marc Dietrich | a573298 | 2011-12-26 17:57:36 +0100 | [diff] [blame] | 165 | /* enable mouse */ |
Marc Dietrich | 85a9052 | 2013-01-27 17:43:42 +0100 | [diff] [blame] | 166 | ps2_sendcommand(ps2_dev.ser_dev, ENABLE_MOUSE); |
Marc Dietrich | a573298 | 2011-12-26 17:57:36 +0100 | [diff] [blame] | 167 | |
Marc Dietrich | d1b5342 | 2011-12-26 17:57:32 +0100 | [diff] [blame] | 168 | return 0; |
| 169 | } |
Marc Dietrich | ebefae2 | 2012-06-24 23:25:19 +0200 | [diff] [blame] | 170 | #endif |
| 171 | |
Peng Fan | 716baa7 | 2015-06-16 23:13:21 +0800 | [diff] [blame] | 172 | static SIMPLE_DEV_PM_OPS(nvec_mouse_pm_ops, nvec_mouse_suspend, |
| 173 | nvec_mouse_resume); |
Marc Dietrich | d1b5342 | 2011-12-26 17:57:32 +0100 | [diff] [blame] | 174 | |
Marc Dietrich | f686e9a | 2011-08-24 20:23:07 +0200 | [diff] [blame] | 175 | static struct platform_driver nvec_mouse_driver = { |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 176 | .probe = nvec_mouse_probe, |
Bill Pemberton | 44b90a3 | 2012-11-19 13:20:55 -0500 | [diff] [blame] | 177 | .remove = nvec_mouse_remove, |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 178 | .driver = { |
| 179 | .name = "nvec-mouse", |
Marc Dietrich | ebefae2 | 2012-06-24 23:25:19 +0200 | [diff] [blame] | 180 | .pm = &nvec_mouse_pm_ops, |
Marc Dietrich | f686e9a | 2011-08-24 20:23:07 +0200 | [diff] [blame] | 181 | }, |
| 182 | }; |
| 183 | |
Marc Dietrich | 9891b1c | 2012-06-24 23:25:18 +0200 | [diff] [blame] | 184 | module_platform_driver(nvec_mouse_driver); |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 185 | |
| 186 | MODULE_DESCRIPTION("NVEC mouse driver"); |
| 187 | MODULE_AUTHOR("Marc Dietrich <marvin24@gmx.de>"); |
Marc Dietrich | 99758de | 2013-04-29 23:14:50 +0200 | [diff] [blame] | 188 | MODULE_ALIAS("platform:nvec-mouse"); |
Marc Dietrich | 162c7d8 | 2011-09-27 19:00:40 +0200 | [diff] [blame] | 189 | MODULE_LICENSE("GPL"); |