fix a kmap leak in virtio_console
[linux/fpc-iii.git] / drivers / gpio / gpio-tps65910.c
blobb6e818e680076c2041469d47e4ff03f7d7dee8c0
1 /*
2 * TI TPS6591x GPIO driver
4 * Copyright 2010 Texas Instruments Inc.
6 * Author: Graeme Gregory <gg@slimlogic.co.uk>
7 * Author: Jorge Eduardo Candelaria jedu@slimlogic.co.uk>
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License as published by the
11 * Free Software Foundation; either version 2 of the License, or (at your
12 * option) any later version.
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/errno.h>
19 #include <linux/gpio.h>
20 #include <linux/i2c.h>
21 #include <linux/platform_device.h>
22 #include <linux/mfd/tps65910.h>
23 #include <linux/of_device.h>
25 struct tps65910_gpio {
26 struct gpio_chip gpio_chip;
27 struct tps65910 *tps65910;
30 static inline struct tps65910_gpio *to_tps65910_gpio(struct gpio_chip *chip)
32 return container_of(chip, struct tps65910_gpio, gpio_chip);
35 static int tps65910_gpio_get(struct gpio_chip *gc, unsigned offset)
37 struct tps65910_gpio *tps65910_gpio = to_tps65910_gpio(gc);
38 struct tps65910 *tps65910 = tps65910_gpio->tps65910;
39 unsigned int val;
41 tps65910_reg_read(tps65910, TPS65910_GPIO0 + offset, &val);
43 if (val & GPIO_STS_MASK)
44 return 1;
46 return 0;
49 static void tps65910_gpio_set(struct gpio_chip *gc, unsigned offset,
50 int value)
52 struct tps65910_gpio *tps65910_gpio = to_tps65910_gpio(gc);
53 struct tps65910 *tps65910 = tps65910_gpio->tps65910;
55 if (value)
56 tps65910_reg_set_bits(tps65910, TPS65910_GPIO0 + offset,
57 GPIO_SET_MASK);
58 else
59 tps65910_reg_clear_bits(tps65910, TPS65910_GPIO0 + offset,
60 GPIO_SET_MASK);
63 static int tps65910_gpio_output(struct gpio_chip *gc, unsigned offset,
64 int value)
66 struct tps65910_gpio *tps65910_gpio = to_tps65910_gpio(gc);
67 struct tps65910 *tps65910 = tps65910_gpio->tps65910;
69 /* Set the initial value */
70 tps65910_gpio_set(gc, offset, value);
72 return tps65910_reg_set_bits(tps65910, TPS65910_GPIO0 + offset,
73 GPIO_CFG_MASK);
76 static int tps65910_gpio_input(struct gpio_chip *gc, unsigned offset)
78 struct tps65910_gpio *tps65910_gpio = to_tps65910_gpio(gc);
79 struct tps65910 *tps65910 = tps65910_gpio->tps65910;
81 return tps65910_reg_clear_bits(tps65910, TPS65910_GPIO0 + offset,
82 GPIO_CFG_MASK);
85 #ifdef CONFIG_OF
86 static struct tps65910_board *tps65910_parse_dt_for_gpio(struct device *dev,
87 struct tps65910 *tps65910, int chip_ngpio)
89 struct tps65910_board *tps65910_board = tps65910->of_plat_data;
90 unsigned int prop_array[TPS6591X_MAX_NUM_GPIO];
91 int ngpio = min(chip_ngpio, TPS6591X_MAX_NUM_GPIO);
92 int ret;
93 int idx;
95 tps65910_board->gpio_base = -1;
96 ret = of_property_read_u32_array(tps65910->dev->of_node,
97 "ti,en-gpio-sleep", prop_array, ngpio);
98 if (ret < 0) {
99 dev_dbg(dev, "ti,en-gpio-sleep not specified\n");
100 return tps65910_board;
103 for (idx = 0; idx < ngpio; idx++)
104 tps65910_board->en_gpio_sleep[idx] = (prop_array[idx] != 0);
106 return tps65910_board;
108 #else
109 static struct tps65910_board *tps65910_parse_dt_for_gpio(struct device *dev,
110 struct tps65910 *tps65910, int chip_ngpio)
112 return NULL;
114 #endif
116 static int tps65910_gpio_probe(struct platform_device *pdev)
118 struct tps65910 *tps65910 = dev_get_drvdata(pdev->dev.parent);
119 struct tps65910_board *pdata = dev_get_platdata(tps65910->dev);
120 struct tps65910_gpio *tps65910_gpio;
121 int ret;
122 int i;
124 tps65910_gpio = devm_kzalloc(&pdev->dev,
125 sizeof(*tps65910_gpio), GFP_KERNEL);
126 if (!tps65910_gpio) {
127 dev_err(&pdev->dev, "Could not allocate tps65910_gpio\n");
128 return -ENOMEM;
131 tps65910_gpio->tps65910 = tps65910;
133 tps65910_gpio->gpio_chip.owner = THIS_MODULE;
134 tps65910_gpio->gpio_chip.label = tps65910->i2c_client->name;
136 switch (tps65910_chip_id(tps65910)) {
137 case TPS65910:
138 tps65910_gpio->gpio_chip.ngpio = TPS65910_NUM_GPIO;
139 break;
140 case TPS65911:
141 tps65910_gpio->gpio_chip.ngpio = TPS65911_NUM_GPIO;
142 break;
143 default:
144 return -EINVAL;
146 tps65910_gpio->gpio_chip.can_sleep = true;
147 tps65910_gpio->gpio_chip.direction_input = tps65910_gpio_input;
148 tps65910_gpio->gpio_chip.direction_output = tps65910_gpio_output;
149 tps65910_gpio->gpio_chip.set = tps65910_gpio_set;
150 tps65910_gpio->gpio_chip.get = tps65910_gpio_get;
151 tps65910_gpio->gpio_chip.dev = &pdev->dev;
152 #ifdef CONFIG_OF_GPIO
153 tps65910_gpio->gpio_chip.of_node = tps65910->dev->of_node;
154 #endif
155 if (pdata && pdata->gpio_base)
156 tps65910_gpio->gpio_chip.base = pdata->gpio_base;
157 else
158 tps65910_gpio->gpio_chip.base = -1;
160 if (!pdata && tps65910->dev->of_node)
161 pdata = tps65910_parse_dt_for_gpio(&pdev->dev, tps65910,
162 tps65910_gpio->gpio_chip.ngpio);
164 if (!pdata)
165 goto skip_init;
167 /* Configure sleep control for gpios if provided */
168 for (i = 0; i < tps65910_gpio->gpio_chip.ngpio; ++i) {
169 if (!pdata->en_gpio_sleep[i])
170 continue;
172 ret = tps65910_reg_set_bits(tps65910,
173 TPS65910_GPIO0 + i, GPIO_SLEEP_MASK);
174 if (ret < 0)
175 dev_warn(tps65910->dev,
176 "GPIO Sleep setting failed with err %d\n", ret);
179 skip_init:
180 ret = gpiochip_add(&tps65910_gpio->gpio_chip);
181 if (ret < 0) {
182 dev_err(&pdev->dev, "Could not register gpiochip, %d\n", ret);
183 return ret;
186 platform_set_drvdata(pdev, tps65910_gpio);
188 return ret;
191 static int tps65910_gpio_remove(struct platform_device *pdev)
193 struct tps65910_gpio *tps65910_gpio = platform_get_drvdata(pdev);
195 return gpiochip_remove(&tps65910_gpio->gpio_chip);
198 static struct platform_driver tps65910_gpio_driver = {
199 .driver.name = "tps65910-gpio",
200 .driver.owner = THIS_MODULE,
201 .probe = tps65910_gpio_probe,
202 .remove = tps65910_gpio_remove,
205 static int __init tps65910_gpio_init(void)
207 return platform_driver_register(&tps65910_gpio_driver);
209 subsys_initcall(tps65910_gpio_init);
211 static void __exit tps65910_gpio_exit(void)
213 platform_driver_unregister(&tps65910_gpio_driver);
215 module_exit(tps65910_gpio_exit);
217 MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>");
218 MODULE_AUTHOR("Jorge Eduardo Candelaria jedu@slimlogic.co.uk>");
219 MODULE_DESCRIPTION("GPIO interface for TPS65910/TPS6511 PMICs");
220 MODULE_LICENSE("GPL v2");
221 MODULE_ALIAS("platform:tps65910-gpio");