USB: avoid left shift by -1
[linux-2.6/btrfs-unstable.git] / drivers / gpio / gpio-arizona.c
blob991370494922b1f7ac3489dc0616793be319378a
1 /*
2 * gpiolib support for Wolfson Arizona class devices
4 * Copyright 2012 Wolfson Microelectronics PLC.
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
15 #include <linux/kernel.h>
16 #include <linux/slab.h>
17 #include <linux/module.h>
18 #include <linux/gpio.h>
19 #include <linux/platform_device.h>
20 #include <linux/seq_file.h>
22 #include <linux/mfd/arizona/core.h>
23 #include <linux/mfd/arizona/pdata.h>
24 #include <linux/mfd/arizona/registers.h>
26 struct arizona_gpio {
27 struct arizona *arizona;
28 struct gpio_chip gpio_chip;
31 static int arizona_gpio_direction_in(struct gpio_chip *chip, unsigned offset)
33 struct arizona_gpio *arizona_gpio = gpiochip_get_data(chip);
34 struct arizona *arizona = arizona_gpio->arizona;
36 return regmap_update_bits(arizona->regmap, ARIZONA_GPIO1_CTRL + offset,
37 ARIZONA_GPN_DIR, ARIZONA_GPN_DIR);
40 static int arizona_gpio_get(struct gpio_chip *chip, unsigned offset)
42 struct arizona_gpio *arizona_gpio = gpiochip_get_data(chip);
43 struct arizona *arizona = arizona_gpio->arizona;
44 unsigned int val;
45 int ret;
47 ret = regmap_read(arizona->regmap, ARIZONA_GPIO1_CTRL + offset, &val);
48 if (ret < 0)
49 return ret;
51 if (val & ARIZONA_GPN_LVL)
52 return 1;
53 else
54 return 0;
57 static int arizona_gpio_direction_out(struct gpio_chip *chip,
58 unsigned offset, int value)
60 struct arizona_gpio *arizona_gpio = gpiochip_get_data(chip);
61 struct arizona *arizona = arizona_gpio->arizona;
63 if (value)
64 value = ARIZONA_GPN_LVL;
66 return regmap_update_bits(arizona->regmap, ARIZONA_GPIO1_CTRL + offset,
67 ARIZONA_GPN_DIR | ARIZONA_GPN_LVL, value);
70 static void arizona_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
72 struct arizona_gpio *arizona_gpio = gpiochip_get_data(chip);
73 struct arizona *arizona = arizona_gpio->arizona;
75 if (value)
76 value = ARIZONA_GPN_LVL;
78 regmap_update_bits(arizona->regmap, ARIZONA_GPIO1_CTRL + offset,
79 ARIZONA_GPN_LVL, value);
82 static struct gpio_chip template_chip = {
83 .label = "arizona",
84 .owner = THIS_MODULE,
85 .direction_input = arizona_gpio_direction_in,
86 .get = arizona_gpio_get,
87 .direction_output = arizona_gpio_direction_out,
88 .set = arizona_gpio_set,
89 .can_sleep = true,
92 static int arizona_gpio_probe(struct platform_device *pdev)
94 struct arizona *arizona = dev_get_drvdata(pdev->dev.parent);
95 struct arizona_pdata *pdata = dev_get_platdata(arizona->dev);
96 struct arizona_gpio *arizona_gpio;
97 int ret;
99 arizona_gpio = devm_kzalloc(&pdev->dev, sizeof(*arizona_gpio),
100 GFP_KERNEL);
101 if (!arizona_gpio)
102 return -ENOMEM;
104 arizona_gpio->arizona = arizona;
105 arizona_gpio->gpio_chip = template_chip;
106 arizona_gpio->gpio_chip.parent = &pdev->dev;
107 #ifdef CONFIG_OF_GPIO
108 arizona_gpio->gpio_chip.of_node = arizona->dev->of_node;
109 #endif
111 switch (arizona->type) {
112 case WM5102:
113 case WM5110:
114 case WM8280:
115 case WM8997:
116 case WM8998:
117 case WM1814:
118 arizona_gpio->gpio_chip.ngpio = 5;
119 break;
120 case WM1831:
121 case CS47L24:
122 arizona_gpio->gpio_chip.ngpio = 2;
123 break;
124 default:
125 dev_err(&pdev->dev, "Unknown chip variant %d\n",
126 arizona->type);
127 return -EINVAL;
130 if (pdata && pdata->gpio_base)
131 arizona_gpio->gpio_chip.base = pdata->gpio_base;
132 else
133 arizona_gpio->gpio_chip.base = -1;
135 ret = devm_gpiochip_add_data(&pdev->dev, &arizona_gpio->gpio_chip,
136 arizona_gpio);
137 if (ret < 0) {
138 dev_err(&pdev->dev, "Could not register gpiochip, %d\n",
139 ret);
140 goto err;
143 platform_set_drvdata(pdev, arizona_gpio);
145 return ret;
147 err:
148 return ret;
151 static struct platform_driver arizona_gpio_driver = {
152 .driver.name = "arizona-gpio",
153 .probe = arizona_gpio_probe,
156 module_platform_driver(arizona_gpio_driver);
158 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
159 MODULE_DESCRIPTION("GPIO interface for Arizona devices");
160 MODULE_LICENSE("GPL");
161 MODULE_ALIAS("platform:arizona-gpio");