10da094d8SJassi Brar /* 20da094d8SJassi Brar * linux/drivers/gpio/gpio-mb86s7x.c 30da094d8SJassi Brar * 40da094d8SJassi Brar * Copyright (C) 2015 Fujitsu Semiconductor Limited 50da094d8SJassi Brar * Copyright (C) 2015 Linaro Ltd. 60da094d8SJassi Brar * 70da094d8SJassi Brar * This program is free software: you can redistribute it and/or modify 80da094d8SJassi Brar * it under the terms of the GNU General Public License as published by 90da094d8SJassi Brar * the Free Software Foundation, version 2 of the License. 100da094d8SJassi Brar * 110da094d8SJassi Brar * This program is distributed in the hope that it will be useful, 120da094d8SJassi Brar * but WITHOUT ANY WARRANTY; without even the implied warranty of 130da094d8SJassi Brar * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 140da094d8SJassi Brar * GNU General Public License for more details. 150da094d8SJassi Brar */ 160da094d8SJassi Brar 170da094d8SJassi Brar #include <linux/io.h> 180da094d8SJassi Brar #include <linux/init.h> 190da094d8SJassi Brar #include <linux/clk.h> 200da094d8SJassi Brar #include <linux/module.h> 210da094d8SJassi Brar #include <linux/err.h> 220da094d8SJassi Brar #include <linux/errno.h> 230da094d8SJassi Brar #include <linux/ioport.h> 240da094d8SJassi Brar #include <linux/of_device.h> 250da094d8SJassi Brar #include <linux/gpio/driver.h> 260da094d8SJassi Brar #include <linux/platform_device.h> 270da094d8SJassi Brar #include <linux/spinlock.h> 280da094d8SJassi Brar #include <linux/slab.h> 290da094d8SJassi Brar 300da094d8SJassi Brar /* 310da094d8SJassi Brar * Only first 8bits of a register correspond to each pin, 320da094d8SJassi Brar * so there are 4 registers for 32 pins. 330da094d8SJassi Brar */ 340da094d8SJassi Brar #define PDR(x) (0x0 + x / 8 * 4) 350da094d8SJassi Brar #define DDR(x) (0x10 + x / 8 * 4) 360da094d8SJassi Brar #define PFR(x) (0x20 + x / 8 * 4) 370da094d8SJassi Brar 380da094d8SJassi Brar #define OFFSET(x) BIT((x) % 8) 390da094d8SJassi Brar 400da094d8SJassi Brar struct mb86s70_gpio_chip { 410da094d8SJassi Brar struct gpio_chip gc; 420da094d8SJassi Brar void __iomem *base; 430da094d8SJassi Brar struct clk *clk; 440da094d8SJassi Brar spinlock_t lock; 450da094d8SJassi Brar }; 460da094d8SJassi Brar 470da094d8SJassi Brar static inline struct mb86s70_gpio_chip *chip_to_mb86s70(struct gpio_chip *gc) 480da094d8SJassi Brar { 490da094d8SJassi Brar return container_of(gc, struct mb86s70_gpio_chip, gc); 500da094d8SJassi Brar } 510da094d8SJassi Brar 520da094d8SJassi Brar static int mb86s70_gpio_request(struct gpio_chip *gc, unsigned gpio) 530da094d8SJassi Brar { 540da094d8SJassi Brar struct mb86s70_gpio_chip *gchip = chip_to_mb86s70(gc); 550da094d8SJassi Brar unsigned long flags; 560da094d8SJassi Brar u32 val; 570da094d8SJassi Brar 580da094d8SJassi Brar spin_lock_irqsave(&gchip->lock, flags); 590da094d8SJassi Brar 600da094d8SJassi Brar val = readl(gchip->base + PFR(gpio)); 610da094d8SJassi Brar val &= ~OFFSET(gpio); 620da094d8SJassi Brar writel(val, gchip->base + PFR(gpio)); 630da094d8SJassi Brar 640da094d8SJassi Brar spin_unlock_irqrestore(&gchip->lock, flags); 650da094d8SJassi Brar 660da094d8SJassi Brar return 0; 670da094d8SJassi Brar } 680da094d8SJassi Brar 690da094d8SJassi Brar static void mb86s70_gpio_free(struct gpio_chip *gc, unsigned gpio) 700da094d8SJassi Brar { 710da094d8SJassi Brar struct mb86s70_gpio_chip *gchip = chip_to_mb86s70(gc); 720da094d8SJassi Brar unsigned long flags; 730da094d8SJassi Brar u32 val; 740da094d8SJassi Brar 750da094d8SJassi Brar spin_lock_irqsave(&gchip->lock, flags); 760da094d8SJassi Brar 770da094d8SJassi Brar val = readl(gchip->base + PFR(gpio)); 780da094d8SJassi Brar val |= OFFSET(gpio); 790da094d8SJassi Brar writel(val, gchip->base + PFR(gpio)); 800da094d8SJassi Brar 810da094d8SJassi Brar spin_unlock_irqrestore(&gchip->lock, flags); 820da094d8SJassi Brar } 830da094d8SJassi Brar 840da094d8SJassi Brar static int mb86s70_gpio_direction_input(struct gpio_chip *gc, unsigned gpio) 850da094d8SJassi Brar { 860da094d8SJassi Brar struct mb86s70_gpio_chip *gchip = chip_to_mb86s70(gc); 870da094d8SJassi Brar unsigned long flags; 880da094d8SJassi Brar unsigned char val; 890da094d8SJassi Brar 900da094d8SJassi Brar spin_lock_irqsave(&gchip->lock, flags); 910da094d8SJassi Brar 920da094d8SJassi Brar val = readl(gchip->base + DDR(gpio)); 930da094d8SJassi Brar val &= ~OFFSET(gpio); 940da094d8SJassi Brar writel(val, gchip->base + DDR(gpio)); 950da094d8SJassi Brar 960da094d8SJassi Brar spin_unlock_irqrestore(&gchip->lock, flags); 970da094d8SJassi Brar 980da094d8SJassi Brar return 0; 990da094d8SJassi Brar } 1000da094d8SJassi Brar 1010da094d8SJassi Brar static int mb86s70_gpio_direction_output(struct gpio_chip *gc, 1020da094d8SJassi Brar unsigned gpio, int value) 1030da094d8SJassi Brar { 1040da094d8SJassi Brar struct mb86s70_gpio_chip *gchip = chip_to_mb86s70(gc); 1050da094d8SJassi Brar unsigned long flags; 1060da094d8SJassi Brar unsigned char val; 1070da094d8SJassi Brar 1080da094d8SJassi Brar spin_lock_irqsave(&gchip->lock, flags); 1090da094d8SJassi Brar 1100da094d8SJassi Brar val = readl(gchip->base + PDR(gpio)); 1110da094d8SJassi Brar if (value) 1120da094d8SJassi Brar val |= OFFSET(gpio); 1130da094d8SJassi Brar else 1140da094d8SJassi Brar val &= ~OFFSET(gpio); 1150da094d8SJassi Brar writel(val, gchip->base + PDR(gpio)); 1160da094d8SJassi Brar 1170da094d8SJassi Brar val = readl(gchip->base + DDR(gpio)); 1180da094d8SJassi Brar val |= OFFSET(gpio); 1190da094d8SJassi Brar writel(val, gchip->base + DDR(gpio)); 1200da094d8SJassi Brar 1210da094d8SJassi Brar spin_unlock_irqrestore(&gchip->lock, flags); 1220da094d8SJassi Brar 1230da094d8SJassi Brar return 0; 1240da094d8SJassi Brar } 1250da094d8SJassi Brar 1260da094d8SJassi Brar static int mb86s70_gpio_get(struct gpio_chip *gc, unsigned gpio) 1270da094d8SJassi Brar { 1280da094d8SJassi Brar struct mb86s70_gpio_chip *gchip = chip_to_mb86s70(gc); 1290da094d8SJassi Brar 1300da094d8SJassi Brar return !!(readl(gchip->base + PDR(gpio)) & OFFSET(gpio)); 1310da094d8SJassi Brar } 1320da094d8SJassi Brar 1330da094d8SJassi Brar static void mb86s70_gpio_set(struct gpio_chip *gc, unsigned gpio, int value) 1340da094d8SJassi Brar { 1350da094d8SJassi Brar struct mb86s70_gpio_chip *gchip = chip_to_mb86s70(gc); 1360da094d8SJassi Brar unsigned long flags; 1370da094d8SJassi Brar unsigned char val; 1380da094d8SJassi Brar 1390da094d8SJassi Brar spin_lock_irqsave(&gchip->lock, flags); 1400da094d8SJassi Brar 1410da094d8SJassi Brar val = readl(gchip->base + PDR(gpio)); 1420da094d8SJassi Brar if (value) 1430da094d8SJassi Brar val |= OFFSET(gpio); 1440da094d8SJassi Brar else 1450da094d8SJassi Brar val &= ~OFFSET(gpio); 1460da094d8SJassi Brar writel(val, gchip->base + PDR(gpio)); 1470da094d8SJassi Brar 1480da094d8SJassi Brar spin_unlock_irqrestore(&gchip->lock, flags); 1490da094d8SJassi Brar } 1500da094d8SJassi Brar 1510da094d8SJassi Brar static int mb86s70_gpio_probe(struct platform_device *pdev) 1520da094d8SJassi Brar { 1530da094d8SJassi Brar struct mb86s70_gpio_chip *gchip; 1540da094d8SJassi Brar struct resource *res; 1550da094d8SJassi Brar int ret; 1560da094d8SJassi Brar 1570da094d8SJassi Brar gchip = devm_kzalloc(&pdev->dev, sizeof(*gchip), GFP_KERNEL); 1580da094d8SJassi Brar if (gchip == NULL) 1590da094d8SJassi Brar return -ENOMEM; 1600da094d8SJassi Brar 1610da094d8SJassi Brar platform_set_drvdata(pdev, gchip); 1620da094d8SJassi Brar 1630da094d8SJassi Brar res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 1640da094d8SJassi Brar gchip->base = devm_ioremap_resource(&pdev->dev, res); 1650da094d8SJassi Brar if (IS_ERR(gchip->base)) 1660da094d8SJassi Brar return PTR_ERR(gchip->base); 1670da094d8SJassi Brar 1680da094d8SJassi Brar gchip->clk = devm_clk_get(&pdev->dev, NULL); 1690da094d8SJassi Brar if (IS_ERR(gchip->clk)) 1700da094d8SJassi Brar return PTR_ERR(gchip->clk); 1710da094d8SJassi Brar 1720da094d8SJassi Brar clk_prepare_enable(gchip->clk); 1730da094d8SJassi Brar 1740da094d8SJassi Brar spin_lock_init(&gchip->lock); 1750da094d8SJassi Brar 1760da094d8SJassi Brar gchip->gc.direction_output = mb86s70_gpio_direction_output; 1770da094d8SJassi Brar gchip->gc.direction_input = mb86s70_gpio_direction_input; 1780da094d8SJassi Brar gchip->gc.request = mb86s70_gpio_request; 1790da094d8SJassi Brar gchip->gc.free = mb86s70_gpio_free; 1800da094d8SJassi Brar gchip->gc.get = mb86s70_gpio_get; 1810da094d8SJassi Brar gchip->gc.set = mb86s70_gpio_set; 1820da094d8SJassi Brar gchip->gc.label = dev_name(&pdev->dev); 1830da094d8SJassi Brar gchip->gc.ngpio = 32; 1840da094d8SJassi Brar gchip->gc.owner = THIS_MODULE; 1850da094d8SJassi Brar gchip->gc.dev = &pdev->dev; 1860da094d8SJassi Brar gchip->gc.base = -1; 1870da094d8SJassi Brar 1880da094d8SJassi Brar platform_set_drvdata(pdev, gchip); 1890da094d8SJassi Brar 1900da094d8SJassi Brar ret = gpiochip_add(&gchip->gc); 1910da094d8SJassi Brar if (ret) { 1920da094d8SJassi Brar dev_err(&pdev->dev, "couldn't register gpio driver\n"); 1930da094d8SJassi Brar clk_disable_unprepare(gchip->clk); 1940da094d8SJassi Brar } 1950da094d8SJassi Brar 1960da094d8SJassi Brar return ret; 1970da094d8SJassi Brar } 1980da094d8SJassi Brar 1990da094d8SJassi Brar static int mb86s70_gpio_remove(struct platform_device *pdev) 2000da094d8SJassi Brar { 2010da094d8SJassi Brar struct mb86s70_gpio_chip *gchip = platform_get_drvdata(pdev); 2020da094d8SJassi Brar 2030da094d8SJassi Brar gpiochip_remove(&gchip->gc); 2040da094d8SJassi Brar clk_disable_unprepare(gchip->clk); 2050da094d8SJassi Brar 2060da094d8SJassi Brar return 0; 2070da094d8SJassi Brar } 2080da094d8SJassi Brar 2090da094d8SJassi Brar static const struct of_device_id mb86s70_gpio_dt_ids[] = { 2100da094d8SJassi Brar { .compatible = "fujitsu,mb86s70-gpio" }, 2110da094d8SJassi Brar { /* sentinel */ } 2120da094d8SJassi Brar }; 2130da094d8SJassi Brar MODULE_DEVICE_TABLE(of, mb86s70_gpio_dt_ids); 2140da094d8SJassi Brar 2150da094d8SJassi Brar static struct platform_driver mb86s70_gpio_driver = { 2160da094d8SJassi Brar .driver = { 2170da094d8SJassi Brar .name = "mb86s70-gpio", 2180da094d8SJassi Brar .of_match_table = mb86s70_gpio_dt_ids, 2190da094d8SJassi Brar }, 2200da094d8SJassi Brar .probe = mb86s70_gpio_probe, 2210da094d8SJassi Brar .remove = mb86s70_gpio_remove, 2220da094d8SJassi Brar }; 2230da094d8SJassi Brar 2240da094d8SJassi Brar static int __init mb86s70_gpio_init(void) 2250da094d8SJassi Brar { 2260da094d8SJassi Brar return platform_driver_register(&mb86s70_gpio_driver); 2270da094d8SJassi Brar } 2280da094d8SJassi Brar module_init(mb86s70_gpio_init); 2290da094d8SJassi Brar 2300da094d8SJassi Brar MODULE_DESCRIPTION("MB86S7x GPIO Driver"); 2310da094d8SJassi Brar MODULE_ALIAS("platform:mb86s70-gpio"); 2320da094d8SJassi Brar MODULE_LICENSE("GPL"); 233