This source file includes following definitions.
- tps65910_gpio_get
- tps65910_gpio_set
- tps65910_gpio_output
- tps65910_gpio_input
- tps65910_parse_dt_for_gpio
- tps65910_parse_dt_for_gpio
- tps65910_gpio_probe
- tps65910_gpio_init
1
2
3
4
5
6
7
8
9
10
11 #include <linux/kernel.h>
12 #include <linux/init.h>
13 #include <linux/errno.h>
14 #include <linux/gpio/driver.h>
15 #include <linux/i2c.h>
16 #include <linux/platform_device.h>
17 #include <linux/mfd/tps65910.h>
18 #include <linux/of_device.h>
19
20 struct tps65910_gpio {
21 struct gpio_chip gpio_chip;
22 struct tps65910 *tps65910;
23 };
24
25 static int tps65910_gpio_get(struct gpio_chip *gc, unsigned offset)
26 {
27 struct tps65910_gpio *tps65910_gpio = gpiochip_get_data(gc);
28 struct tps65910 *tps65910 = tps65910_gpio->tps65910;
29 unsigned int val;
30
31 tps65910_reg_read(tps65910, TPS65910_GPIO0 + offset, &val);
32
33 if (val & GPIO_STS_MASK)
34 return 1;
35
36 return 0;
37 }
38
39 static void tps65910_gpio_set(struct gpio_chip *gc, unsigned offset,
40 int value)
41 {
42 struct tps65910_gpio *tps65910_gpio = gpiochip_get_data(gc);
43 struct tps65910 *tps65910 = tps65910_gpio->tps65910;
44
45 if (value)
46 tps65910_reg_set_bits(tps65910, TPS65910_GPIO0 + offset,
47 GPIO_SET_MASK);
48 else
49 tps65910_reg_clear_bits(tps65910, TPS65910_GPIO0 + offset,
50 GPIO_SET_MASK);
51 }
52
53 static int tps65910_gpio_output(struct gpio_chip *gc, unsigned offset,
54 int value)
55 {
56 struct tps65910_gpio *tps65910_gpio = gpiochip_get_data(gc);
57 struct tps65910 *tps65910 = tps65910_gpio->tps65910;
58
59
60 tps65910_gpio_set(gc, offset, value);
61
62 return tps65910_reg_set_bits(tps65910, TPS65910_GPIO0 + offset,
63 GPIO_CFG_MASK);
64 }
65
66 static int tps65910_gpio_input(struct gpio_chip *gc, unsigned offset)
67 {
68 struct tps65910_gpio *tps65910_gpio = gpiochip_get_data(gc);
69 struct tps65910 *tps65910 = tps65910_gpio->tps65910;
70
71 return tps65910_reg_clear_bits(tps65910, TPS65910_GPIO0 + offset,
72 GPIO_CFG_MASK);
73 }
74
75 #ifdef CONFIG_OF
76 static struct tps65910_board *tps65910_parse_dt_for_gpio(struct device *dev,
77 struct tps65910 *tps65910, int chip_ngpio)
78 {
79 struct tps65910_board *tps65910_board = tps65910->of_plat_data;
80 unsigned int prop_array[TPS6591X_MAX_NUM_GPIO];
81 int ngpio = min(chip_ngpio, TPS6591X_MAX_NUM_GPIO);
82 int ret;
83 int idx;
84
85 tps65910_board->gpio_base = -1;
86 ret = of_property_read_u32_array(tps65910->dev->of_node,
87 "ti,en-gpio-sleep", prop_array, ngpio);
88 if (ret < 0) {
89 dev_dbg(dev, "ti,en-gpio-sleep not specified\n");
90 return tps65910_board;
91 }
92
93 for (idx = 0; idx < ngpio; idx++)
94 tps65910_board->en_gpio_sleep[idx] = (prop_array[idx] != 0);
95
96 return tps65910_board;
97 }
98 #else
99 static struct tps65910_board *tps65910_parse_dt_for_gpio(struct device *dev,
100 struct tps65910 *tps65910, int chip_ngpio)
101 {
102 return NULL;
103 }
104 #endif
105
106 static int tps65910_gpio_probe(struct platform_device *pdev)
107 {
108 struct tps65910 *tps65910 = dev_get_drvdata(pdev->dev.parent);
109 struct tps65910_board *pdata = dev_get_platdata(tps65910->dev);
110 struct tps65910_gpio *tps65910_gpio;
111 int ret;
112 int i;
113
114 tps65910_gpio = devm_kzalloc(&pdev->dev,
115 sizeof(*tps65910_gpio), GFP_KERNEL);
116 if (!tps65910_gpio)
117 return -ENOMEM;
118
119 tps65910_gpio->tps65910 = tps65910;
120
121 tps65910_gpio->gpio_chip.owner = THIS_MODULE;
122 tps65910_gpio->gpio_chip.label = tps65910->i2c_client->name;
123
124 switch (tps65910_chip_id(tps65910)) {
125 case TPS65910:
126 tps65910_gpio->gpio_chip.ngpio = TPS65910_NUM_GPIO;
127 break;
128 case TPS65911:
129 tps65910_gpio->gpio_chip.ngpio = TPS65911_NUM_GPIO;
130 break;
131 default:
132 return -EINVAL;
133 }
134 tps65910_gpio->gpio_chip.can_sleep = true;
135 tps65910_gpio->gpio_chip.direction_input = tps65910_gpio_input;
136 tps65910_gpio->gpio_chip.direction_output = tps65910_gpio_output;
137 tps65910_gpio->gpio_chip.set = tps65910_gpio_set;
138 tps65910_gpio->gpio_chip.get = tps65910_gpio_get;
139 tps65910_gpio->gpio_chip.parent = &pdev->dev;
140 #ifdef CONFIG_OF_GPIO
141 tps65910_gpio->gpio_chip.of_node = tps65910->dev->of_node;
142 #endif
143 if (pdata && pdata->gpio_base)
144 tps65910_gpio->gpio_chip.base = pdata->gpio_base;
145 else
146 tps65910_gpio->gpio_chip.base = -1;
147
148 if (!pdata && tps65910->dev->of_node)
149 pdata = tps65910_parse_dt_for_gpio(&pdev->dev, tps65910,
150 tps65910_gpio->gpio_chip.ngpio);
151
152 if (!pdata)
153 goto skip_init;
154
155
156 for (i = 0; i < tps65910_gpio->gpio_chip.ngpio; ++i) {
157 if (!pdata->en_gpio_sleep[i])
158 continue;
159
160 ret = tps65910_reg_set_bits(tps65910,
161 TPS65910_GPIO0 + i, GPIO_SLEEP_MASK);
162 if (ret < 0)
163 dev_warn(tps65910->dev,
164 "GPIO Sleep setting failed with err %d\n", ret);
165 }
166
167 skip_init:
168 ret = devm_gpiochip_add_data(&pdev->dev, &tps65910_gpio->gpio_chip,
169 tps65910_gpio);
170 if (ret < 0) {
171 dev_err(&pdev->dev, "Could not register gpiochip, %d\n", ret);
172 return ret;
173 }
174
175 platform_set_drvdata(pdev, tps65910_gpio);
176
177 return ret;
178 }
179
180 static struct platform_driver tps65910_gpio_driver = {
181 .driver.name = "tps65910-gpio",
182 .probe = tps65910_gpio_probe,
183 };
184
185 static int __init tps65910_gpio_init(void)
186 {
187 return platform_driver_register(&tps65910_gpio_driver);
188 }
189 subsys_initcall(tps65910_gpio_init);