2 * Copyright (C) 2011 LAPIS Semiconductor Co., Ltd.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; version 2 of the License.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
13 * You should have received a copy of the GNU General Public License
14 * along with this program; if not, write to the Free Software
15 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
17 #include <linux/module.h>
18 #include <linux/kernel.h>
19 #include <linux/pci.h>
20 #include <linux/gpio.h>
21 #include <linux/interrupt.h>
22 #include <linux/irq.h>
24 #define PCH_EDGE_FALLING 0
25 #define PCH_EDGE_RISING BIT(0)
26 #define PCH_LEVEL_L BIT(1)
27 #define PCH_LEVEL_H (BIT(0) | BIT(1))
28 #define PCH_EDGE_BOTH BIT(2)
29 #define PCH_IM_MASK (BIT(0) | BIT(1) | BIT(2))
31 #define PCH_IRQ_BASE 24
52 OKISEMI_ML7223m_IOH
, /* LAPIS Semiconductor ML7223 IOH PCIe Bus-m */
53 OKISEMI_ML7223n_IOH
/* LAPIS Semiconductor ML7223 IOH PCIe Bus-n */
56 /* Specifies number of GPIO PINS */
57 static int gpio_pins
[] = {
58 [INTEL_EG20T_PCH
] = 12,
59 [OKISEMI_ML7223m_IOH
] = 8,
60 [OKISEMI_ML7223n_IOH
] = 8,
64 * struct pch_gpio_reg_data - The register store data.
65 * @ien_reg: To store contents of IEN register.
66 * @imask_reg: To store contents of IMASK register.
67 * @po_reg: To store contents of PO register.
68 * @pm_reg: To store contents of PM register.
69 * @im0_reg: To store contents of IM0 register.
70 * @im1_reg: To store contents of IM1 register.
71 * @gpio_use_sel_reg : To store contents of GPIO_USE_SEL register.
74 struct pch_gpio_reg_data
{
85 * struct pch_gpio - GPIO private data structure.
86 * @base: PCI base address of Memory mapped I/O register.
87 * @reg: Memory mapped PCH GPIO register list.
88 * @dev: Pointer to device structure.
89 * @gpio: Data for GPIO infrastructure.
90 * @pch_gpio_reg: Memory mapped Register data is saved here
92 * @lock: Used for register access protection
93 * @irq_base: Save base of IRQ number for interrupt
95 * @spinlock: Used for register access protection
99 struct pch_regs __iomem
*reg
;
101 struct gpio_chip gpio
;
102 struct pch_gpio_reg_data pch_gpio_reg
;
108 static void pch_gpio_set(struct gpio_chip
*gpio
, unsigned nr
, int val
)
111 struct pch_gpio
*chip
= container_of(gpio
, struct pch_gpio
, gpio
);
114 spin_lock_irqsave(&chip
->spinlock
, flags
);
115 reg_val
= ioread32(&chip
->reg
->po
);
117 reg_val
|= (1 << nr
);
119 reg_val
&= ~(1 << nr
);
121 iowrite32(reg_val
, &chip
->reg
->po
);
122 spin_unlock_irqrestore(&chip
->spinlock
, flags
);
125 static int pch_gpio_get(struct gpio_chip
*gpio
, unsigned nr
)
127 struct pch_gpio
*chip
= container_of(gpio
, struct pch_gpio
, gpio
);
129 return ioread32(&chip
->reg
->pi
) & (1 << nr
);
132 static int pch_gpio_direction_output(struct gpio_chip
*gpio
, unsigned nr
,
135 struct pch_gpio
*chip
= container_of(gpio
, struct pch_gpio
, gpio
);
140 spin_lock_irqsave(&chip
->spinlock
, flags
);
141 pm
= ioread32(&chip
->reg
->pm
) & ((1 << gpio_pins
[chip
->ioh
]) - 1);
143 iowrite32(pm
, &chip
->reg
->pm
);
145 reg_val
= ioread32(&chip
->reg
->po
);
147 reg_val
|= (1 << nr
);
149 reg_val
&= ~(1 << nr
);
150 iowrite32(reg_val
, &chip
->reg
->po
);
151 spin_unlock_irqrestore(&chip
->spinlock
, flags
);
156 static int pch_gpio_direction_input(struct gpio_chip
*gpio
, unsigned nr
)
158 struct pch_gpio
*chip
= container_of(gpio
, struct pch_gpio
, gpio
);
162 spin_lock_irqsave(&chip
->spinlock
, flags
);
163 pm
= ioread32(&chip
->reg
->pm
) & ((1 << gpio_pins
[chip
->ioh
]) - 1);
165 iowrite32(pm
, &chip
->reg
->pm
);
166 spin_unlock_irqrestore(&chip
->spinlock
, flags
);
172 * Save register configuration and disable interrupts.
174 static void pch_gpio_save_reg_conf(struct pch_gpio
*chip
)
176 chip
->pch_gpio_reg
.ien_reg
= ioread32(&chip
->reg
->ien
);
177 chip
->pch_gpio_reg
.imask_reg
= ioread32(&chip
->reg
->imask
);
178 chip
->pch_gpio_reg
.po_reg
= ioread32(&chip
->reg
->po
);
179 chip
->pch_gpio_reg
.pm_reg
= ioread32(&chip
->reg
->pm
);
180 chip
->pch_gpio_reg
.im0_reg
= ioread32(&chip
->reg
->im0
);
181 if (chip
->ioh
== INTEL_EG20T_PCH
)
182 chip
->pch_gpio_reg
.im1_reg
= ioread32(&chip
->reg
->im1
);
183 if (chip
->ioh
== OKISEMI_ML7223n_IOH
)
184 chip
->pch_gpio_reg
.gpio_use_sel_reg
=\
185 ioread32(&chip
->reg
->gpio_use_sel
);
189 * This function restores the register configuration of the GPIO device.
191 static void pch_gpio_restore_reg_conf(struct pch_gpio
*chip
)
193 iowrite32(chip
->pch_gpio_reg
.ien_reg
, &chip
->reg
->ien
);
194 iowrite32(chip
->pch_gpio_reg
.imask_reg
, &chip
->reg
->imask
);
195 /* to store contents of PO register */
196 iowrite32(chip
->pch_gpio_reg
.po_reg
, &chip
->reg
->po
);
197 /* to store contents of PM register */
198 iowrite32(chip
->pch_gpio_reg
.pm_reg
, &chip
->reg
->pm
);
199 iowrite32(chip
->pch_gpio_reg
.im0_reg
, &chip
->reg
->im0
);
200 if (chip
->ioh
== INTEL_EG20T_PCH
)
201 iowrite32(chip
->pch_gpio_reg
.im1_reg
, &chip
->reg
->im1
);
202 if (chip
->ioh
== OKISEMI_ML7223n_IOH
)
203 iowrite32(chip
->pch_gpio_reg
.gpio_use_sel_reg
,
204 &chip
->reg
->gpio_use_sel
);
207 static int pch_gpio_to_irq(struct gpio_chip
*gpio
, unsigned offset
)
209 struct pch_gpio
*chip
= container_of(gpio
, struct pch_gpio
, gpio
);
210 return chip
->irq_base
+ offset
;
213 static void pch_gpio_setup(struct pch_gpio
*chip
)
215 struct gpio_chip
*gpio
= &chip
->gpio
;
217 gpio
->label
= dev_name(chip
->dev
);
218 gpio
->dev
= chip
->dev
;
219 gpio
->owner
= THIS_MODULE
;
220 gpio
->direction_input
= pch_gpio_direction_input
;
221 gpio
->get
= pch_gpio_get
;
222 gpio
->direction_output
= pch_gpio_direction_output
;
223 gpio
->set
= pch_gpio_set
;
224 gpio
->dbg_show
= NULL
;
226 gpio
->ngpio
= gpio_pins
[chip
->ioh
];
228 gpio
->to_irq
= pch_gpio_to_irq
;
231 static int pch_irq_type(struct irq_data
*d
, unsigned int type
)
233 struct irq_chip_generic
*gc
= irq_data_get_irq_chip_data(d
);
234 struct pch_gpio
*chip
= gc
->private;
238 int ch
, irq
= d
->irq
;
240 ch
= irq
- chip
->irq_base
;
241 if (irq
<= chip
->irq_base
+ 7) {
242 im_reg
= &chip
->reg
->im0
;
245 im_reg
= &chip
->reg
->im1
;
248 dev_dbg(chip
->dev
, "%s:irq=%d type=%d ch=%d pos=%d\n",
249 __func__
, irq
, type
, ch
, im_pos
);
251 spin_lock_irqsave(&chip
->spinlock
, flags
);
254 case IRQ_TYPE_EDGE_RISING
:
255 val
= PCH_EDGE_RISING
;
257 case IRQ_TYPE_EDGE_FALLING
:
258 val
= PCH_EDGE_FALLING
;
260 case IRQ_TYPE_EDGE_BOTH
:
263 case IRQ_TYPE_LEVEL_HIGH
:
266 case IRQ_TYPE_LEVEL_LOW
:
273 /* Set interrupt mode */
274 im
= ioread32(im_reg
) & ~(PCH_IM_MASK
<< (im_pos
* 4));
275 iowrite32(im
| (val
<< (im_pos
* 4)), im_reg
);
277 /* And the handler */
278 if (type
& (IRQ_TYPE_LEVEL_LOW
| IRQ_TYPE_LEVEL_HIGH
))
279 __irq_set_handler_locked(d
->irq
, handle_level_irq
);
280 else if (type
& (IRQ_TYPE_EDGE_FALLING
| IRQ_TYPE_EDGE_RISING
))
281 __irq_set_handler_locked(d
->irq
, handle_edge_irq
);
284 spin_unlock_irqrestore(&chip
->spinlock
, flags
);
288 static void pch_irq_unmask(struct irq_data
*d
)
290 struct irq_chip_generic
*gc
= irq_data_get_irq_chip_data(d
);
291 struct pch_gpio
*chip
= gc
->private;
293 iowrite32(1 << (d
->irq
- chip
->irq_base
), &chip
->reg
->imaskclr
);
296 static void pch_irq_mask(struct irq_data
*d
)
298 struct irq_chip_generic
*gc
= irq_data_get_irq_chip_data(d
);
299 struct pch_gpio
*chip
= gc
->private;
301 iowrite32(1 << (d
->irq
- chip
->irq_base
), &chip
->reg
->imask
);
304 static void pch_irq_ack(struct irq_data
*d
)
306 struct irq_chip_generic
*gc
= irq_data_get_irq_chip_data(d
);
307 struct pch_gpio
*chip
= gc
->private;
309 iowrite32(1 << (d
->irq
- chip
->irq_base
), &chip
->reg
->iclr
);
312 static irqreturn_t
pch_gpio_handler(int irq
, void *dev_id
)
314 struct pch_gpio
*chip
= dev_id
;
315 u32 reg_val
= ioread32(&chip
->reg
->istatus
);
316 int i
, ret
= IRQ_NONE
;
318 for (i
= 0; i
< gpio_pins
[chip
->ioh
]; i
++) {
319 if (reg_val
& BIT(i
)) {
320 dev_dbg(chip
->dev
, "%s:[%d]:irq=%d status=0x%x\n",
321 __func__
, i
, irq
, reg_val
);
322 generic_handle_irq(chip
->irq_base
+ i
);
329 static void pch_gpio_alloc_generic_chip(struct pch_gpio
*chip
,
330 unsigned int irq_start
, unsigned int num
)
332 struct irq_chip_generic
*gc
;
333 struct irq_chip_type
*ct
;
335 gc
= irq_alloc_generic_chip("pch_gpio", 1, irq_start
, chip
->base
,
340 ct
->chip
.irq_ack
= pch_irq_ack
;
341 ct
->chip
.irq_mask
= pch_irq_mask
;
342 ct
->chip
.irq_unmask
= pch_irq_unmask
;
343 ct
->chip
.irq_set_type
= pch_irq_type
;
345 irq_setup_generic_chip(gc
, IRQ_MSK(num
), IRQ_GC_INIT_MASK_CACHE
,
346 IRQ_NOREQUEST
| IRQ_NOPROBE
, 0);
349 static int pch_gpio_probe(struct pci_dev
*pdev
,
350 const struct pci_device_id
*id
)
353 struct pch_gpio
*chip
;
357 chip
= kzalloc(sizeof(*chip
), GFP_KERNEL
);
361 chip
->dev
= &pdev
->dev
;
362 ret
= pci_enable_device(pdev
);
364 dev_err(&pdev
->dev
, "%s : pci_enable_device FAILED", __func__
);
368 ret
= pci_request_regions(pdev
, KBUILD_MODNAME
);
370 dev_err(&pdev
->dev
, "pci_request_regions FAILED-%d", ret
);
371 goto err_request_regions
;
374 chip
->base
= pci_iomap(pdev
, 1, 0);
376 dev_err(&pdev
->dev
, "%s : pci_iomap FAILED", __func__
);
381 if (pdev
->device
== 0x8803)
382 chip
->ioh
= INTEL_EG20T_PCH
;
383 else if (pdev
->device
== 0x8014)
384 chip
->ioh
= OKISEMI_ML7223m_IOH
;
385 else if (pdev
->device
== 0x8043)
386 chip
->ioh
= OKISEMI_ML7223n_IOH
;
388 chip
->reg
= chip
->base
;
389 pci_set_drvdata(pdev
, chip
);
390 spin_lock_init(&chip
->spinlock
);
391 pch_gpio_setup(chip
);
392 ret
= gpiochip_add(&chip
->gpio
);
394 dev_err(&pdev
->dev
, "PCH gpio: Failed to register GPIO\n");
395 goto err_gpiochip_add
;
398 irq_base
= irq_alloc_descs(-1, 0, gpio_pins
[chip
->ioh
], NUMA_NO_NODE
);
400 dev_warn(&pdev
->dev
, "PCH gpio: Failed to get IRQ base num\n");
404 chip
->irq_base
= irq_base
;
406 /* Mask all interrupts, but enable them */
407 msk
= (1 << gpio_pins
[chip
->ioh
]) - 1;
408 iowrite32(msk
, &chip
->reg
->imask
);
409 iowrite32(msk
, &chip
->reg
->ien
);
411 ret
= request_irq(pdev
->irq
, pch_gpio_handler
,
412 IRQF_SHARED
, KBUILD_MODNAME
, chip
);
415 "%s request_irq failed\n", __func__
);
416 goto err_request_irq
;
419 pch_gpio_alloc_generic_chip(chip
, irq_base
, gpio_pins
[chip
->ioh
]);
425 irq_free_descs(irq_base
, gpio_pins
[chip
->ioh
]);
427 ret
= gpiochip_remove(&chip
->gpio
);
429 dev_err(&pdev
->dev
, "%s gpiochip_remove failed\n", __func__
);
432 pci_iounmap(pdev
, chip
->base
);
435 pci_release_regions(pdev
);
438 pci_disable_device(pdev
);
442 dev_err(&pdev
->dev
, "%s Failed returns %d\n", __func__
, ret
);
446 static void pch_gpio_remove(struct pci_dev
*pdev
)
449 struct pch_gpio
*chip
= pci_get_drvdata(pdev
);
451 if (chip
->irq_base
!= -1) {
452 free_irq(pdev
->irq
, chip
);
454 irq_free_descs(chip
->irq_base
, gpio_pins
[chip
->ioh
]);
457 err
= gpiochip_remove(&chip
->gpio
);
459 dev_err(&pdev
->dev
, "Failed gpiochip_remove\n");
461 pci_iounmap(pdev
, chip
->base
);
462 pci_release_regions(pdev
);
463 pci_disable_device(pdev
);
468 static int pch_gpio_suspend(struct pci_dev
*pdev
, pm_message_t state
)
471 struct pch_gpio
*chip
= pci_get_drvdata(pdev
);
474 spin_lock_irqsave(&chip
->spinlock
, flags
);
475 pch_gpio_save_reg_conf(chip
);
476 spin_unlock_irqrestore(&chip
->spinlock
, flags
);
478 ret
= pci_save_state(pdev
);
480 dev_err(&pdev
->dev
, "pci_save_state Failed-%d\n", ret
);
483 pci_disable_device(pdev
);
484 pci_set_power_state(pdev
, PCI_D0
);
485 ret
= pci_enable_wake(pdev
, PCI_D0
, 1);
487 dev_err(&pdev
->dev
, "pci_enable_wake Failed -%d\n", ret
);
492 static int pch_gpio_resume(struct pci_dev
*pdev
)
495 struct pch_gpio
*chip
= pci_get_drvdata(pdev
);
498 ret
= pci_enable_wake(pdev
, PCI_D0
, 0);
500 pci_set_power_state(pdev
, PCI_D0
);
501 ret
= pci_enable_device(pdev
);
503 dev_err(&pdev
->dev
, "pci_enable_device Failed-%d ", ret
);
506 pci_restore_state(pdev
);
508 spin_lock_irqsave(&chip
->spinlock
, flags
);
509 iowrite32(0x01, &chip
->reg
->reset
);
510 iowrite32(0x00, &chip
->reg
->reset
);
511 pch_gpio_restore_reg_conf(chip
);
512 spin_unlock_irqrestore(&chip
->spinlock
, flags
);
517 #define pch_gpio_suspend NULL
518 #define pch_gpio_resume NULL
521 #define PCI_VENDOR_ID_ROHM 0x10DB
522 static DEFINE_PCI_DEVICE_TABLE(pch_gpio_pcidev_id
) = {
523 { PCI_DEVICE(PCI_VENDOR_ID_INTEL
, 0x8803) },
524 { PCI_DEVICE(PCI_VENDOR_ID_ROHM
, 0x8014) },
525 { PCI_DEVICE(PCI_VENDOR_ID_ROHM
, 0x8043) },
526 { PCI_DEVICE(PCI_VENDOR_ID_ROHM
, 0x8803) },
529 MODULE_DEVICE_TABLE(pci
, pch_gpio_pcidev_id
);
531 static struct pci_driver pch_gpio_driver
= {
533 .id_table
= pch_gpio_pcidev_id
,
534 .probe
= pch_gpio_probe
,
535 .remove
= pch_gpio_remove
,
536 .suspend
= pch_gpio_suspend
,
537 .resume
= pch_gpio_resume
540 module_pci_driver(pch_gpio_driver
);
542 MODULE_DESCRIPTION("PCH GPIO PCI Driver");
543 MODULE_LICENSE("GPL");