Some of ThinkPad X1C6 touchpads didn't wakeup after resume.
Forcing enable nosleep make touchpad back.
Add nosleep via sysfs, so user can control it to workaround issue.

/sys/devices/rmi4-00/nosleep can be written non-zero will enable
nosleep mode.

BugLink: https://bugs.launchpad.net/bugs/1791427
Cc: <sta...@vger.kernel.org>
Signed-off-by: Aaron Ma <aaron...@canonical.com>
---
 drivers/input/rmi4/rmi_f01.c | 45 ++++++++++++++++++++++++++++++++++++
 1 file changed, 45 insertions(+)

diff --git a/drivers/input/rmi4/rmi_f01.c b/drivers/input/rmi4/rmi_f01.c
index 4edaa14fe878..e41d1ec625d9 100644
--- a/drivers/input/rmi4/rmi_f01.c
+++ b/drivers/input/rmi4/rmi_f01.c
@@ -325,12 +325,57 @@ static ssize_t rmi_driver_package_id_show(struct device 
*dev,
 
 static DEVICE_ATTR(package_id, 0444, rmi_driver_package_id_show, NULL);
 
+static ssize_t rmi_driver_nosleep_show(struct device *dev,
+                                         struct device_attribute *dattr,
+                                         char *buf)
+{
+       struct rmi_driver_data *data = dev_get_drvdata(dev);
+       struct f01_data *f01 = dev_get_drvdata(&data->f01_container->dev);
+       int f01_nosleep;
+
+       f01_nosleep = ((f01->device_control.ctrl0 & RMI_F01_CTRL0_NOSLEEP_BIT)
+                ? 1 : 0);
+
+       return scnprintf(buf, PAGE_SIZE, "%d\n", f01_nosleep);
+}
+
+static ssize_t rmi_driver_nosleep_store(struct device *dev,
+                                         struct device_attribute *dattr,
+                                         const char *buf, size_t count)
+{
+       struct rmi_driver_data *data = dev_get_drvdata(dev);
+       struct f01_data *f01 = dev_get_drvdata(&data->f01_container->dev);
+       int error;
+
+       if (count <= 0)
+               return count;
+
+       if ('0' == *buf) {
+               f01->device_control.ctrl0 &= ~RMI_F01_CTRL0_NOSLEEP_BIT;
+       } else {
+               f01->device_control.ctrl0 |= RMI_F01_CTRL0_NOSLEEP_BIT;
+       }
+
+       error = rmi_write(data->rmi_dev,
+                       data->f01_container->fd.control_base_addr,
+                         f01->device_control.ctrl0);
+       if (error) {
+               dev_err(dev, "Failed to write nosleep mode: %d.\n", error);
+       }
+
+       return count;
+}
+
+static DEVICE_ATTR(nosleep, 0644,
+               rmi_driver_nosleep_show, rmi_driver_nosleep_store);
+
 static struct attribute *rmi_f01_attrs[] = {
        &dev_attr_manufacturer_id.attr,
        &dev_attr_date_of_manufacture.attr,
        &dev_attr_product_id.attr,
        &dev_attr_firmware_id.attr,
        &dev_attr_package_id.attr,
+       &dev_attr_nosleep.attr,
        NULL
 };
 
-- 
2.17.1

Reply via email to