1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/spinlock.h>
13#include <linux/module.h>
14#include <linux/platform_device.h>
15#include <linux/gpio.h>
16#include <linux/io.h>
17#include <linux/cs5535.h>
18#include <asm/msr.h>
19
20#define DRV_NAME "cs5535-gpio"
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39#define GPIO_DEFAULT_MASK 0x0F7FFFFF
40
41static ulong mask = GPIO_DEFAULT_MASK;
42module_param_named(mask, mask, ulong, 0444);
43MODULE_PARM_DESC(mask, "GPIO channel mask.");
44
45
46
47
48
49static struct cs5535_gpio_chip {
50 struct gpio_chip chip;
51 resource_size_t base;
52
53 struct platform_device *pdev;
54 spinlock_t lock;
55} cs5535_gpio_chip;
56
57
58
59
60
61
62
63static void errata_outl(struct cs5535_gpio_chip *chip, u32 val,
64 unsigned int reg)
65{
66 unsigned long addr = chip->base + 0x80 + reg;
67
68
69
70
71
72
73
74
75
76
77 if (reg != GPIO_POSITIVE_EDGE_STS && reg != GPIO_NEGATIVE_EDGE_STS) {
78 if (val & 0xffff)
79 val |= (inl(addr) & 0xffff);
80 else
81 val |= (inl(addr) ^ (val >> 16));
82 }
83 outl(val, addr);
84}
85
86static void __cs5535_gpio_set(struct cs5535_gpio_chip *chip, unsigned offset,
87 unsigned int reg)
88{
89 if (offset < 16)
90
91 outl(1 << offset, chip->base + reg);
92 else
93
94 errata_outl(chip, 1 << (offset - 16), reg);
95}
96
97void cs5535_gpio_set(unsigned offset, unsigned int reg)
98{
99 struct cs5535_gpio_chip *chip = &cs5535_gpio_chip;
100 unsigned long flags;
101
102 spin_lock_irqsave(&chip->lock, flags);
103 __cs5535_gpio_set(chip, offset, reg);
104 spin_unlock_irqrestore(&chip->lock, flags);
105}
106EXPORT_SYMBOL_GPL(cs5535_gpio_set);
107
108static void __cs5535_gpio_clear(struct cs5535_gpio_chip *chip, unsigned offset,
109 unsigned int reg)
110{
111 if (offset < 16)
112
113 outl(1 << (offset + 16), chip->base + reg);
114 else
115
116 errata_outl(chip, 1 << offset, reg);
117}
118
119void cs5535_gpio_clear(unsigned offset, unsigned int reg)
120{
121 struct cs5535_gpio_chip *chip = &cs5535_gpio_chip;
122 unsigned long flags;
123
124 spin_lock_irqsave(&chip->lock, flags);
125 __cs5535_gpio_clear(chip, offset, reg);
126 spin_unlock_irqrestore(&chip->lock, flags);
127}
128EXPORT_SYMBOL_GPL(cs5535_gpio_clear);
129
130int cs5535_gpio_isset(unsigned offset, unsigned int reg)
131{
132 struct cs5535_gpio_chip *chip = &cs5535_gpio_chip;
133 unsigned long flags;
134 long val;
135
136 spin_lock_irqsave(&chip->lock, flags);
137 if (offset < 16)
138
139 val = inl(chip->base + reg);
140 else {
141
142 val = inl(chip->base + 0x80 + reg);
143 offset -= 16;
144 }
145 spin_unlock_irqrestore(&chip->lock, flags);
146
147 return (val & (1 << offset)) ? 1 : 0;
148}
149EXPORT_SYMBOL_GPL(cs5535_gpio_isset);
150
151int cs5535_gpio_set_irq(unsigned group, unsigned irq)
152{
153 uint32_t lo, hi;
154
155 if (group > 7 || irq > 15)
156 return -EINVAL;
157
158 rdmsr(MSR_PIC_ZSEL_HIGH, lo, hi);
159
160 lo &= ~(0xF << (group * 4));
161 lo |= (irq & 0xF) << (group * 4);
162
163 wrmsr(MSR_PIC_ZSEL_HIGH, lo, hi);
164 return 0;
165}
166EXPORT_SYMBOL_GPL(cs5535_gpio_set_irq);
167
168void cs5535_gpio_setup_event(unsigned offset, int pair, int pme)
169{
170 struct cs5535_gpio_chip *chip = &cs5535_gpio_chip;
171 uint32_t shift = (offset % 8) * 4;
172 unsigned long flags;
173 uint32_t val;
174
175 if (offset >= 24)
176 offset = GPIO_MAP_W;
177 else if (offset >= 16)
178 offset = GPIO_MAP_Z;
179 else if (offset >= 8)
180 offset = GPIO_MAP_Y;
181 else
182 offset = GPIO_MAP_X;
183
184 spin_lock_irqsave(&chip->lock, flags);
185 val = inl(chip->base + offset);
186
187
188 val &= ~(0xF << shift);
189
190
191 val |= ((pair & 7) << shift);
192
193
194 if (pme)
195 val |= (1 << (shift + 3));
196
197 outl(val, chip->base + offset);
198 spin_unlock_irqrestore(&chip->lock, flags);
199}
200EXPORT_SYMBOL_GPL(cs5535_gpio_setup_event);
201
202
203
204
205
206static int chip_gpio_request(struct gpio_chip *c, unsigned offset)
207{
208 struct cs5535_gpio_chip *chip = gpiochip_get_data(c);
209 unsigned long flags;
210
211 spin_lock_irqsave(&chip->lock, flags);
212
213
214 if ((mask & (1 << offset)) == 0) {
215 dev_info(&chip->pdev->dev,
216 "pin %u is not available (check mask)\n", offset);
217 spin_unlock_irqrestore(&chip->lock, flags);
218 return -EINVAL;
219 }
220
221
222 __cs5535_gpio_clear(chip, offset, GPIO_OUTPUT_AUX1);
223 __cs5535_gpio_clear(chip, offset, GPIO_OUTPUT_AUX2);
224
225
226 __cs5535_gpio_clear(chip, offset, GPIO_INPUT_AUX1);
227
228 spin_unlock_irqrestore(&chip->lock, flags);
229
230 return 0;
231}
232
233static int chip_gpio_get(struct gpio_chip *chip, unsigned offset)
234{
235 return cs5535_gpio_isset(offset, GPIO_READ_BACK);
236}
237
238static void chip_gpio_set(struct gpio_chip *chip, unsigned offset, int val)
239{
240 if (val)
241 cs5535_gpio_set(offset, GPIO_OUTPUT_VAL);
242 else
243 cs5535_gpio_clear(offset, GPIO_OUTPUT_VAL);
244}
245
246static int chip_direction_input(struct gpio_chip *c, unsigned offset)
247{
248 struct cs5535_gpio_chip *chip = gpiochip_get_data(c);
249 unsigned long flags;
250
251 spin_lock_irqsave(&chip->lock, flags);
252 __cs5535_gpio_set(chip, offset, GPIO_INPUT_ENABLE);
253 __cs5535_gpio_clear(chip, offset, GPIO_OUTPUT_ENABLE);
254 spin_unlock_irqrestore(&chip->lock, flags);
255
256 return 0;
257}
258
259static int chip_direction_output(struct gpio_chip *c, unsigned offset, int val)
260{
261 struct cs5535_gpio_chip *chip = gpiochip_get_data(c);
262 unsigned long flags;
263
264 spin_lock_irqsave(&chip->lock, flags);
265
266 __cs5535_gpio_set(chip, offset, GPIO_INPUT_ENABLE);
267 __cs5535_gpio_set(chip, offset, GPIO_OUTPUT_ENABLE);
268 if (val)
269 __cs5535_gpio_set(chip, offset, GPIO_OUTPUT_VAL);
270 else
271 __cs5535_gpio_clear(chip, offset, GPIO_OUTPUT_VAL);
272
273 spin_unlock_irqrestore(&chip->lock, flags);
274
275 return 0;
276}
277
278static const char * const cs5535_gpio_names[] = {
279 "GPIO0", "GPIO1", "GPIO2", "GPIO3",
280 "GPIO4", "GPIO5", "GPIO6", "GPIO7",
281 "GPIO8", "GPIO9", "GPIO10", "GPIO11",
282 "GPIO12", "GPIO13", "GPIO14", "GPIO15",
283 "GPIO16", "GPIO17", "GPIO18", "GPIO19",
284 "GPIO20", "GPIO21", "GPIO22", NULL,
285 "GPIO24", "GPIO25", "GPIO26", "GPIO27",
286 "GPIO28", NULL, NULL, NULL,
287};
288
289static struct cs5535_gpio_chip cs5535_gpio_chip = {
290 .chip = {
291 .owner = THIS_MODULE,
292 .label = DRV_NAME,
293
294 .base = 0,
295 .ngpio = 32,
296 .names = cs5535_gpio_names,
297 .request = chip_gpio_request,
298
299 .get = chip_gpio_get,
300 .set = chip_gpio_set,
301
302 .direction_input = chip_direction_input,
303 .direction_output = chip_direction_output,
304 },
305};
306
307static int cs5535_gpio_probe(struct platform_device *pdev)
308{
309 struct resource *res;
310 int err = -EIO;
311 ulong mask_orig = mask;
312
313
314
315
316
317
318
319
320 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
321 if (!res) {
322 dev_err(&pdev->dev, "can't fetch device resource info\n");
323 return err;
324 }
325
326 if (!devm_request_region(&pdev->dev, res->start, resource_size(res),
327 pdev->name)) {
328 dev_err(&pdev->dev, "can't request region\n");
329 return err;
330 }
331
332
333 cs5535_gpio_chip.base = res->start;
334 cs5535_gpio_chip.pdev = pdev;
335 spin_lock_init(&cs5535_gpio_chip.lock);
336
337 dev_info(&pdev->dev, "reserved resource region %pR\n", res);
338
339
340 mask &= 0x1F7FFFFF;
341
342
343
344 mask &= ~(1 << 28);
345
346 if (mask_orig != mask)
347 dev_info(&pdev->dev, "mask changed from 0x%08lX to 0x%08lX\n",
348 mask_orig, mask);
349
350
351 err = devm_gpiochip_add_data(&pdev->dev, &cs5535_gpio_chip.chip,
352 &cs5535_gpio_chip);
353 if (err)
354 return err;
355
356 return 0;
357}
358
359static struct platform_driver cs5535_gpio_driver = {
360 .driver = {
361 .name = DRV_NAME,
362 },
363 .probe = cs5535_gpio_probe,
364};
365
366module_platform_driver(cs5535_gpio_driver);
367
368MODULE_AUTHOR("Andres Salomon <dilinger@queued.net>");
369MODULE_DESCRIPTION("AMD CS5535/CS5536 GPIO driver");
370MODULE_LICENSE("GPL");
371MODULE_ALIAS("platform:" DRV_NAME);
372