From patchwork Tue Oct 28 00:01:55 2014 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Dmitry Baryshkov X-Patchwork-Id: 404010 Return-Path: X-Original-To: incoming@patchwork.ozlabs.org Delivered-To: patchwork-incoming@bilbo.ozlabs.org Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 742A6140077 for ; Tue, 28 Oct 2014 11:02:35 +1100 (AEDT) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1752943AbaJ1ACe (ORCPT ); Mon, 27 Oct 2014 20:02:34 -0400 Received: from mail-wi0-f178.google.com ([209.85.212.178]:33045 "EHLO mail-wi0-f178.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752889AbaJ1ACb (ORCPT ); Mon, 27 Oct 2014 20:02:31 -0400 Received: by mail-wi0-f178.google.com with SMTP id q5so76596wiv.11 for ; Mon, 27 Oct 2014 17:02:29 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20120113; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=PROb7d3Cpjmq/iDP0BBMmN4ES7OPvkVNlV69rZDzN0Y=; b=KCYj3aMhQSevW4lpQ3LARQLZekqKz+xpcxD8/i8TcXeDWh837+ZGbFX6gTGWB2nIVk JcQQ//YXCqAniMWg/smUjj84EVCoLcW2TI/qBHjdLKmT1B1ELS5v7tzTvRYzKiGAyrK0 pBrXaDvB9PJpDCZNbKECdZnfcImlHq60NVnwtHMCwvLbyYPQAvmhPe9GrQwWgrYLWNqs heEk/Aje3Xqvd1QTFHFNluXjKsPyL1DiShBWyLmIChN+/RZP6iI6Cn5YHeadgtgmdO0r eVX0ssV5rpDOCgvy0srzEEUkd0QoA2JR/PeyPhFR37WbbtmLXo3L0iKCLUp7QbnBV4zV 1Nvg== X-Received: by 10.194.57.169 with SMTP id j9mr24903625wjq.33.1414454549240; Mon, 27 Oct 2014 17:02:29 -0700 (PDT) Received: from fangorn.rup.mentorg.com (nat-min.mentorg.com. [139.181.32.34]) by mx.google.com with ESMTPSA id fq1sm13495340wib.12.2014.10.27.17.02.26 for (version=TLSv1.2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Mon, 27 Oct 2014 17:02:28 -0700 (PDT) From: Dmitry Eremin-Solenikov To: linux-arm-kernel@lists.infradead.org, linux-gpio@vger.kernel.org, linux-input@vger.kernel.org, linux-leds@vger.kernel.org, linux-spi@vger.kernel.org, linux-fbdev@vger.kernel.org, alsa-devel@alsa-project.org Cc: Andrea Adami , Russell King , Daniel Mack , Haojian Zhuang , Robert Jarzmik , Linus Walleij , Alexandre Courbot , Dmitry Torokhov , Bryan Wu , Richard Purdie , Samuel Ortiz , Lee Jones , Mark Brown , Jingoo Han , Liam Girdwood Subject: [PATCH 02/15] GPIO: port LoCoMo gpio support from old driver Date: Tue, 28 Oct 2014 03:01:55 +0300 Message-Id: <1414454528-24240-3-git-send-email-dbaryshkov@gmail.com> X-Mailer: git-send-email 2.1.1 In-Reply-To: <1414454528-24240-1-git-send-email-dbaryshkov@gmail.com> References: <1414454528-24240-1-git-send-email-dbaryshkov@gmail.com> Sender: linux-gpio-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-gpio@vger.kernel.org Add gpiolib driver for gpio pins placed on the LoCoMo GA. Signed-off-by: Dmitry Eremin-Solenikov --- drivers/gpio/Kconfig | 7 ++ drivers/gpio/Makefile | 1 + drivers/gpio/gpio-locomo.c | 228 +++++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 236 insertions(+) create mode 100644 drivers/gpio/gpio-locomo.c diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig index 0959ca9..11c03d4 100644 --- a/drivers/gpio/Kconfig +++ b/drivers/gpio/Kconfig @@ -457,6 +457,13 @@ config GPIO_TB10X select GENERIC_IRQ_CHIP select OF_GPIO +config GPIO_LOCOMO + bool "Sharp LoCoMo GPIO support" + depends on MFD_LOCOMO + help + Select this to support GPIO pins on Sharp LoCoMo Grid Array found + in Sharp Zaurus collie and poodle models. + comment "I2C GPIO expanders:" config GPIO_ARIZONA diff --git a/drivers/gpio/Makefile b/drivers/gpio/Makefile index e5d346c..ed73f63 100644 --- a/drivers/gpio/Makefile +++ b/drivers/gpio/Makefile @@ -39,6 +39,7 @@ obj-$(CONFIG_GPIO_JANZ_TTL) += gpio-janz-ttl.o obj-$(CONFIG_GPIO_KEMPLD) += gpio-kempld.o obj-$(CONFIG_ARCH_KS8695) += gpio-ks8695.o obj-$(CONFIG_GPIO_INTEL_MID) += gpio-intel-mid.o +obj-$(CONFIG_GPIO_LOCOMO) += gpio-locomo.o obj-$(CONFIG_GPIO_LP3943) += gpio-lp3943.o obj-$(CONFIG_ARCH_LPC32XX) += gpio-lpc32xx.o obj-$(CONFIG_GPIO_LYNXPOINT) += gpio-lynxpoint.o diff --git a/drivers/gpio/gpio-locomo.c b/drivers/gpio/gpio-locomo.c new file mode 100644 index 0000000..3b54b07 --- /dev/null +++ b/drivers/gpio/gpio-locomo.c @@ -0,0 +1,228 @@ +/* + * Sharp LoCoMo support for GPIO + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + * This file contains all generic LoCoMo support. + * + * All initialization functions provided here are intended to be called + * from machine specific code with proper arguments when required. + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include + +struct locomo_gpio { + void __iomem *regs; + + spinlock_t lock; + struct gpio_chip gpio; + + u16 rising_edge; + u16 falling_edge; + + u16 save_gpo; + u16 save_gpe; +}; + +static int locomo_gpio_get(struct gpio_chip *chip, + unsigned offset) +{ + struct locomo_gpio *lg = container_of(chip, struct locomo_gpio, gpio); + + return readw(lg->regs + LOCOMO_GPL) & (1 << offset); +} + +static void __locomo_gpio_set(struct gpio_chip *chip, + unsigned offset, int value) +{ + struct locomo_gpio *lg = container_of(chip, struct locomo_gpio, gpio); + u16 r; + + r = readw(lg->regs + LOCOMO_GPO); + if (value) + r |= 1 << offset; + else + r &= ~(1 << offset); + writew(r, lg->regs + LOCOMO_GPO); +} + +static void locomo_gpio_set(struct gpio_chip *chip, + unsigned offset, int value) +{ + struct locomo_gpio *lg = container_of(chip, struct locomo_gpio, gpio); + unsigned long flags; + + spin_lock_irqsave(&lg->lock, flags); + + __locomo_gpio_set(chip, offset, value); + + spin_unlock_irqrestore(&lg->lock, flags); +} + +static int locomo_gpio_direction_input(struct gpio_chip *chip, + unsigned offset) +{ + struct locomo_gpio *lg = container_of(chip, struct locomo_gpio, gpio); + unsigned long flags; + u16 r; + + spin_lock_irqsave(&lg->lock, flags); + + r = readw(lg->regs + LOCOMO_GPD); + r |= (1 << offset); + writew(r, lg->regs + LOCOMO_GPD); + + r = readw(lg->regs + LOCOMO_GPE); + r |= (1 << offset); + writew(r, lg->regs + LOCOMO_GPE); + + spin_unlock_irqrestore(&lg->lock, flags); + + return 0; +} + +static int locomo_gpio_direction_output(struct gpio_chip *chip, + unsigned offset, int value) +{ + struct locomo_gpio *lg = container_of(chip, struct locomo_gpio, gpio); + unsigned long flags; + u16 r; + + spin_lock_irqsave(&lg->lock, flags); + + __locomo_gpio_set(chip, offset, value); + + r = readw(lg->regs + LOCOMO_GPD); + r &= ~(1 << offset); + writew(r, lg->regs + LOCOMO_GPD); + + r = readw(lg->regs + LOCOMO_GPE); + r &= ~(1 << offset); + writew(r, lg->regs + LOCOMO_GPE); + + spin_unlock_irqrestore(&lg->lock, flags); + + return 0; +} + +#ifdef CONFIG_PM_SLEEP +static int locomo_gpio_suspend(struct device *dev) +{ + struct locomo_gpio *lg = dev_get_drvdata(dev); + unsigned long flags; + + spin_lock_irqsave(&lg->lock, flags); + + lg->save_gpo = readw(lg->regs + LOCOMO_GPO); + writew(0x00, lg->regs + LOCOMO_GPO); + + lg->save_gpo = readw(lg->regs + LOCOMO_GPE); + writew(0x00, lg->regs + LOCOMO_GPE); + + spin_unlock_irqrestore(&lg->lock, flags); + return 0; +} + +static int locomo_gpio_resume(struct device *dev) +{ + struct locomo_gpio *lg = dev_get_drvdata(dev); + unsigned long flags; + + spin_lock_irqsave(&lg->lock, flags); + + writew(lg->save_gpo, lg->regs + LOCOMO_GPO); + + writew(lg->save_gpe, lg->regs + LOCOMO_GPE); + + spin_unlock_irqrestore(&lg->lock, flags); + return 0; +} +static SIMPLE_DEV_PM_OPS(locomo_gpio_pm, + locomo_gpio_suspend, locomo_gpio_resume); +#define LOCOMO_GPIO_PM (&locomo_gpio_pm) +#else +#define LOCOMO_GPIO_PM NULL +#endif + +static int locomo_gpio_probe(struct platform_device *pdev) +{ + struct resource *res; + struct locomo_gpio *lg; + int ret; + struct locomo_gpio_platform_data *pdata = dev_get_platdata(&pdev->dev); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) + return -ENODEV; + + lg = devm_kzalloc(&pdev->dev, sizeof(struct locomo_gpio), + GFP_KERNEL); + if (!lg) + return -ENOMEM; + + lg->regs = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(lg->regs)) + return PTR_ERR(lg->regs); + + spin_lock_init(&lg->lock); + + platform_set_drvdata(pdev, lg); + + writew(0, lg->regs + LOCOMO_GPO); + writew(0, lg->regs + LOCOMO_GPE); + writew(0, lg->regs + LOCOMO_GPD); + writew(0, lg->regs + LOCOMO_GIE); + + lg->gpio.base = pdata ? pdata->gpio_base : -1; + lg->gpio.label = "locomo-gpio"; + lg->gpio.ngpio = 16; + lg->gpio.set = locomo_gpio_set; + lg->gpio.get = locomo_gpio_get; + lg->gpio.direction_input = locomo_gpio_direction_input; + lg->gpio.direction_output = locomo_gpio_direction_output; + + ret = gpiochip_add(&lg->gpio); + if (ret) + return ret; + + return 0; +} + +static int locomo_gpio_remove(struct platform_device *pdev) +{ + struct locomo_gpio *lg = platform_get_drvdata(pdev); + int ret; + + ret = gpiochip_remove(&lg->gpio); + if (ret) { + dev_err(&pdev->dev, "Can't remove gpio chip: %d\n", ret); + return ret; + } + + return 0; +} + +static struct platform_driver locomo_gpio_driver = { + .probe = locomo_gpio_probe, + .remove = locomo_gpio_remove, + .driver = { + .name = "locomo-gpio", + .owner = THIS_MODULE, + .pm = LOCOMO_GPIO_PM, + }, +}; +module_platform_driver(locomo_gpio_driver); + +MODULE_DESCRIPTION("Sharp LoCoMo GPIO driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("John Lenz "); +MODULE_ALIAS("platform:locomo-gpio");