From patchwork Tue Oct 22 06:31:57 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Ming-Jen Chen X-Patchwork-Id: 13845202 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id D3EB8D1CDA1 for ; Tue, 22 Oct 2024 06:35:26 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:Content-Transfer-Encoding: MIME-Version:References:In-Reply-To:Message-Id:Date:Subject:To:From:Reply-To: Cc:Content-Type:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=JhZnFvvf8Id6PGMcwnAZsntULqiyWtz+J0PFKo90yqI=; b=L6PbN3KwM+G2vNFU8tKM/8eQZl Z7j+pVSIay106biXMrig6SoHRFZ8XcRpsDbdY91fFA8WSK7wg3xrU2e9VACg/hiVtl+RB/tlFW2KT rg/MY/vwET1TXS5uo3V52NElFgqOWf+td9ezG7p5RBPn3v1cCVcEvgE5+GJB5KNZB+nKIYXxznpIN bzUuA6zEg8to1TV8Jiq/28IPDQaRNHVgLhvWTIM9IXSb2FWwTkHyDYfVfXwLTQnP7NlLqE9hFPrRJ XnXsgNt3R9+NC4WL06q3NZNN9EpxRk1MW39XqqmPiQV5dUlGOW6hXqGIbPrUR5YFOFO2lHhLS7k1T W3KxXnVA==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1t38U9-00000009pUn-1Kmz; Tue, 22 Oct 2024 06:35:17 +0000 Received: from mail-pj1-x102b.google.com ([2607:f8b0:4864:20::102b]) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1t38R8-00000009okh-3WdS for linux-arm-kernel@lists.infradead.org; Tue, 22 Oct 2024 06:32:12 +0000 Received: by mail-pj1-x102b.google.com with SMTP id 98e67ed59e1d1-2e2e6a1042dso4177033a91.2 for ; Mon, 21 Oct 2024 23:32:10 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1729578729; x=1730183529; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:from:to:cc:subject:date:message-id :reply-to; bh=JhZnFvvf8Id6PGMcwnAZsntULqiyWtz+J0PFKo90yqI=; b=cQVPMcLGrpZqcl90+8Cb94t2+pKkRhV4lMHYhUCKQtGaKHYoFNRTQccv/dM/kWAiN3 wQ8QzYCUbbWjq0O4WrQJ2L7WTjpNPP4/f+Pc1DLh5isjniuWzyZ4gwEWGTvj4n8Pv2GR i7AD6KQBJ6vE1Nw5RUopKVwqMyQ5zj1ywzDM9IozP4T6yHZlTA7TPVGb7ZfdtC1ZtFDg NCa3CdA5//4x+EptPqkvoAqy7LRKwZC8HzFlkcGLdLDd6leDXpg9klIGOk0uV5DkESej hEyE+thNya7zE3UND7SKb7ZFZv85FSayLgqycdnAYVtB0FhbkdDZO7ZVY2xPo/jt4MJD YIAg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1729578729; x=1730183529; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=JhZnFvvf8Id6PGMcwnAZsntULqiyWtz+J0PFKo90yqI=; b=XBtoDT5W2urINO+OIYjcVnpsf4K0vcxZjhTkqHyVRHzwVSmIstJKF2IPVA5Sgk/PWu ahWguQ2R99IwzqbUnfXthVar9HLPF6Hxxmqgob1X/qpAGEK7vVevk6+s+KbWrVNxSs+U HHjEgRrCZou7a9aJYwSSkXYEHg1VzZnb846mL+UgqEuYsa+OANEZzgI1h1QL/u8413Y+ KI2Zp6+aIlSTt8f0oHCd/AAPQuaMCoB/b5mYBIe/gHJ5x2sY2S9eM8NLvbek1hJk6lvH 2JBpnLe77Wv3T/T9cu2/GxGxsMCCNSM6NZNZSqbzZsN3LP57WNHW5atx30gGv2Qe32Z1 NgtQ== X-Forwarded-Encrypted: i=1; AJvYcCVKvLz3vwYhoVQALoWClV5RA/9rwWDNxkPzyLZg9hhz11lYISNguXi1u7YEP5jrR7cB/FTWcvncIemT+59+uFhR@lists.infradead.org X-Gm-Message-State: AOJu0YwIeODd80s6tkAohb4m+G35aW8o0ByIqIOQ0Mgf3ON3gG84O+Ks g8K9RBRAbzCNKl1P9b2CJ4QVZq7+uJDA7lIOD5tRuQJ4jwIYUecrCN/5bCLI X-Google-Smtp-Source: AGHT+IGN8i3mOey7VdZPPlZdjGYJJmkHvvSelu321aCwFvVAEV3cURA9WTE75dCfPDQ8v06QzorsLg== X-Received: by 2002:a17:90b:3013:b0:2e2:d181:6809 with SMTP id 98e67ed59e1d1-2e561a178e6mr16626201a91.39.1729578729488; Mon, 21 Oct 2024 23:32:09 -0700 (PDT) Received: from localhost.localdomain (60-250-192-107.hinet-ip.hinet.net. [60.250.192.107]) by smtp.gmail.com with ESMTPSA id 98e67ed59e1d1-2e5ad355bebsm5227508a91.7.2024.10.21.23.32.06 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 21 Oct 2024 23:32:09 -0700 (PDT) From: mjchen To: linux-kernel@vger.kernel.org, devicetree@vger.kernel.org, linux-input@vger.kernel.org, linux-arm-kernel@lists.infradead.org, mjchen0829@gmail.com, mjchen@nuvoton.com, peng.fan@nxp.com, sudeep.holla@arm.com, arnd@arndb.de, conor+dt@kernel.org, krzk+dt@kernel.org, robh@kernel.org, dmitry.torokhov@gmail.com Subject: [PATCH 1/2] dt-bindings: input: Add Nuvoton MA35D1 keypad Date: Tue, 22 Oct 2024 06:31:57 +0000 Message-Id: <20241022063158.5910-2-mjchen0829@gmail.com> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20241022063158.5910-1-mjchen0829@gmail.com> References: <20241022063158.5910-1-mjchen0829@gmail.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20241021_233210_918206_A47EEF40 X-CRM114-Status: GOOD ( 12.85 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: mjchen Add YAML bindings for MA35D1 SoC keypad. Signed-off-by: mjchen --- .../bindings/input/nvt,ma35d1-keypad.yaml | 88 +++++++++++++++++++ 1 file changed, 88 insertions(+) create mode 100755 Documentation/devicetree/bindings/input/nvt,ma35d1-keypad.yaml diff --git a/Documentation/devicetree/bindings/input/nvt,ma35d1-keypad.yaml b/Documentation/devicetree/bindings/input/nvt,ma35d1-keypad.yaml new file mode 100755 index 000000000000..3d9fc26cc132 --- /dev/null +++ b/Documentation/devicetree/bindings/input/nvt,ma35d1-keypad.yaml @@ -0,0 +1,88 @@ +# SPDX-License-Identifier: (GPL-2.0 OR BSD-2-Clause) +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/input/nvt,ma35d1-keypad.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: NVT MA35D1 Keypad + +maintainers: + - Ming-jen Chen + +allOf: + - $ref: /schemas/input/matrix-keymap.yaml# + +properties: + compatible: + const: nuvoton,ma35d1-kpi + + debounce-period: + $ref: /schemas/types.yaml#/definitions/uint32 + description: | + key debounce period select + 0 = 0 clock + 1 = 0 clock + 2 = 0 clock + 3 = 8 clocks + 4 = 16 clocks + 5 = 32 clocks + 6 = 64 clocks + 7 = 128 clocks + 8 = 256 clocks + 9 = 512 clocks + 10 = 1024 clocks + 11 = 2048 clocks + 12 = 4096 clocks + 13 = 8192 clocks + + per-scale: + $ref: /schemas/types.yaml#/definitions/uint32 + description: Row Scan Cycle Pre-scale Value (1 to 256). + + per-scalediv: + $ref: /schemas/types.yaml#/definitions/uint32 + description: Per-scale divider (1 to 256). + + reg: + maxItems: 1 + + interrupts: + maxItems: 1 + + clocks: + maxItems: 1 + +required: + - compatible + - reg + - interrupts + - clocks + - linux,keymap + - debounce-period + - per-scale + - per-scalediv + +unevaluatedProperties: false + +examples: + - | + #include + keypad: keypad@404A0000 { + compatible = "nuvoton,ma35d1-kpi"; + reg = <0x404A0000 0x10000>; + interrupts = <79>; + clocks = <&clk>; + keypad,num-rows = <2>; + keypad,num-columns = <2>; + + linux,keymap = < + MATRIX_KEY(0, 0, KEY_ENTER) + MATRIX_KEY(0, 1, KEY_ENTER) + MATRIX_KEY(1, 0, KEY_SPACE) + MATRIX_KEY(1, 1, KEY_Z) + >; + + debounce-period = <1>; + per-scale = <1>; + per-scalediv = <24>; + }; From patchwork Tue Oct 22 06:31:58 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Ming-Jen Chen X-Patchwork-Id: 13845203 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id 3146DD1CDA1 for ; Tue, 22 Oct 2024 06:37:05 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:Content-Transfer-Encoding: MIME-Version:References:In-Reply-To:Message-Id:Date:Subject:To:From:Reply-To: Cc:Content-Type:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=TeJfGyoavQtWH24FNumVoDvcueikkdaRPhG7USbSTX8=; b=kNOkwShst1njcBi9pwin4FqsLF f0Pyk+/LJh7XOz80JDb0AxpWNSHpHxANTvGAN6tOr0cs9buiwLuDgKB1wyujPc0U/4/kJ7G3+u+4C RlaqyVhUsrpUU/pXJCWauFTBx7fj/WTc3v78TDzJc/qRvjqDP2qBErA8lZxFUVPnjthK+bcx6UEIo LHyId2GfQ6zvI8uLaz2QAr1lARFr2G/uJvGsb8f5UJeJwFhuLiC2/pwyT3OkbSK1u4zSNui+52NSI RqlBx+DNm2wf4wQqyb3f3UbZGyLCeVwBLoGjHTe5YK8FFGdaecOF2y8GOCt2Ie8f5Ug5b6kpFQHoE pZPVeaaA==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1t38Vb-00000009php-2kat; Tue, 22 Oct 2024 06:36:49 +0000 Received: from mail-pj1-x1030.google.com ([2607:f8b0:4864:20::1030]) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1t38RB-00000009ole-2E2y for linux-arm-kernel@lists.infradead.org; Tue, 22 Oct 2024 06:32:14 +0000 Received: by mail-pj1-x1030.google.com with SMTP id 98e67ed59e1d1-2e3686088c3so3844602a91.0 for ; Mon, 21 Oct 2024 23:32:12 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1729578732; x=1730183532; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:from:to:cc:subject:date:message-id :reply-to; bh=TeJfGyoavQtWH24FNumVoDvcueikkdaRPhG7USbSTX8=; b=kXCgaanmWPgD6Ic2SVOM762D9yOizwCdbTI7O6TcH+JdL50RZf74hmw9VeKwyJTk9p CsyJisnM5HQYcUEAsBlHMOtxFOpMH1oS+fxF20leGtktqwyCcGjj5Y0mhziQt1gBazDR 9TE85IH/I1Tjz1eGke5YgudvX4sJbFg7GTZZ7UU0ssI/ghgFc4Pb794MROCCrMQH9hTC OE44bqczRVIgkO/c8nhPxVnGD2gBMRDb/+uuojvvk0TC4BS1MDAwihGJiAB8WJQxs96Q R7ACfG/HsqvJliPCvfaPbt+UXiIWLw0uBHULyvwHH7MfPUQh3p1/2ewXGxE2LW99DJXR ePQg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1729578732; x=1730183532; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=TeJfGyoavQtWH24FNumVoDvcueikkdaRPhG7USbSTX8=; b=ge/PTM/3oplJEGgnW9SgALYepdi3GMgi7UooHqgwSa6zyToLR64jozeSn0QIMO1GNq mFIECNQ2dLKyIfwyJNgeWJbqd7/VakAakqBFrpDhA9+lwSUujUlEz+4t9TGaWWgbAwJu RTKWM/unZZZ4PVRtGTuUNLMjGeQnjp2DI0dg/fdESo/6lRH0ZS1YObXzodh5LnmAJEW5 JF40nMrUUXZb+/F7j98TYTjRYFEEyKfGByRQrBMNNT+DB0JtFXo/WdTHaoooT1Vj38w5 6KOlavFD0mtLuuiHYwGLtHK5LY2xeEWRWxTDR+q2qhmDOJOE7IZeOOsxNHjMW6ZQbliZ J7jw== X-Forwarded-Encrypted: i=1; AJvYcCW/Vg7+2BHrURrEHYJ8iLLB4AZhV5SgAM6hHIM3QvrFAM/KExtFfKP/r2DB7GyjoHOxsL4zXqTNXMLvyzaKLup1@lists.infradead.org X-Gm-Message-State: AOJu0YxL1IgTOF/ui20P18nbEjFsc3EZNHv8oVtgpM6cdo8pQbciPkke 4+CYpid5t2KYmFP1L4ClHsScm2HAHp3vTXb6tlshF/AUKBNg82fn8o4naxz0 X-Google-Smtp-Source: AGHT+IHwsNkX5eJ8oqfIl++yx1qBuOyPryYrqnTYEX3EpS2uIlX7iAsFm1oTvFgRO8bWHNDIunqg6g== X-Received: by 2002:a17:90b:3507:b0:2e0:ab57:51ec with SMTP id 98e67ed59e1d1-2e5da804ec4mr2862861a91.30.1729578732226; Mon, 21 Oct 2024 23:32:12 -0700 (PDT) Received: from localhost.localdomain (60-250-192-107.hinet-ip.hinet.net. [60.250.192.107]) by smtp.gmail.com with ESMTPSA id 98e67ed59e1d1-2e5ad355bebsm5227508a91.7.2024.10.21.23.32.09 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 21 Oct 2024 23:32:11 -0700 (PDT) From: mjchen To: linux-kernel@vger.kernel.org, devicetree@vger.kernel.org, linux-input@vger.kernel.org, linux-arm-kernel@lists.infradead.org, mjchen0829@gmail.com, mjchen@nuvoton.com, peng.fan@nxp.com, sudeep.holla@arm.com, arnd@arndb.de, conor+dt@kernel.org, krzk+dt@kernel.org, robh@kernel.org, dmitry.torokhov@gmail.com Subject: [PATCH 2/2] input: keypad: add new keypad driver for MA35D1 Date: Tue, 22 Oct 2024 06:31:58 +0000 Message-Id: <20241022063158.5910-3-mjchen0829@gmail.com> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20241022063158.5910-1-mjchen0829@gmail.com> References: <20241022063158.5910-1-mjchen0829@gmail.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20241021_233213_605907_5585ADED X-CRM114-Status: GOOD ( 29.46 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: mjchen Adds a new keypad driver for the MA35D1 platform. The driver supports key scanning and interrupt handling. Signed-off-by: mjchen --- drivers/input/keyboard/Kconfig | 10 + drivers/input/keyboard/Makefile | 1 + drivers/input/keyboard/ma35d1_keypad.c | 312 +++++++++++++++++++++++++ 3 files changed, 323 insertions(+) create mode 100644 drivers/input/keyboard/ma35d1_keypad.c diff --git a/drivers/input/keyboard/Kconfig b/drivers/input/keyboard/Kconfig index 721ab69e84ac..ce9bd5cc13a1 100644 --- a/drivers/input/keyboard/Kconfig +++ b/drivers/input/keyboard/Kconfig @@ -797,4 +797,14 @@ config KEYBOARD_CYPRESS_SF To compile this driver as a module, choose M here: the module will be called cypress-sf. +config KEYBOARD_MA35D1 + tristate "Nuvoton MA35D1 keypad driver" + depends on ARCH_MA35 + select INPUT_MATRIXKMAP + help + Say Y here if you want to use Nuvoton MA35D1 keypad. + + To compile this driver as a module, choose M here: the + module will be called ma35d1-keypad. + endif diff --git a/drivers/input/keyboard/Makefile b/drivers/input/keyboard/Makefile index 1e0721c30709..9b858cdd1b6b 100644 --- a/drivers/input/keyboard/Makefile +++ b/drivers/input/keyboard/Makefile @@ -70,3 +70,4 @@ obj-$(CONFIG_KEYBOARD_TEGRA) += tegra-kbc.o obj-$(CONFIG_KEYBOARD_TM2_TOUCHKEY) += tm2-touchkey.o obj-$(CONFIG_KEYBOARD_TWL4030) += twl4030_keypad.o obj-$(CONFIG_KEYBOARD_XTKBD) += xtkbd.o +obj-$(CONFIG_KEYBOARD_MA35D1) += ma35d1_keypad.o diff --git a/drivers/input/keyboard/ma35d1_keypad.c b/drivers/input/keyboard/ma35d1_keypad.c new file mode 100644 index 000000000000..20b5b1b91127 --- /dev/null +++ b/drivers/input/keyboard/ma35d1_keypad.c @@ -0,0 +1,312 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * MA35D1 keypad driver + * Copyright (C) 2024 Nuvoton Technology Corp. + */ + +#include +#include +#include +#include +#include +#include + +/* Keypad Interface Registers */ +#define KPI_CONF 0x00 +#define KPI_3KCONF 0x04 +#define KPI_STATUS 0x08 +#define KPI_RSTC 0x0C +#define KPI_KEST 0x10 +#define KPI_KPE0 0x18 +#define KPI_KPE1 0x1C +#define KPI_KRE0 0x20 +#define KPI_KRE1 0x24 +#define KPI_PRESCALDIV 0x28 + +/* KPI_CONF - Keypad Configuration Register */ +#define KROW GENMASK(30, 28) /* Keypad Matrix ROW number */ +#define KCOL GENMASK(26, 24) /* Keypad Matrix COL Number */ +#define DB_CLKSEL GENMASK(19, 16) /* De-bounce sampling cycle selection */ +#define PRESCALE GENMASK(15, 8) /* Row Scan Cycle Pre-scale Value */ +#define WAKEUP BIT(5) /* Lower Power Wakeup Enable */ +#define INTEN BIT(3) /* Key Interrupt Enable Control */ +#define RKINTEN BIT(2) /* Release Key Interrupt Enable */ +#define PKINTEN BIT(1) /* Press Key Interrupt Enable Control */ +#define ENKP BIT(0) /* Keypad Scan Enable */ + +/* KPI_STATUS - Keypad Status Register */ +#define PKEY_INT BIT(4) /* Press key interrupt */ +#define RKEY_INT BIT(3) /* Release key interrupt */ +#define KEY_INT BIT(2) /* Key Interrupt */ +#define RST_3KEY BIT(1) /* 3-Keys Reset Flag */ +#define PDWAKE BIT(0) /* Power Down Wakeup Flag */ + +#define DEFAULT_DEBOUNCE 1 +#define DEFAULT_PRE_SCALE 1 +#define DEFAULT_PRE_SCALEDIV 32 + +struct ma35d1_keypad { + struct clk *clk; + struct input_dev *input_dev; + void __iomem *mmio_base; + int irq; + unsigned int kpi_row; + unsigned int kpi_col; + unsigned int debounce_val; + unsigned int pre_scale; + unsigned int pre_scale_divider; +}; + +static void ma35d1_keypad_scan_matrix(struct ma35d1_keypad *keypad, unsigned int status) +{ + struct input_dev *input_dev = keypad->input_dev; + unsigned int i, j; + unsigned int row_add = 0; + unsigned int code; + unsigned int key; + unsigned int press_key; + unsigned long KeyEvent[4]; + unsigned int row_shift = get_count_order(keypad->kpi_col); + unsigned short *keymap = input_dev->keycode; + + /* Read key event status */ + KeyEvent[0] = readl(keypad->mmio_base + KPI_KPE0); + KeyEvent[1] = readl(keypad->mmio_base + KPI_KPE1); + KeyEvent[2] = readl(keypad->mmio_base + KPI_KRE0); + KeyEvent[3] = readl(keypad->mmio_base + KPI_KRE1); + + /* Clear key event status */ + writel(KeyEvent[0], (keypad->mmio_base + KPI_KPE0)); + writel(KeyEvent[1], (keypad->mmio_base + KPI_KPE1)); + writel(KeyEvent[2], (keypad->mmio_base + KPI_KRE0)); + writel(KeyEvent[3], (keypad->mmio_base + KPI_KRE1)); + + for (j = 0; j < 4; j++) { + if (KeyEvent[j] != 0) { + row_add = (j % 2) ? 4 : 0; + press_key = (j < 2) ? 1 : 0; + + for (i = 0; i < 32; i++) { + if (KeyEvent[j] & (1<mmio_base + KPI_STATUS); + + if (kstatus & (PKEY_INT|RKEY_INT)) { + ma35d1_keypad_scan_matrix(keypad, kstatus); + } else { + if (kstatus & PDWAKE) + writel(PDWAKE, (keypad->mmio_base + KPI_STATUS)); + } + + return IRQ_HANDLED; +} + +static int ma35d1_keypad_open(struct input_dev *dev) +{ + struct ma35d1_keypad *keypad = input_get_drvdata(dev); + unsigned int val, config; + + val = RKINTEN | PKINTEN | INTEN | ENKP; + val |= FIELD_PREP(KCOL, (keypad->kpi_col - 1)) | FIELD_PREP(KROW, (keypad->kpi_row - 1)); + + if (keypad->debounce_val > 0) + config = FIELD_PREP(PRESCALE, (keypad->pre_scale - 1)) | + FIELD_PREP(DB_CLKSEL, keypad->debounce_val); + else + config = FIELD_PREP(PRESCALE, (keypad->pre_scale - 1)); + + val |= config; + + writel(val, keypad->mmio_base + KPI_CONF); + writel((keypad->pre_scale_divider - 1), keypad->mmio_base + KPI_PRESCALDIV); + + return 0; +} + +static void ma35d1_keypad_close(struct input_dev *dev) +{ + struct ma35d1_keypad *keypad = input_get_drvdata(dev); + + clk_disable(keypad->clk); +} + +static int ma35d1_keypad_probe(struct platform_device *pdev) +{ + struct ma35d1_keypad *keypad; + struct input_dev *input_dev; + struct resource *res; + int error = 0; + + keypad = devm_kzalloc(&pdev->dev, sizeof(*keypad), GFP_KERNEL); + if (!keypad) + return -ENOMEM; + + + input_dev = input_allocate_device(); + if (!input_dev) { + dev_err(&pdev->dev, "failed to allocate input device\n"); + return -ENOMEM; + } + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) { + dev_err(&pdev->dev, "failed to get I/O memory\n"); + error = -ENXIO; + goto failed_free_input; + } + + keypad->mmio_base = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(keypad->mmio_base)) { + dev_err(&pdev->dev, "failed to remap I/O memory\n"); + return PTR_ERR(keypad->mmio_base); + } + + keypad->irq = platform_get_irq(pdev, 0); + if (keypad->irq < 0) { + dev_err(&pdev->dev, "failed to get IRQ\n"); + return keypad->irq; + } + + keypad->clk = devm_clk_get(&pdev->dev, NULL); + if (IS_ERR(keypad->clk)) { + dev_err(&pdev->dev, "failed to get core clk: %ld\n", PTR_ERR(keypad->clk)); + return PTR_ERR(keypad->clk); + } + + error = matrix_keypad_parse_properties(&pdev->dev, + &(keypad->kpi_row), + &(keypad->kpi_col)); + if (error) { + dev_err(&pdev->dev, "failed to parse kp params\n"); + return error; + } + + error = matrix_keypad_build_keymap(NULL, NULL, + keypad->kpi_row, + keypad->kpi_col, + NULL, input_dev); + if (error) { + dev_err(&pdev->dev, "failed to build keymap\n"); + return error; + } + + keypad->input_dev = input_dev; + input_dev->name = pdev->name; + input_dev->id.bustype = BUS_HOST; + input_dev->open = ma35d1_keypad_open; + input_dev->close = ma35d1_keypad_close; + input_dev->dev.parent = &pdev->dev; + + if (of_property_read_u32(pdev->dev.of_node, "debounce-period", &(keypad->debounce_val))) + keypad->debounce_val = DEFAULT_DEBOUNCE; + + if (of_property_read_u32(pdev->dev.of_node, "per-scale", &(keypad->pre_scale))) + keypad->pre_scale = DEFAULT_PRE_SCALE; + + if (of_property_read_u32(pdev->dev.of_node, "per-scalediv", &(keypad->pre_scale_divider))) + keypad->pre_scale_divider = DEFAULT_PRE_SCALEDIV; + + __set_bit(EV_REP, input_dev->evbit); + input_set_drvdata(input_dev, keypad); + input_set_capability(input_dev, EV_MSC, MSC_SCAN); + + error = input_register_device(input_dev); + if (error) { + dev_err(&pdev->dev, "failed to register input device\n"); + goto failed_free_input; + } + + error = devm_request_irq(&pdev->dev, keypad->irq, + ma35d1_keypad_interrupt, + IRQF_NO_SUSPEND, pdev->name, keypad); + if (error) { + dev_err(&pdev->dev, "failed to request IRQ\n"); + goto failed_unregister_input; + } + + platform_set_drvdata(pdev, keypad); + device_init_wakeup(&pdev->dev, 1); + clk_prepare_enable(keypad->clk); + + return 0; + +failed_unregister_input: + input_unregister_device(input_dev); +failed_free_input: + input_free_device(input_dev); + return error; +} + +static void ma35d1_keypad_remove(struct platform_device *pdev) +{ + struct ma35d1_keypad *keypad = platform_get_drvdata(pdev); + + input_unregister_device(keypad->input_dev); + clk_disable_unprepare(keypad->clk); +} + +static int ma35d1_keypad_suspend(struct platform_device *pdev, + pm_message_t state) +{ + struct ma35d1_keypad *keypad = platform_get_drvdata(pdev); + + if (device_may_wakeup(&pdev->dev)) { + writel(readl(keypad->mmio_base + KPI_CONF) | WAKEUP, keypad->mmio_base + KPI_CONF); + enable_irq_wake(keypad->irq); + } + + return 0; +} + +static int ma35d1_keypad_resume(struct platform_device *pdev) +{ + struct ma35d1_keypad *keypad = platform_get_drvdata(pdev); + + if (device_may_wakeup(&pdev->dev)) { + writel(readl(keypad->mmio_base + KPI_CONF) & ~(WAKEUP), + keypad->mmio_base + KPI_CONF); + disable_irq_wake(keypad->irq); + } + + return 0; +} + +static const struct of_device_id ma35d1_kpi_of_match[] = { + { .compatible = "nuvoton,ma35d1-kpi"}, + {}, +}; +MODULE_DEVICE_TABLE(of, ma35d1_kpi_of_match); + +static struct platform_driver ma35d1_keypad_driver = { + .probe = ma35d1_keypad_probe, + .remove = ma35d1_keypad_remove, + .suspend = ma35d1_keypad_suspend, + .resume = ma35d1_keypad_resume, + .driver = { + .name = "ma35d1-kpi", + .of_match_table = of_match_ptr(ma35d1_kpi_of_match), + }, +}; +module_platform_driver(ma35d1_keypad_driver); + +MODULE_AUTHOR("Ming-Jen Chen"); +MODULE_DESCRIPTION("MA35D1 Keypad Driver"); +MODULE_LICENSE("GPL"); +