On Thu, 2015-05-28 at 15:47 +0300, Irina Tirdea wrote:
> Implement suspend/resume for goodix driver.
>
> Signed-off-by: Octavian Purdila <octavian.purdila@xxxxxxxxx>
> Signed-off-by: Irina Tirdea <irina.tirdea@xxxxxxxxx>
> ---
> drivers/input/touchscreen/goodix.c | 81
> +++++++++++++++++++++++++++++++++++---
> 1 file changed, 76 insertions(+), 5 deletions(-)
>
> diff --git a/drivers/input/touchscreen/goodix.c
> b/drivers/input/touchscreen/goodix.c
> index 22052c9..ce7e834 100644
> --- a/drivers/input/touchscreen/goodix.c
> +++ b/drivers/input/touchscreen/goodix.c
> @@ -37,6 +37,7 @@ struct goodix_ts_data {
> unsigned int int_trigger_type;
> struct gpio_desc *gpiod_int;
> struct gpio_desc *gpiod_rst;
> + unsigned long irq_flags;
> };
>
> #define GOODIX_GPIO_INT_NAME "irq"
> @@ -52,6 +53,9 @@ struct goodix_ts_data {
> #define GOODIX_CONFIG_MAX_LENGTH 240
>
> /* Register defines */
> +#define GOODIX_REG_COMMAND 0x8040
> +#define GOODIX_CMD_SCREEN_OFF 0x05
> +
> #define GOODIX_READ_COOR_ADDR 0x814E
> #define GOODIX_REG_CONFIG_DATA 0x8047
> #define GOODIX_REG_ID 0x8140
> @@ -129,6 +133,11 @@ static int goodix_i2c_write(struct i2c_client
> *client, u16 reg, u8 *buf,
> return ret < 0 ? ret : (ret != 1 ? -EIO : 0);
> }
>
> +static int goodix_i2c_write_u8(struct i2c_client *client, u16 reg,
> u8 value)
> +{
> + return goodix_i2c_write(client, reg, &value, sizeof(value));
> +}
> +
> static int goodix_ts_read_input_report(struct goodix_ts_data *ts, u8
> *data)
> {
> int touch_num;
> @@ -227,6 +236,18 @@ static irqreturn_t goodix_ts_irq_handler(int
> irq, void *dev_id)
> return IRQ_HANDLED;
> }
>
> +static void goodix_free_irq(struct goodix_ts_data *ts)
> +{
> + devm_free_irq(&ts->client->dev, ts->client->irq, ts);
> +}
> +
> +static int goodix_request_irq(struct goodix_ts_data *ts)
> +{
> + return devm_request_threaded_irq(&ts->client->dev, ts
> ->client->irq,
> + NULL,
> goodix_ts_irq_handler,
> + ts->irq_flags, ts->client
> ->name, ts);
> +}
> +
> /**
> * goodix_get_cfg - Get device config from ACPI/DT.
> *
> @@ -562,7 +583,6 @@ static int goodix_ts_probe(struct i2c_client
> *client,
> const struct i2c_device_id *id)
> {
> struct goodix_ts_data *ts;
> - unsigned long irq_flags;
> int error;
> u16 version_info, id_info;
>
> @@ -614,10 +634,8 @@ static int goodix_ts_probe(struct i2c_client
> *client,
> if (error)
> return error;
>
> - irq_flags = goodix_irq_flags[ts->int_trigger_type] |
> IRQF_ONESHOT;
> - error = devm_request_threaded_irq(&ts->client->dev, client
> ->irq,
> - NULL,
> goodix_ts_irq_handler,
> - irq_flags, client->name,
> ts);
> + ts->irq_flags = goodix_irq_flags[ts->int_trigger_type] |
> IRQF_ONESHOT;
> + error = goodix_request_irq(ts);
> if (error) {
> dev_err(&client->dev, "request IRQ failed: %d\n",
> error);
> return error;
> @@ -626,6 +644,58 @@ static int goodix_ts_probe(struct i2c_client
> *client,
> return 0;
> }
>
> +#ifdef CONFIG_PM_SLEEP
> +static int goodix_suspend(struct device *dev)
> +{
> + struct i2c_client *client = to_i2c_client(dev);
> + struct goodix_ts_data *ts = i2c_get_clientdata(client);
> + int ret;
> +
> + goodix_free_irq(ts);
> + ret = gpiod_direction_output(ts->gpiod_int, 0);
> + if (ret) {
> + goodix_request_irq(ts);
> + return ret;
> + }
> + usleep_range(5000, 6000);
I'd appreciate some references and explanations for those magic
numbers.
> +
> + ret = goodix_i2c_write_u8(ts->client, GOODIX_REG_COMMAND,
> + GOODIX_CMD_SCREEN_OFF);
> + if (ret) {
> + dev_err(&ts->client->dev, "Screen off command
> failed\n");
> + gpiod_direction_input(ts->gpiod_int);
> + goodix_request_irq(ts);
> + return -EAGAIN;
> + }
> +
> + /*
> + * To avoid waking up while is not sleeping,
You're missing a subject in that sentence.
> + * delay 58ms to ensure reliability
> + */
> + msleep(58);
Why 58ms?
> + return 0;
> +}
> +
> +static int goodix_resume(struct device *dev)
> +{
> + struct i2c_client *client = to_i2c_client(dev);
> + struct goodix_ts_data *ts = i2c_get_clientdata(client);
> + int ret;
> +
> + ret = gpiod_direction_output(ts->gpiod_int, 1);
> + if (ret)
> + return ret;
> + usleep_range(2000, 5000); /* 2ms~5ms */
Good comment, just missing a reference (anything that could help find
that information in the datasheets would be good).
> + ret = goodix_int_sync(ts);
> + if (ret)
> + return ret;
> +
> + return goodix_request_irq(ts);
> +}
> +#endif
> +
> +static SIMPLE_DEV_PM_OPS(goodix_pm_ops, goodix_suspend,
> goodix_resume);
> +
> static const struct i2c_device_id goodix_ts_id[] = {
> { "GDIX1001:00", 0 },
> { }
> @@ -663,6 +733,7 @@ static struct i2c_driver goodix_ts_driver = {
> .owner = THIS_MODULE,
> .acpi_match_table = ACPI_PTR(goodix_acpi_match),
> .of_match_table = of_match_ptr(goodix_of_match),
> + .pm = &goodix_pm_ops,
> },
> };
> module_i2c_driver(goodix_ts_driver);
--
To unsubscribe from this list: send the line "unsubscribe devicetree" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
