1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/module.h>
24#include <linux/pci.h>
25#include <linux/platform_device.h>
26#include <linux/kernel.h>
27#include <linux/delay.h>
28#include <linux/stddef.h>
29#include <linux/interrupt.h>
30#include <linux/init.h>
31#include <linux/io.h>
32#include <linux/gpio/driver.h>
33#include <linux/slab.h>
34#include <linux/pm_runtime.h>
35
36#define INTEL_MID_IRQ_TYPE_EDGE (1 << 0)
37#define INTEL_MID_IRQ_TYPE_LEVEL (1 << 1)
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53enum GPIO_REG {
54 GPLR = 0,
55 GPDR,
56 GPSR,
57 GPCR,
58 GRER,
59 GFER,
60 GEDR,
61 GAFR,
62};
63
64
65struct intel_mid_gpio_ddata {
66 u16 ngpio;
67 u32 gplr_offset;
68 u32 flis_base;
69 u32 flis_len;
70 u32 (*get_flis_offset)(int gpio);
71 u32 chip_irq_type;
72};
73
74struct intel_mid_gpio {
75 struct gpio_chip chip;
76 void __iomem *reg_base;
77 spinlock_t lock;
78 struct pci_dev *pdev;
79};
80
81static void __iomem *gpio_reg(struct gpio_chip *chip, unsigned offset,
82 enum GPIO_REG reg_type)
83{
84 struct intel_mid_gpio *priv = gpiochip_get_data(chip);
85 unsigned nreg = chip->ngpio / 32;
86 u8 reg = offset / 32;
87
88 return priv->reg_base + reg_type * nreg * 4 + reg * 4;
89}
90
91static void __iomem *gpio_reg_2bit(struct gpio_chip *chip, unsigned offset,
92 enum GPIO_REG reg_type)
93{
94 struct intel_mid_gpio *priv = gpiochip_get_data(chip);
95 unsigned nreg = chip->ngpio / 32;
96 u8 reg = offset / 16;
97
98 return priv->reg_base + reg_type * nreg * 4 + reg * 4;
99}
100
101static int intel_gpio_request(struct gpio_chip *chip, unsigned offset)
102{
103 void __iomem *gafr = gpio_reg_2bit(chip, offset, GAFR);
104 u32 value = readl(gafr);
105 int shift = (offset % 16) << 1, af = (value >> shift) & 3;
106
107 if (af) {
108 value &= ~(3 << shift);
109 writel(value, gafr);
110 }
111 return 0;
112}
113
114static int intel_gpio_get(struct gpio_chip *chip, unsigned offset)
115{
116 void __iomem *gplr = gpio_reg(chip, offset, GPLR);
117
118 return !!(readl(gplr) & BIT(offset % 32));
119}
120
121static void intel_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
122{
123 void __iomem *gpsr, *gpcr;
124
125 if (value) {
126 gpsr = gpio_reg(chip, offset, GPSR);
127 writel(BIT(offset % 32), gpsr);
128 } else {
129 gpcr = gpio_reg(chip, offset, GPCR);
130 writel(BIT(offset % 32), gpcr);
131 }
132}
133
134static int intel_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
135{
136 struct intel_mid_gpio *priv = gpiochip_get_data(chip);
137 void __iomem *gpdr = gpio_reg(chip, offset, GPDR);
138 u32 value;
139 unsigned long flags;
140
141 if (priv->pdev)
142 pm_runtime_get(&priv->pdev->dev);
143
144 spin_lock_irqsave(&priv->lock, flags);
145 value = readl(gpdr);
146 value &= ~BIT(offset % 32);
147 writel(value, gpdr);
148 spin_unlock_irqrestore(&priv->lock, flags);
149
150 if (priv->pdev)
151 pm_runtime_put(&priv->pdev->dev);
152
153 return 0;
154}
155
156static int intel_gpio_direction_output(struct gpio_chip *chip,
157 unsigned offset, int value)
158{
159 struct intel_mid_gpio *priv = gpiochip_get_data(chip);
160 void __iomem *gpdr = gpio_reg(chip, offset, GPDR);
161 unsigned long flags;
162
163 intel_gpio_set(chip, offset, value);
164
165 if (priv->pdev)
166 pm_runtime_get(&priv->pdev->dev);
167
168 spin_lock_irqsave(&priv->lock, flags);
169 value = readl(gpdr);
170 value |= BIT(offset % 32);
171 writel(value, gpdr);
172 spin_unlock_irqrestore(&priv->lock, flags);
173
174 if (priv->pdev)
175 pm_runtime_put(&priv->pdev->dev);
176
177 return 0;
178}
179
180static int intel_mid_irq_type(struct irq_data *d, unsigned type)
181{
182 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
183 struct intel_mid_gpio *priv = gpiochip_get_data(gc);
184 u32 gpio = irqd_to_hwirq(d);
185 unsigned long flags;
186 u32 value;
187 void __iomem *grer = gpio_reg(&priv->chip, gpio, GRER);
188 void __iomem *gfer = gpio_reg(&priv->chip, gpio, GFER);
189
190 if (gpio >= priv->chip.ngpio)
191 return -EINVAL;
192
193 if (priv->pdev)
194 pm_runtime_get(&priv->pdev->dev);
195
196 spin_lock_irqsave(&priv->lock, flags);
197 if (type & IRQ_TYPE_EDGE_RISING)
198 value = readl(grer) | BIT(gpio % 32);
199 else
200 value = readl(grer) & (~BIT(gpio % 32));
201 writel(value, grer);
202
203 if (type & IRQ_TYPE_EDGE_FALLING)
204 value = readl(gfer) | BIT(gpio % 32);
205 else
206 value = readl(gfer) & (~BIT(gpio % 32));
207 writel(value, gfer);
208 spin_unlock_irqrestore(&priv->lock, flags);
209
210 if (priv->pdev)
211 pm_runtime_put(&priv->pdev->dev);
212
213 return 0;
214}
215
216static void intel_mid_irq_unmask(struct irq_data *d)
217{
218}
219
220static void intel_mid_irq_mask(struct irq_data *d)
221{
222}
223
224static struct irq_chip intel_mid_irqchip = {
225 .name = "INTEL_MID-GPIO",
226 .irq_mask = intel_mid_irq_mask,
227 .irq_unmask = intel_mid_irq_unmask,
228 .irq_set_type = intel_mid_irq_type,
229};
230
231static const struct intel_mid_gpio_ddata gpio_lincroft = {
232 .ngpio = 64,
233};
234
235static const struct intel_mid_gpio_ddata gpio_penwell_aon = {
236 .ngpio = 96,
237 .chip_irq_type = INTEL_MID_IRQ_TYPE_EDGE,
238};
239
240static const struct intel_mid_gpio_ddata gpio_penwell_core = {
241 .ngpio = 96,
242 .chip_irq_type = INTEL_MID_IRQ_TYPE_EDGE,
243};
244
245static const struct intel_mid_gpio_ddata gpio_cloverview_aon = {
246 .ngpio = 96,
247 .chip_irq_type = INTEL_MID_IRQ_TYPE_EDGE | INTEL_MID_IRQ_TYPE_LEVEL,
248};
249
250static const struct intel_mid_gpio_ddata gpio_cloverview_core = {
251 .ngpio = 96,
252 .chip_irq_type = INTEL_MID_IRQ_TYPE_EDGE,
253};
254
255static const struct intel_mid_gpio_ddata gpio_tangier = {
256 .ngpio = 192,
257 .gplr_offset = 4,
258 .flis_base = 0xff0c0000,
259 .flis_len = 0x8000,
260 .get_flis_offset = NULL,
261 .chip_irq_type = INTEL_MID_IRQ_TYPE_EDGE,
262};
263
264static const struct pci_device_id intel_gpio_ids[] = {
265 {
266
267 PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x080f),
268 .driver_data = (kernel_ulong_t)&gpio_lincroft,
269 },
270 {
271
272 PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x081f),
273 .driver_data = (kernel_ulong_t)&gpio_penwell_aon,
274 },
275 {
276
277 PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x081a),
278 .driver_data = (kernel_ulong_t)&gpio_penwell_core,
279 },
280 {
281
282 PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x08eb),
283 .driver_data = (kernel_ulong_t)&gpio_cloverview_aon,
284 },
285 {
286
287 PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x08f7),
288 .driver_data = (kernel_ulong_t)&gpio_cloverview_core,
289 },
290 {
291
292 PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x1199),
293 .driver_data = (kernel_ulong_t)&gpio_tangier,
294 },
295 { 0 }
296};
297MODULE_DEVICE_TABLE(pci, intel_gpio_ids);
298
299static void intel_mid_irq_handler(struct irq_desc *desc)
300{
301 struct gpio_chip *gc = irq_desc_get_handler_data(desc);
302 struct intel_mid_gpio *priv = gpiochip_get_data(gc);
303 struct irq_data *data = irq_desc_get_irq_data(desc);
304 struct irq_chip *chip = irq_data_get_irq_chip(data);
305 u32 base, gpio, mask;
306 unsigned long pending;
307 void __iomem *gedr;
308
309
310 for (base = 0; base < priv->chip.ngpio; base += 32) {
311 gedr = gpio_reg(&priv->chip, base, GEDR);
312 while ((pending = readl(gedr))) {
313 gpio = __ffs(pending);
314 mask = BIT(gpio);
315
316 writel(mask, gedr);
317 generic_handle_irq(irq_find_mapping(gc->irqdomain,
318 base + gpio));
319 }
320 }
321
322 chip->irq_eoi(data);
323}
324
325static void intel_mid_irq_init_hw(struct intel_mid_gpio *priv)
326{
327 void __iomem *reg;
328 unsigned base;
329
330 for (base = 0; base < priv->chip.ngpio; base += 32) {
331
332 reg = gpio_reg(&priv->chip, base, GRER);
333 writel(0, reg);
334
335 reg = gpio_reg(&priv->chip, base, GFER);
336 writel(0, reg);
337
338 reg = gpio_reg(&priv->chip, base, GEDR);
339 writel(~0, reg);
340 }
341}
342
343static int intel_gpio_runtime_idle(struct device *dev)
344{
345 int err = pm_schedule_suspend(dev, 500);
346 return err ?: -EBUSY;
347}
348
349static const struct dev_pm_ops intel_gpio_pm_ops = {
350 SET_RUNTIME_PM_OPS(NULL, NULL, intel_gpio_runtime_idle)
351};
352
353static int intel_gpio_probe(struct pci_dev *pdev,
354 const struct pci_device_id *id)
355{
356 void __iomem *base;
357 struct intel_mid_gpio *priv;
358 u32 gpio_base;
359 u32 irq_base;
360 int retval;
361 struct intel_mid_gpio_ddata *ddata =
362 (struct intel_mid_gpio_ddata *)id->driver_data;
363
364 retval = pcim_enable_device(pdev);
365 if (retval)
366 return retval;
367
368 retval = pcim_iomap_regions(pdev, 1 << 0 | 1 << 1, pci_name(pdev));
369 if (retval) {
370 dev_err(&pdev->dev, "I/O memory mapping error\n");
371 return retval;
372 }
373
374 base = pcim_iomap_table(pdev)[1];
375
376 irq_base = readl(base);
377 gpio_base = readl(sizeof(u32) + base);
378
379
380 pcim_iounmap_regions(pdev, 1 << 1);
381
382 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
383 if (!priv) {
384 dev_err(&pdev->dev, "can't allocate chip data\n");
385 return -ENOMEM;
386 }
387
388 priv->reg_base = pcim_iomap_table(pdev)[0];
389 priv->chip.label = dev_name(&pdev->dev);
390 priv->chip.parent = &pdev->dev;
391 priv->chip.request = intel_gpio_request;
392 priv->chip.direction_input = intel_gpio_direction_input;
393 priv->chip.direction_output = intel_gpio_direction_output;
394 priv->chip.get = intel_gpio_get;
395 priv->chip.set = intel_gpio_set;
396 priv->chip.base = gpio_base;
397 priv->chip.ngpio = ddata->ngpio;
398 priv->chip.can_sleep = false;
399 priv->pdev = pdev;
400
401 spin_lock_init(&priv->lock);
402
403 pci_set_drvdata(pdev, priv);
404 retval = gpiochip_add_data(&priv->chip, priv);
405 if (retval) {
406 dev_err(&pdev->dev, "gpiochip_add error %d\n", retval);
407 return retval;
408 }
409
410 retval = gpiochip_irqchip_add(&priv->chip,
411 &intel_mid_irqchip,
412 irq_base,
413 handle_simple_irq,
414 IRQ_TYPE_NONE);
415 if (retval) {
416 dev_err(&pdev->dev,
417 "could not connect irqchip to gpiochip\n");
418 return retval;
419 }
420
421 intel_mid_irq_init_hw(priv);
422
423 gpiochip_set_chained_irqchip(&priv->chip,
424 &intel_mid_irqchip,
425 pdev->irq,
426 intel_mid_irq_handler);
427
428 pm_runtime_put_noidle(&pdev->dev);
429 pm_runtime_allow(&pdev->dev);
430
431 return 0;
432}
433
434static struct pci_driver intel_gpio_driver = {
435 .name = "intel_mid_gpio",
436 .id_table = intel_gpio_ids,
437 .probe = intel_gpio_probe,
438 .driver = {
439 .pm = &intel_gpio_pm_ops,
440 },
441};
442
443static int __init intel_gpio_init(void)
444{
445 return pci_register_driver(&intel_gpio_driver);
446}
447
448device_initcall(intel_gpio_init);
449