Since we removed support for calling an init() callback from
the platform data, introduce a function which initializes
the chip by performing a hard reset, using the reset gpio
defined in the device properties.

Signed-off-by: Oreste Salerno <[email protected]>
---
 drivers/input/touchscreen/cyttsp_core.c | 12 ++++++++++++
 1 file changed, 12 insertions(+)

diff --git a/drivers/input/touchscreen/cyttsp_core.c 
b/drivers/input/touchscreen/cyttsp_core.c
index d91668d..0fd0956 100644
--- a/drivers/input/touchscreen/cyttsp_core.c
+++ b/drivers/input/touchscreen/cyttsp_core.c
@@ -240,6 +240,16 @@ static int cyttsp_set_sysinfo_regs(struct cyttsp *ts)
        return retval;
 }
 
+static void cyttsp_hard_reset(struct cyttsp *ts)
+{
+       if (ts->reset_gpio) {
+               gpiod_set_value_cansleep(ts->reset_gpio, 1);
+               msleep(CY_DELAY_DFLT);
+               gpiod_set_value_cansleep(ts->reset_gpio, 0);
+               msleep(CY_DELAY_DFLT);
+       }
+}
+
 static int cyttsp_soft_reset(struct cyttsp *ts)
 {
        unsigned long timeout;
@@ -663,6 +673,8 @@ struct cyttsp *cyttsp_probe(const struct cyttsp_bus_ops 
*bus_ops,
 
        disable_irq(ts->irq);
 
+       cyttsp_hard_reset(ts);
+
        error = cyttsp_power_on(ts);
        if (error)
                return ERR_PTR(error);
-- 
1.9.1

Reply via email to