From c3b9ba6ade77cfec906c3a05b576e4c43416831f Mon Sep 17 00:00:00 2001 From: Dudley Du Date: Tue, 1 Jul 2014 14:51:31 +0800 Subject: [PATCH 14/14] input: cyapa: add function to monitor LID close event to off trackpad device Add the function to monitor lid close event to suspend and resume trackpad device. Because system suspend takes some time to trigger from user space, and in that time, the lid panel of the laptop may couple with the active trackpad. This may generate stray input events, which may in turn cancel the suspend if the drivers use pm_wakup_event(), and those input events may trigger something unwanted in the UI. So this patch adds the function to do off the trackpad device quickly. When the lid is closed, as soon as possible, the trakcpad device must be off. And furthermore, the policy on lid close is not always to enter suspend (lid closed with external display), and at this time, the trackpad device must be disabled as well as again to avoid the risk of generating stray events. TEST=test on Chomebooks. Signed-off-by: Dudley Du --- drivers/input/mouse/cyapa.c | 138 +++++++++++++++++++++++++++++++++++++++++++ drivers/input/mouse/cyapa.h | 4 ++ 2 files changed, 142 insertions(+) diff --git a/drivers/input/mouse/cyapa.c b/drivers/input/mouse/cyapa.c index 4342f42..84f1e6e 100644 --- a/drivers/input/mouse/cyapa.c +++ b/drivers/input/mouse/cyapa.c @@ -1167,6 +1167,140 @@ static const struct attribute_group cyapa_sysfs_group = { .attrs = cyapa_sysfs_entries, }; + +/* + * We rely on EV_SW and SW_LID bits to identify a LID device, and hook + * up our filter to listen for SW_LID events to enable/disable touchpad when + * LID is open/closed. + */ +static const struct input_device_id lid_device_ids[] = { + { + .flags = INPUT_DEVICE_ID_MATCH_EVBIT | + INPUT_DEVICE_ID_MATCH_SWBIT, + .evbit = { BIT_MASK(EV_SW) }, + .swbit = { BIT_MASK(SW_LID) }, + }, + { }, +}; + +static int lid_device_connect(struct input_handler *handler, + struct input_dev *dev, + const struct input_device_id *id) +{ + struct input_handle *lid_handle; + int error; + + pr_info("cyapa: LID device: '%s' connected\n", dev->name); + lid_handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL); + if (!lid_handle) + return -ENOMEM; + + lid_handle->dev = dev; + lid_handle->handler = handler; + lid_handle->name = "lid_event_handler"; + lid_handle->private = handler->private; + + error = input_register_handle(lid_handle); + if (error) { + pr_err("Failed to register lid_event_handler, error %d\n", + error); + goto err_free; + } + + error = input_open_device(lid_handle); + if (error) { + pr_err("Failed to open input device, error %d\n", error); + goto err_unregister; + } + + return 0; +err_unregister: + input_unregister_handle(lid_handle); +err_free: + kfree(lid_handle); + return error; +} + +static void lid_device_disconnect(struct input_handle *handle) +{ + input_close_device(handle); + input_unregister_handle(handle); + kfree(handle); +} + +static bool lid_event_filter(struct input_handle *handle, + unsigned int type, unsigned int code, int value) +{ + struct cyapa *cyapa = handle->private; + struct device *dev = &cyapa->client->dev; + + if (type == EV_SW && code == SW_LID) { + pr_info("cyapa %s: %s touch device\n", + dev_name(&cyapa->client->dev), + (value ? "disable" : "enable")); + if (cyapa->suspended) { + /* + * If the lid event filter is called while suspended, + * there is no guarantee that the underlying i2cs are + * resumed at this point, so it is not safe to issue + * the command to change power modes. + * Instead, rely on cyapa_resume to set us back to + * PWR_MODE_FULL_ACTIVE. + */ + pr_info("cyapa %s: skipping lid pm change in suspend\n", + dev_name(&cyapa->client->dev)); + return false; + } + if (value == 0) { + if (cyapa->ops->cyapa_set_power_mode) + cyapa->ops->cyapa_set_power_mode(cyapa, + PWR_MODE_FULL_ACTIVE, 0); + pm_runtime_set_active(dev); + pm_runtime_enable(dev); + } else { + pm_runtime_disable(dev); + if (cyapa->ops->cyapa_set_power_mode) + cyapa->ops->cyapa_set_power_mode(cyapa, + PWR_MODE_OFF, 0); + } + } + + return false; +} + +static void lid_event_register_handler(struct cyapa *cyapa) +{ + int error; + struct input_handler *lid_handler = &cyapa->lid_handler; + + if (cyapa->lid_handler_registered) { + pr_err("lid handler is registered already\n"); + return; + } + + lid_handler->filter = lid_event_filter; + lid_handler->connect = lid_device_connect; + lid_handler->disconnect = lid_device_disconnect; + lid_handler->name = "cyapa_lid_event_handler"; + lid_handler->id_table = lid_device_ids; + lid_handler->private = cyapa; + + error = input_register_handler(lid_handler); + if (error) { + pr_err("Failed to register lid handler(%d)\n", error); + return; + } + cyapa->lid_handler_registered = true; +} + +static void lid_event_unregister_handler(struct cyapa *cyapa) +{ + if (cyapa->lid_handler_registered) { + input_unregister_handler(&cyapa->lid_handler); + cyapa->lid_handler_registered = false; + } +} + void cyapa_detect_async(void *data, async_cookie_t cookie) { struct cyapa *cyapa = (struct cyapa *)data; @@ -1187,6 +1321,7 @@ static void cyapa_detect_and_start(void *data, async_cookie_t cookie) cyapa_detect_async(data, cookie); cyapa_start_runtime(cyapa); + lid_event_register_handler(cyapa); } static int cyapa_probe(struct i2c_client *client, @@ -1325,6 +1460,7 @@ static int cyapa_remove(struct i2c_client *client) mutex_destroy(&cyapa->debugfs_mutex); input_unregister_device(cyapa->input); + lid_event_unregister_handler(cyapa); if (cyapa->ops->cyapa_set_power_mode) cyapa->ops->cyapa_set_power_mode(cyapa, PWR_MODE_OFF, 0); i2c_set_clientdata(client, NULL); @@ -1341,6 +1477,7 @@ static int cyapa_suspend(struct device *dev) struct cyapa *cyapa = dev_get_drvdata(dev); cyapa_disable_irq(cyapa); + cyapa->suspended = true; /* * Set trackpad device to idle mode if wakeup is allowed, @@ -1383,6 +1520,7 @@ static int cyapa_resume(struct device *dev) pm_runtime_disable(dev); pm_runtime_set_active(dev); pm_runtime_enable(dev); + cyapa->suspended = false; return 0; } #endif /* CONFIG_PM_SLEEP */ diff --git a/drivers/input/mouse/cyapa.h b/drivers/input/mouse/cyapa.h index 7f8c3d4..616db23 100644 --- a/drivers/input/mouse/cyapa.h +++ b/drivers/input/mouse/cyapa.h @@ -219,6 +219,7 @@ struct cyapa { u8 runtime_suspend_power_mode; u16 runtime_suspend_sleep_time; #endif /* CONFIG_PM_RUNTIME */ + bool suspended; /* read from query data region. */ char product_id[16]; @@ -259,6 +260,9 @@ struct cyapa { size_t tp_raw_data_size; const struct cyapa_dev_ops *ops; + + bool lid_handler_registered; + struct input_handler lid_handler; }; -- 1.7.9.5