146 lines · c
1// SPDX-License-Identifier: GPL-2.0+2/*3 * gpiolib support for Wolfson WM835x PMICs4 *5 * Copyright 2009 Wolfson Microelectronics PLC.6 *7 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>8 *9 */10 11#include <linux/gpio/driver.h>12#include <linux/kernel.h>13#include <linux/mfd/core.h>14#include <linux/module.h>15#include <linux/platform_device.h>16#include <linux/slab.h>17 18#include <linux/mfd/wm8350/core.h>19#include <linux/mfd/wm8350/gpio.h>20 21struct wm8350_gpio_data {22 struct wm8350 *wm8350;23 struct gpio_chip gpio_chip;24};25 26static int wm8350_gpio_direction_in(struct gpio_chip *chip, unsigned offset)27{28 struct wm8350_gpio_data *wm8350_gpio = gpiochip_get_data(chip);29 struct wm8350 *wm8350 = wm8350_gpio->wm8350;30 31 return wm8350_set_bits(wm8350, WM8350_GPIO_CONFIGURATION_I_O,32 1 << offset);33}34 35static int wm8350_gpio_get(struct gpio_chip *chip, unsigned offset)36{37 struct wm8350_gpio_data *wm8350_gpio = gpiochip_get_data(chip);38 struct wm8350 *wm8350 = wm8350_gpio->wm8350;39 int ret;40 41 ret = wm8350_reg_read(wm8350, WM8350_GPIO_LEVEL);42 if (ret < 0)43 return ret;44 45 if (ret & (1 << offset))46 return 1;47 else48 return 0;49}50 51static void wm8350_gpio_set(struct gpio_chip *chip, unsigned offset, int value)52{53 struct wm8350_gpio_data *wm8350_gpio = gpiochip_get_data(chip);54 struct wm8350 *wm8350 = wm8350_gpio->wm8350;55 56 if (value)57 wm8350_set_bits(wm8350, WM8350_GPIO_LEVEL, 1 << offset);58 else59 wm8350_clear_bits(wm8350, WM8350_GPIO_LEVEL, 1 << offset);60}61 62static int wm8350_gpio_direction_out(struct gpio_chip *chip,63 unsigned offset, int value)64{65 struct wm8350_gpio_data *wm8350_gpio = gpiochip_get_data(chip);66 struct wm8350 *wm8350 = wm8350_gpio->wm8350;67 int ret;68 69 ret = wm8350_clear_bits(wm8350, WM8350_GPIO_CONFIGURATION_I_O,70 1 << offset);71 if (ret < 0)72 return ret;73 74 /* Don't have an atomic direction/value setup */75 wm8350_gpio_set(chip, offset, value);76 77 return 0;78}79 80static int wm8350_gpio_to_irq(struct gpio_chip *chip, unsigned offset)81{82 struct wm8350_gpio_data *wm8350_gpio = gpiochip_get_data(chip);83 struct wm8350 *wm8350 = wm8350_gpio->wm8350;84 85 if (!wm8350->irq_base)86 return -EINVAL;87 88 return wm8350->irq_base + WM8350_IRQ_GPIO(offset);89}90 91static const struct gpio_chip template_chip = {92 .label = "wm8350",93 .owner = THIS_MODULE,94 .direction_input = wm8350_gpio_direction_in,95 .get = wm8350_gpio_get,96 .direction_output = wm8350_gpio_direction_out,97 .set = wm8350_gpio_set,98 .to_irq = wm8350_gpio_to_irq,99 .can_sleep = true,100};101 102static int wm8350_gpio_probe(struct platform_device *pdev)103{104 struct wm8350 *wm8350 = dev_get_drvdata(pdev->dev.parent);105 struct wm8350_platform_data *pdata = dev_get_platdata(wm8350->dev);106 struct wm8350_gpio_data *wm8350_gpio;107 108 wm8350_gpio = devm_kzalloc(&pdev->dev, sizeof(*wm8350_gpio),109 GFP_KERNEL);110 if (wm8350_gpio == NULL)111 return -ENOMEM;112 113 wm8350_gpio->wm8350 = wm8350;114 wm8350_gpio->gpio_chip = template_chip;115 wm8350_gpio->gpio_chip.ngpio = 13;116 wm8350_gpio->gpio_chip.parent = &pdev->dev;117 if (pdata && pdata->gpio_base)118 wm8350_gpio->gpio_chip.base = pdata->gpio_base;119 else120 wm8350_gpio->gpio_chip.base = -1;121 122 return devm_gpiochip_add_data(&pdev->dev, &wm8350_gpio->gpio_chip, wm8350_gpio);123}124 125static struct platform_driver wm8350_gpio_driver = {126 .driver.name = "wm8350-gpio",127 .probe = wm8350_gpio_probe,128};129 130static int __init wm8350_gpio_init(void)131{132 return platform_driver_register(&wm8350_gpio_driver);133}134subsys_initcall(wm8350_gpio_init);135 136static void __exit wm8350_gpio_exit(void)137{138 platform_driver_unregister(&wm8350_gpio_driver);139}140module_exit(wm8350_gpio_exit);141 142MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");143MODULE_DESCRIPTION("GPIO interface for WM8350 PMICs");144MODULE_LICENSE("GPL");145MODULE_ALIAS("platform:wm8350-gpio");146