From patchwork Thu Aug 23 15:00:12 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Eugeniy Paltsev X-Patchwork-Id: 961435 Return-Path: X-Original-To: incoming@patchwork.ozlabs.org Delivered-To: patchwork-incoming@bilbo.ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=lists.infradead.org (client-ip=2607:7c80:54:e::133; helo=bombadil.infradead.org; envelope-from=linux-snps-arc-bounces+incoming=patchwork.ozlabs.org@lists.infradead.org; receiver=) Authentication-Results: ozlabs.org; dmarc=fail (p=none dis=none) header.from=synopsys.com Authentication-Results: ozlabs.org; dkim=pass (2048-bit key; unprotected) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="MiYcXwpp"; dkim=fail reason="signature verification failed" (2048-bit key; unprotected) header.d=synopsys.com header.i=@synopsys.com header.b="fv/vKWLH"; dkim-atps=neutral Received: from bombadil.infradead.org (bombadil.infradead.org [IPv6:2607:7c80:54:e::133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by ozlabs.org (Postfix) with ESMTPS id 41x7083JhYz9ryt for ; Fri, 24 Aug 2018 01:01:12 +1000 (AEST) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20170209; h=Sender: Content-Transfer-Encoding:Content-Type:MIME-Version:Cc:List-Subscribe: List-Help:List-Post:List-Archive:List-Unsubscribe:List-Id:References: In-Reply-To:Message-Id:Date:Subject:To:From:Reply-To:Content-ID: Content-Description:Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc :Resent-Message-ID:List-Owner; bh=Z2txqRb+s6/Ed8C3Xmpz1QJOhXqhcscs0HKtC9r4N7Q=; b=MiYcXwpp//iYHXyZfdhaLGfyll j6RD2RmbmCJUP/bxAzodquyP/1pbgiIr7rcBbqU8LTUm5mU0CqkdgNC5aej1vRpAfjUu6sV5j4Bzz QYM4GJuegr52hyGhckd3rrQNFf+w8cAsYMt9V7ty+GgPbBhQASLFlMOZBFWuXo9af2wfksg0JVkAJ exQ/wRqc1IJUJ+1gvrGStKmBwotZqmIv2O5bl15/ELW2wOp60EWR5+W4da3Z51DpfnBokbcAz9Vxp adiAg7jhWxViGCWywxhKsImfGNmmjDQe8DNePSQMbwUN8Hc48R9cXgrX5dO6LaE59uVZ/C3n3pSAp iyt0mmRA==; Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.90_1 #2 (Red Hat Linux)) id 1fsr6j-0002Mt-Og; Thu, 23 Aug 2018 15:01:09 +0000 Received: from us01smtprelay-2.synopsys.com ([198.182.60.111] helo=smtprelay.synopsys.com) by bombadil.infradead.org with esmtps (Exim 4.90_1 #2 (Red Hat Linux)) id 1fsr6C-00025r-EP for linux-snps-arc@lists.infradead.org; Thu, 23 Aug 2018 15:00:38 +0000 Received: from mailhost.synopsys.com (mailhost2.synopsys.com [10.13.184.66]) by smtprelay.synopsys.com (Postfix) with ESMTP id 69B5410C1B06; Thu, 23 Aug 2018 08:00:27 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=synopsys.com; s=mail; t=1535036427; bh=mkE1oJD3kkMT8NkHOB83rshd02SX1+vJBbAErR0D828=; h=From:To:Cc:Subject:Date:In-Reply-To:References:From; b=fv/vKWLHOZxZSAEMgGHkChsl7Rng4vOud/t2NCiWKJRPQRoB8hV03dYIFlQmM4A+v bA+zb5onYZsD+cZpxs3h51NDwGktXZZFsAzj2MFI8XJ9cKonc+s/Yzc+KXScpMgtDi Lh6nKUszuFs+85D/Tca1hnOqV9APqERTwVrO7icRWse9xW/EebEstWvpDECfVBG1j4 WlRx7HirFOT2ZAlwKL9HTgKXCHP1vCdYwpgb5r074WI4gF6anzJ9pdOikH2dXV6mLd 7g9rakq7Jo8f/PiNqNWR1PtwTf+3vyzZp6ycMwRketofb7XpucG0PKTs3aSM7KeOCi I/QoBjIHwtL7w== Received: from paltsev-e7480.internal.synopsys.com (paltsev-e7480.internal.synopsys.com [10.121.3.36]) by mailhost.synopsys.com (Postfix) with ESMTP id 1A4D03F53; Thu, 23 Aug 2018 08:00:23 -0700 (PDT) From: Eugeniy Paltsev To: linux-snps-arc@lists.infradead.org, linux-gpio@vger.kernel.org Subject: [PATCH 1/2] GPIO: add single-register gpio via creg driver Date: Thu, 23 Aug 2018 18:00:12 +0300 Message-Id: <20180823150013.21837-2-Eugeniy.Paltsev@synopsys.com> X-Mailer: git-send-email 2.14.4 In-Reply-To: <20180823150013.21837-1-Eugeniy.Paltsev@synopsys.com> References: <20180823150013.21837-1-Eugeniy.Paltsev@synopsys.com> X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20180823_080036_504282_8E71351B X-CRM114-Status: GOOD ( 22.85 ) X-Spam-Score: -0.1 (/) X-Spam-Report: SpamAssassin version 3.4.1 on bombadil.infradead.org summary: Content analysis details: (-0.1 points) pts rule name description ---- ---------------------- -------------------------------------------------- -0.0 RCVD_IN_DNSWL_NONE RBL: Sender listed at http://www.dnswl.org/, no trust [198.182.60.111 listed in list.dnswl.org] -0.0 SPF_PASS SPF: sender matches SPF record -0.1 DKIM_VALID Message has at least one valid DKIM or DK signature -0.1 DKIM_VALID_AU Message has a valid DKIM or DK signature from author's domain 0.1 DKIM_SIGNED Message has a DKIM or DK signature, not necessarily valid X-BeenThere: linux-snps-arc@lists.infradead.org X-Mailman-Version: 2.1.21 Precedence: list List-Id: Linux on Synopsys ARC Processors List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Mark Rutland , devicetree@vger.kernel.org, Vineet Gupta , Alexey Brodkin , linux-kernel@vger.kernel.org, Rob Herring , Eugeniy Paltsev , Linus Walleij MIME-Version: 1.0 Sender: "linux-snps-arc" Errors-To: linux-snps-arc-bounces+incoming=patchwork.ozlabs.org@lists.infradead.org Add single-register MMIO gpio driver for complex cases where only several fields in register belong to GPIO and each GPIO owns field with different length and on/off values. Here is the example: 31 11 8 7 5 0 < bit number | | | | | | [ not used | gpio-1 | shift-1 | gpio-0 | shift-0 ] < 32 bit MMIO ^ ^ (3 bit) (2 bit) | | | | | write 0x2 == set output to "1" (on) | write 0x3 == set output to "0" (off) | write 0x1 == set output to "1" (on) write 0x4 == set output to "0" (off) This is different from gpio-reg, gpio-mmio and gpio-74xx-mmio: * They all don't support cases when GPIO output register have more than one bit per GPIO line. * They don't support holes in MMIO register. * They don't support cases when GPIO lines have different on/off values. Signed-off-by: Eugeniy Paltsev --- MAINTAINERS | 6 ++ drivers/gpio/Kconfig | 9 ++ drivers/gpio/Makefile | 1 + drivers/gpio/gpio-creg-snps.c | 242 ++++++++++++++++++++++++++++++++++++++++++ 4 files changed, 258 insertions(+) create mode 100644 drivers/gpio/gpio-creg-snps.c diff --git a/MAINTAINERS b/MAINTAINERS index 544cac829cf4..e731f2f9648a 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -13734,6 +13734,12 @@ S: Supported F: drivers/reset/reset-axs10x.c F: Documentation/devicetree/bindings/reset/snps,axs10x-reset.txt +SYNOPSYS CREG GPIO DRIVER +M: Eugeniy Paltsev +S: Maintained +F: drivers/gpio/gpio-creg-snps.c +F: Documentation/devicetree/bindings/gpio/snps,creg-gpio.txt + SYNOPSYS DESIGNWARE 8250 UART DRIVER R: Andy Shevchenko S: Maintained diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig index 71c0ab46f216..0f9cc1582cab 100644 --- a/drivers/gpio/Kconfig +++ b/drivers/gpio/Kconfig @@ -430,6 +430,15 @@ config GPIO_REG A 32-bit single register GPIO fixed in/out implementation. This can be used to represent any register as a set of GPIO signals. +config GPIO_SNPS_CREG + bool "GPIO via CREG (Control REGisers) driver" + select OF_GPIO + help + This driver supports GPIOs via CREG on various Synopsys SoCs. + This is is single-register MMIO gpio driver for complex cases + where only several fields in register belong to GPIO and + each GPIO owns field with different length and on/off values. + config GPIO_SPEAR_SPICS bool "ST SPEAr13xx SPI Chip Select as GPIO support" depends on PLAT_SPEAR diff --git a/drivers/gpio/Makefile b/drivers/gpio/Makefile index 1324c8f966a7..993f8ad54a19 100644 --- a/drivers/gpio/Makefile +++ b/drivers/gpio/Makefile @@ -109,6 +109,7 @@ obj-$(CONFIG_GPIO_REG) += gpio-reg.o obj-$(CONFIG_ARCH_SA1100) += gpio-sa1100.o obj-$(CONFIG_GPIO_SCH) += gpio-sch.o obj-$(CONFIG_GPIO_SCH311X) += gpio-sch311x.o +obj-$(CONFIG_GPIO_SNPS_CREG) += gpio-creg-snps.o obj-$(CONFIG_GPIO_SODAVILLE) += gpio-sodaville.o obj-$(CONFIG_GPIO_SPEAR_SPICS) += gpio-spear-spics.o obj-$(CONFIG_GPIO_SPRD) += gpio-sprd.o diff --git a/drivers/gpio/gpio-creg-snps.c b/drivers/gpio/gpio-creg-snps.c new file mode 100644 index 000000000000..b684b7257aae --- /dev/null +++ b/drivers/gpio/gpio-creg-snps.c @@ -0,0 +1,242 @@ +// SPDX-License-Identifier: GPL-2.0+ +// +// Synopsys CREG (Control REGisers) GPIO driver +// +// Copyright (C) 2018 Synopsys +// Author: Eugeniy Paltsev + +#include +#include +#include +#include +#include +#include +#include + +#include "gpiolib.h" + +/* + * GPIO via CREG (Control REGisers) driver + * + * 31 11 8 7 5 0 < bit number + * | | | | | | + * [ not used | gpio-1 | shift-1 | gpio-0 | shift-0 ] < 32 bit register + * ^ ^ + * | | + * | write 0x2 == set output to "1" (on) + * | write 0x3 == set output to "0" (off) + * | + * write 0x1 == set output to "1" (on) + * write 0x4 == set output to "0" (off) + */ + +#define MAX_GPIO 32 + +struct creg_gpio { + struct of_mm_gpio_chip mmchip; + spinlock_t lock; + + u32 shift[MAX_GPIO]; + u32 on[MAX_GPIO]; + u32 off[MAX_GPIO]; + u32 bit_per_gpio[MAX_GPIO]; +}; + +static void _creg_gpio_set(struct creg_gpio *hcg, unsigned int gpio, u32 val) +{ + u32 reg, reg_shift; + unsigned long flags; + int i; + + reg_shift = hcg->shift[gpio]; + for (i = 0; i < gpio; i++) + reg_shift += hcg->bit_per_gpio[i] + hcg->shift[i]; + + spin_lock_irqsave(&hcg->lock, flags); + reg = readl(hcg->mmchip.regs); + reg &= ~(GENMASK(hcg->bit_per_gpio[i] - 1, 0) << reg_shift); + reg |= (val << reg_shift); + writel(reg, hcg->mmchip.regs); + spin_unlock_irqrestore(&hcg->lock, flags); +} + +static void creg_gpio_set(struct gpio_chip *gc, unsigned int gpio, int val) +{ + struct creg_gpio *hcg = gpiochip_get_data(gc); + u32 value = val ? hcg->on[gpio] : hcg->off[gpio]; + + _creg_gpio_set(hcg, gpio, value); +} + +static int creg_gpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int val) +{ + creg_gpio_set(gc, gpio, val); + + return 0; +} + +static int creg_gpio_get_direction(struct gpio_chip *gc, unsigned int offset) +{ + return 0; /* output */ +} + +static int creg_gpio_xlate(struct gpio_chip *gc, + const struct of_phandle_args *gpiospec, u32 *flags) +{ + if (gpiospec->args_count != 1) { + dev_err(&gc->gpiodev->dev, "invalid args_count: %d\n", + gpiospec->args_count); + return -EINVAL; + } + + if (gpiospec->args[0] >= gc->ngpio) { + dev_err(&gc->gpiodev->dev, "gpio number is too big: %d\n", + gpiospec->args[0]); + return -EINVAL; + } + + return gpiospec->args[0]; +} + +static int creg_gpio_validate_pgv(struct device *dev, struct creg_gpio *hcg, + int i, u32 *defaults, bool use_defaults) +{ + if (hcg->bit_per_gpio[i] < 1 || hcg->bit_per_gpio[i] > 8) { + dev_err(dev, "'bit-per-line[%d]' is out of bounds\n", i); + return -EINVAL; + } + + /* Check that on valiue suits it's placeholder */ + if (GENMASK(31, hcg->bit_per_gpio[i]) & hcg->on[i]) { + dev_err(dev, "'on-val[%d]' can't be more than %lu\n", + i, GENMASK(hcg->bit_per_gpio[i] - 1, 0)); + return -EINVAL; + } + + /* Check that off valiue suits it's placeholder */ + if (GENMASK(31, hcg->bit_per_gpio[i]) & hcg->off[i]) { + dev_err(dev, "'off-val[%d]' can't be more than %lu\n", + i, GENMASK(hcg->bit_per_gpio[i] - 1, 0)); + return -EINVAL; + } + + /* Check that default valiue suits it's placeholder */ + if (use_defaults && (GENMASK(31, hcg->bit_per_gpio[i]) & defaults[i])) { + dev_err(dev, "'default-val[%d]' can't be more than %lu\n", + i, GENMASK(hcg->bit_per_gpio[i] - 1, 0)); + return -EINVAL; + } + + if (hcg->on[i] == hcg->off[i]) { + dev_err(dev, "'off-val[%d]' and 'on-val[%d]' can't be equal\n", + i, i); + return -EINVAL; + } + + return 0; +} + +static int creg_gpio_probe(struct platform_device *pdev) +{ + struct device_node *np = pdev->dev.of_node; + struct device *dev = &pdev->dev; + struct creg_gpio *hcg; + + u32 defaults[MAX_GPIO]; + bool use_defaults; + u32 ngpio, reg_len = 0; + int ret, i; + + hcg = devm_kzalloc(dev, sizeof(struct creg_gpio), GFP_KERNEL); + if (!hcg) + return -ENOMEM; + + if (of_property_read_u32(np, "snps,ngpios", &ngpio)) { + dev_err(dev, "'ngpios' isn't set\n"); + return -EINVAL; + } + + if (ngpio < 1 || ngpio > MAX_GPIO) { + dev_err(dev, "'ngpios' is out of bounds\n"); + return -EINVAL; + } + + if (of_property_read_u32_array(np, "snps,shift", hcg->shift, ngpio)) { + dev_err(dev, "'shift' is set incorrectly\n"); + return -EINVAL; + } + + if (of_property_read_u32_array(np, "snps,bit-per-line", + hcg->bit_per_gpio, ngpio)) { + dev_err(dev, "'bit-per-line' is set incorrectly\n"); + return -EINVAL; + } + + if (of_property_read_u32_array(np, "snps,on-val", hcg->on, ngpio)) { + dev_err(dev, "'on-val' is set incorrectly\n"); + return -EINVAL; + } + + if (of_property_read_u32_array(np, "snps,off-val", hcg->off, ngpio)) { + dev_err(dev, "'off-val' is set incorrectly\n"); + return -EINVAL; + } + + ret = of_property_read_u32_array(np, "snps,default-val", defaults, ngpio); + if (ret && ret != -EINVAL) { + dev_err(dev, "'default-val' is set incorrectly\n"); + return ret; + } + use_defaults = !ret; + + for (i = 0; i < ngpio; i++) { + if (creg_gpio_validate_pgv(dev, hcg, i, defaults, use_defaults)) + return -EINVAL; + + reg_len += hcg->shift[i] + hcg->bit_per_gpio[i]; + } + + /* Check that we suit in 32 bit register */ + if (reg_len > 32) { + dev_err(dev, + "32-bit io register overflow: attempt to use %u bits\n", + reg_len); + return -EINVAL; + } + + spin_lock_init(&hcg->lock); + + hcg->mmchip.gc.ngpio = ngpio; + hcg->mmchip.gc.set = creg_gpio_set; + hcg->mmchip.gc.get_direction = creg_gpio_get_direction; + hcg->mmchip.gc.direction_output = creg_gpio_dir_out; + hcg->mmchip.gc.of_xlate = creg_gpio_xlate; + hcg->mmchip.gc.of_gpio_n_cells = 1; + + ret = of_mm_gpiochip_add_data(pdev->dev.of_node, &hcg->mmchip, hcg); + if (ret) + return ret; + + /* Setup default GPIO value if we have "snps,default-val" array */ + if (use_defaults) + for (i = 0; i < ngpio; i++) + _creg_gpio_set(hcg, i, defaults[i]); + + dev_info(dev, "GPIO controller with %d gpios probed\n", ngpio); + + return 0; +} + +static const struct of_device_id creg_gpio_ids[] = { + { .compatible = "snps,creg-gpio" }, + { } +}; + +static struct platform_driver creg_gpio_snps_driver = { + .driver = { + .name = "snps-creg-gpio", + .of_match_table = creg_gpio_ids, + }, + .probe = creg_gpio_probe, +}; +builtin_platform_driver(creg_gpio_snps_driver);