From patchwork Wed Apr 11 14:13:40 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Lukasz Majewski X-Patchwork-Id: 10335563 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 5BBAC6053B for ; Wed, 11 Apr 2018 14:14:22 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 474D8289A1 for ; Wed, 11 Apr 2018 14:14:22 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 3B1F7289A5; Wed, 11 Apr 2018 14:14:22 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-7.9 required=2.0 tests=BAYES_00, MAILING_LIST_MULTI, RCVD_IN_DNSWL_HI autolearn=unavailable version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id C4B4D289A1 for ; Wed, 11 Apr 2018 14:14:21 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753098AbeDKOOM (ORCPT ); Wed, 11 Apr 2018 10:14:12 -0400 Received: from mail-out.m-online.net ([212.18.0.9]:56548 "EHLO mail-out.m-online.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752335AbeDKOOC (ORCPT ); Wed, 11 Apr 2018 10:14:02 -0400 Received: from frontend01.mail.m-online.net (unknown [192.168.8.182]) by mail-out.m-online.net (Postfix) with ESMTP id 40LmHY3SL7z1qvV6; Wed, 11 Apr 2018 16:14:01 +0200 (CEST) Received: from localhost (dynscan1.mnet-online.de [192.168.6.70]) by mail.m-online.net (Postfix) with ESMTP id 40LmHY311Vz1qqyh; Wed, 11 Apr 2018 16:14:01 +0200 (CEST) X-Virus-Scanned: amavisd-new at mnet-online.de Received: from mail.mnet-online.de ([192.168.8.182]) by localhost (dynscan1.mail.m-online.net [192.168.6.70]) (amavisd-new, port 10024) with ESMTP id KfXh3lFeSC2Z; Wed, 11 Apr 2018 16:14:00 +0200 (CEST) X-Auth-Info: TGXcsHggYwceqhyC9rEP3F+lAhHqIyYfsvRGrltIuMw= Received: from localhost.localdomain (85-222-111-42.dynamic.chello.pl [85.222.111.42]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.mnet-online.de (Postfix) with ESMTPSA; Wed, 11 Apr 2018 16:14:00 +0200 (CEST) From: Lukasz Majewski To: Dmitry Torokhov Cc: linux-kernel@vger.kernel.org, linux-input@vger.kernel.org, Sascha Hauer , Lukasz Majewski Subject: [PATCH 2/2] input: touchscreen mc13xxx: Add mc34708 support Date: Wed, 11 Apr 2018 16:13:40 +0200 Message-Id: <20180411141340.30939-2-lukma@denx.de> X-Mailer: git-send-email 2.11.0 In-Reply-To: <20180411141340.30939-1-lukma@denx.de> References: <20180411141340.30939-1-lukma@denx.de> Sender: linux-input-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-input@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP From: Sascha Hauer The mc34708 has a different bit to enable pen detection. This adds the driver data and devtype necessary to probe the device and to distinguish between the mc13783 and the mc34708. Signed-off-by: Sascha Hauer Signed-off-by: Lukasz Majewski --- Changes from the original patch: - Simplify the mcXXXXX_set_pen_detection functions - Fix checkpatch warnings --- drivers/input/touchscreen/mc13783_ts.c | 65 +++++++++++++++++++++++++++++++--- 1 file changed, 61 insertions(+), 4 deletions(-) diff --git a/drivers/input/touchscreen/mc13783_ts.c b/drivers/input/touchscreen/mc13783_ts.c index 610f10e6aadf..9fcc7069f633 100644 --- a/drivers/input/touchscreen/mc13783_ts.c +++ b/drivers/input/touchscreen/mc13783_ts.c @@ -33,6 +33,8 @@ MODULE_PARM_DESC(sample_tolerance, "is supposed to be wrong and is discarded. Set to 0 to " "disable this check."); +struct mc13xxx_driver_data; + struct mc13783_ts_priv { struct input_dev *idev; struct mc13xxx *mc13xxx; @@ -40,6 +42,43 @@ struct mc13783_ts_priv { unsigned int sample[4]; u8 ato; bool atox; + struct mc13xxx_driver_data *drvdata; +}; + +enum mc13xxx_type { + MC13XXX_TYPE_MC13783, + MC13XXX_TYPE_MC34708, +}; + +struct mc13xxx_driver_data { + int (*set_pen_detection)(struct mc13783_ts_priv *priv, bool enable); + enum mc13xxx_type type; +}; + +static int mc13783_set_pen_detection(struct mc13783_ts_priv *priv, bool enable) +{ + return mc13xxx_reg_rmw(priv->mc13xxx, MC13XXX_ADC0, + MC13XXX_ADC0_TSMOD_MASK, + enable ? MC13XXX_ADC0_TSMOD0 : 0); +} + +#define MC34708_ADC0_TSPENDETEN (1 << 20) + +static int mc34708_set_pen_detection(struct mc13783_ts_priv *priv, bool enable) +{ + return mc13xxx_reg_rmw(priv->mc13xxx, MC13XXX_ADC0, + MC34708_ADC0_TSPENDETEN, + enable ? MC34708_ADC0_TSPENDETEN : 0); +} + +static struct mc13xxx_driver_data mc13783_driver_data = { + .type = MC13XXX_TYPE_MC13783, + .set_pen_detection = mc13783_set_pen_detection, +}; + +static struct mc13xxx_driver_data mc34708_driver_data = { + .type = MC13XXX_TYPE_MC34708, + .set_pen_detection = mc34708_set_pen_detection, }; static irqreturn_t mc13783_ts_handler(int irq, void *data) @@ -96,6 +135,10 @@ static void mc13783_ts_report_sample(struct mc13783_ts_priv *priv) cr0 = (cr0 + cr1) / 2; + if (priv->drvdata->type == MC13XXX_TYPE_MC34708) + if (cr0 > 4080) + cr0 = 0; + if (!cr0 || !sample_tolerance || (x2 - x0 < sample_tolerance && y2 - y0 < sample_tolerance)) { @@ -148,8 +191,7 @@ static int mc13783_ts_open(struct input_dev *dev) if (ret) goto out; - ret = mc13xxx_reg_rmw(priv->mc13xxx, MC13XXX_ADC0, - MC13XXX_ADC0_TSMOD_MASK, MC13XXX_ADC0_TSMOD0); + ret = priv->drvdata->set_pen_detection(priv, 1); if (ret) mc13xxx_irq_free(priv->mc13xxx, MC13XXX_IRQ_TS, priv); out: @@ -162,8 +204,7 @@ static void mc13783_ts_close(struct input_dev *dev) struct mc13783_ts_priv *priv = input_get_drvdata(dev); mc13xxx_lock(priv->mc13xxx); - mc13xxx_reg_rmw(priv->mc13xxx, MC13XXX_ADC0, - MC13XXX_ADC0_TSMOD_MASK, 0); + priv->drvdata->set_pen_detection(priv, 0); mc13xxx_irq_free(priv->mc13xxx, MC13XXX_IRQ_TS, priv); mc13xxx_unlock(priv->mc13xxx); @@ -175,6 +216,7 @@ static int __init mc13783_ts_probe(struct platform_device *pdev) struct mc13783_ts_priv *priv; struct mc13xxx_ts_platform_data *pdata = dev_get_platdata(&pdev->dev); struct input_dev *idev; + const struct platform_device_id *id = platform_get_device_id(pdev); int ret = -ENOMEM; priv = kzalloc(sizeof(*priv), GFP_KERNEL); @@ -185,6 +227,7 @@ static int __init mc13783_ts_probe(struct platform_device *pdev) INIT_DELAYED_WORK(&priv->work, mc13783_ts_work); priv->mc13xxx = dev_get_drvdata(pdev->dev.parent); priv->idev = idev; + priv->drvdata = (void *)id->driver_data; if (pdata) { priv->atox = pdata->atox; @@ -231,7 +274,21 @@ static int mc13783_ts_remove(struct platform_device *pdev) return 0; } +static const struct platform_device_id mc13xxx_ts_idtable[] = { + { + .name = "mc13783-ts", + .driver_data = (kernel_ulong_t)&mc13783_driver_data, + }, { + .name = "mc34708-ts", + .driver_data = (kernel_ulong_t)&mc34708_driver_data, + }, { + /* sentinel */ + } +}; +MODULE_DEVICE_TABLE(platform, mc13xxx_ts_idtable); + static struct platform_driver mc13783_ts_driver = { + .id_table = mc13xxx_ts_idtable, .remove = mc13783_ts_remove, .driver = { .name = MC13783_TS_NAME,