| /* |
| * vrc4173.c, NEC VRC4173 base driver for NEC VR4122/VR4131. |
| * |
| * Copyright (C) 2001-2003 MontaVista Software Inc. |
| * Author: Yoichi Yuasa <yyuasa@mvista.com, or source@mvista.com> |
| * Copyright (C) 2004 Yoichi Yuasa <yuasa@hh.iij4u.or.jp> |
| * Copyright (C) 2005 Ralf Baechle (ralf@linux-mips.org) |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| */ |
| #include <linux/init.h> |
| #include <linux/module.h> |
| #include <linux/interrupt.h> |
| #include <linux/irq.h> |
| #include <linux/pci.h> |
| #include <linux/spinlock.h> |
| #include <linux/types.h> |
| |
| #include <asm/vr41xx/vr41xx.h> |
| #include <asm/vr41xx/vrc4173.h> |
| |
| MODULE_DESCRIPTION("NEC VRC4173 base driver for NEC VR4122/4131"); |
| MODULE_AUTHOR("Yoichi Yuasa <yyuasa@mvista.com>"); |
| MODULE_LICENSE("GPL"); |
| |
| #define VRC4173_CMUCLKMSK 0x040 |
| #define MSKPIU 0x0001 |
| #define MSKKIU 0x0002 |
| #define MSKAIU 0x0004 |
| #define MSKPS2CH1 0x0008 |
| #define MSKPS2CH2 0x0010 |
| #define MSKUSB 0x0020 |
| #define MSKCARD1 0x0040 |
| #define MSKCARD2 0x0080 |
| #define MSKAC97 0x0100 |
| #define MSK48MUSB 0x0400 |
| #define MSK48MPIN 0x0800 |
| #define MSK48MOSC 0x1000 |
| #define VRC4173_CMUSRST 0x042 |
| #define USBRST 0x0001 |
| #define CARD1RST 0x0002 |
| #define CARD2RST 0x0004 |
| #define AC97RST 0x0008 |
| |
| #define VRC4173_SYSINT1REG 0x060 |
| #define VRC4173_MSYSINT1REG 0x06c |
| #define VRC4173_MPIUINTREG 0x06e |
| #define VRC4173_MAIUINTREG 0x070 |
| #define VRC4173_MKIUINTREG 0x072 |
| |
| #define VRC4173_SELECTREG 0x09e |
| #define SEL3 0x0008 |
| #define SEL2 0x0004 |
| #define SEL1 0x0002 |
| #define SEL0 0x0001 |
| |
| static struct pci_device_id vrc4173_id_table[] __devinitdata = { |
| { .vendor = PCI_VENDOR_ID_NEC, |
| .device = PCI_DEVICE_ID_NEC_VRC4173, |
| .subvendor = PCI_ANY_ID, |
| .subdevice = PCI_ANY_ID, }, |
| { .vendor = 0, }, |
| }; |
| |
| unsigned long vrc4173_io_offset = 0; |
| |
| EXPORT_SYMBOL(vrc4173_io_offset); |
| |
| static int vrc4173_initialized; |
| static uint16_t vrc4173_cmuclkmsk; |
| static uint16_t vrc4173_selectreg; |
| static spinlock_t vrc4173_cmu_lock; |
| static spinlock_t vrc4173_giu_lock; |
| |
| static inline void set_cmusrst(uint16_t val) |
| { |
| uint16_t cmusrst; |
| |
| cmusrst = vrc4173_inw(VRC4173_CMUSRST); |
| cmusrst |= val; |
| vrc4173_outw(cmusrst, VRC4173_CMUSRST); |
| } |
| |
| static inline void clear_cmusrst(uint16_t val) |
| { |
| uint16_t cmusrst; |
| |
| cmusrst = vrc4173_inw(VRC4173_CMUSRST); |
| cmusrst &= ~val; |
| vrc4173_outw(cmusrst, VRC4173_CMUSRST); |
| } |
| |
| void vrc4173_supply_clock(vrc4173_clock_t clock) |
| { |
| if (vrc4173_initialized) { |
| spin_lock_irq(&vrc4173_cmu_lock); |
| |
| switch (clock) { |
| case VRC4173_PIU_CLOCK: |
| vrc4173_cmuclkmsk |= MSKPIU; |
| break; |
| case VRC4173_KIU_CLOCK: |
| vrc4173_cmuclkmsk |= MSKKIU; |
| break; |
| case VRC4173_AIU_CLOCK: |
| vrc4173_cmuclkmsk |= MSKAIU; |
| break; |
| case VRC4173_PS2_CH1_CLOCK: |
| vrc4173_cmuclkmsk |= MSKPS2CH1; |
| break; |
| case VRC4173_PS2_CH2_CLOCK: |
| vrc4173_cmuclkmsk |= MSKPS2CH2; |
| break; |
| case VRC4173_USBU_PCI_CLOCK: |
| set_cmusrst(USBRST); |
| vrc4173_cmuclkmsk |= MSKUSB; |
| break; |
| case VRC4173_CARDU1_PCI_CLOCK: |
| set_cmusrst(CARD1RST); |
| vrc4173_cmuclkmsk |= MSKCARD1; |
| break; |
| case VRC4173_CARDU2_PCI_CLOCK: |
| set_cmusrst(CARD2RST); |
| vrc4173_cmuclkmsk |= MSKCARD2; |
| break; |
| case VRC4173_AC97U_PCI_CLOCK: |
| set_cmusrst(AC97RST); |
| vrc4173_cmuclkmsk |= MSKAC97; |
| break; |
| case VRC4173_USBU_48MHz_CLOCK: |
| set_cmusrst(USBRST); |
| vrc4173_cmuclkmsk |= MSK48MUSB; |
| break; |
| case VRC4173_EXT_48MHz_CLOCK: |
| if (vrc4173_cmuclkmsk & MSK48MOSC) |
| vrc4173_cmuclkmsk |= MSK48MPIN; |
| else |
| printk(KERN_WARNING |
| "vrc4173_supply_clock: " |
| "Please supply VRC4173_48MHz_CLOCK first " |
| "rather than VRC4173_EXT_48MHz_CLOCK.\n"); |
| break; |
| case VRC4173_48MHz_CLOCK: |
| vrc4173_cmuclkmsk |= MSK48MOSC; |
| break; |
| default: |
| printk(KERN_WARNING |
| "vrc4173_supply_clock: Invalid CLOCK value %u\n", clock); |
| break; |
| } |
| |
| vrc4173_outw(vrc4173_cmuclkmsk, VRC4173_CMUCLKMSK); |
| |
| switch (clock) { |
| case VRC4173_USBU_PCI_CLOCK: |
| case VRC4173_USBU_48MHz_CLOCK: |
| clear_cmusrst(USBRST); |
| break; |
| case VRC4173_CARDU1_PCI_CLOCK: |
| clear_cmusrst(CARD1RST); |
| break; |
| case VRC4173_CARDU2_PCI_CLOCK: |
| clear_cmusrst(CARD2RST); |
| break; |
| case VRC4173_AC97U_PCI_CLOCK: |
| clear_cmusrst(AC97RST); |
| break; |
| default: |
| break; |
| } |
| |
| spin_unlock_irq(&vrc4173_cmu_lock); |
| } |
| } |
| |
| EXPORT_SYMBOL(vrc4173_supply_clock); |
| |
| void vrc4173_mask_clock(vrc4173_clock_t clock) |
| { |
| if (vrc4173_initialized) { |
| spin_lock_irq(&vrc4173_cmu_lock); |
| |
| switch (clock) { |
| case VRC4173_PIU_CLOCK: |
| vrc4173_cmuclkmsk &= ~MSKPIU; |
| break; |
| case VRC4173_KIU_CLOCK: |
| vrc4173_cmuclkmsk &= ~MSKKIU; |
| break; |
| case VRC4173_AIU_CLOCK: |
| vrc4173_cmuclkmsk &= ~MSKAIU; |
| break; |
| case VRC4173_PS2_CH1_CLOCK: |
| vrc4173_cmuclkmsk &= ~MSKPS2CH1; |
| break; |
| case VRC4173_PS2_CH2_CLOCK: |
| vrc4173_cmuclkmsk &= ~MSKPS2CH2; |
| break; |
| case VRC4173_USBU_PCI_CLOCK: |
| set_cmusrst(USBRST); |
| vrc4173_cmuclkmsk &= ~MSKUSB; |
| break; |
| case VRC4173_CARDU1_PCI_CLOCK: |
| set_cmusrst(CARD1RST); |
| vrc4173_cmuclkmsk &= ~MSKCARD1; |
| break; |
| case VRC4173_CARDU2_PCI_CLOCK: |
| set_cmusrst(CARD2RST); |
| vrc4173_cmuclkmsk &= ~MSKCARD2; |
| break; |
| case VRC4173_AC97U_PCI_CLOCK: |
| set_cmusrst(AC97RST); |
| vrc4173_cmuclkmsk &= ~MSKAC97; |
| break; |
| case VRC4173_USBU_48MHz_CLOCK: |
| set_cmusrst(USBRST); |
| vrc4173_cmuclkmsk &= ~MSK48MUSB; |
| break; |
| case VRC4173_EXT_48MHz_CLOCK: |
| vrc4173_cmuclkmsk &= ~MSK48MPIN; |
| break; |
| case VRC4173_48MHz_CLOCK: |
| vrc4173_cmuclkmsk &= ~MSK48MOSC; |
| break; |
| default: |
| printk(KERN_WARNING "vrc4173_mask_clock: Invalid CLOCK value %u\n", clock); |
| break; |
| } |
| |
| vrc4173_outw(vrc4173_cmuclkmsk, VRC4173_CMUCLKMSK); |
| |
| switch (clock) { |
| case VRC4173_USBU_PCI_CLOCK: |
| case VRC4173_USBU_48MHz_CLOCK: |
| clear_cmusrst(USBRST); |
| break; |
| case VRC4173_CARDU1_PCI_CLOCK: |
| clear_cmusrst(CARD1RST); |
| break; |
| case VRC4173_CARDU2_PCI_CLOCK: |
| clear_cmusrst(CARD2RST); |
| break; |
| case VRC4173_AC97U_PCI_CLOCK: |
| clear_cmusrst(AC97RST); |
| break; |
| default: |
| break; |
| } |
| |
| spin_unlock_irq(&vrc4173_cmu_lock); |
| } |
| } |
| |
| EXPORT_SYMBOL(vrc4173_mask_clock); |
| |
| static inline void vrc4173_cmu_init(void) |
| { |
| vrc4173_cmuclkmsk = vrc4173_inw(VRC4173_CMUCLKMSK); |
| |
| spin_lock_init(&vrc4173_cmu_lock); |
| } |
| |
| void vrc4173_select_function(vrc4173_function_t function) |
| { |
| if (vrc4173_initialized) { |
| spin_lock_irq(&vrc4173_giu_lock); |
| |
| switch(function) { |
| case PS2_CHANNEL1: |
| vrc4173_selectreg |= SEL2; |
| break; |
| case PS2_CHANNEL2: |
| vrc4173_selectreg |= SEL1; |
| break; |
| case TOUCHPANEL: |
| vrc4173_selectreg &= SEL2 | SEL1 | SEL0; |
| break; |
| case KEYBOARD_8SCANLINES: |
| vrc4173_selectreg &= SEL3 | SEL2 | SEL1; |
| break; |
| case KEYBOARD_10SCANLINES: |
| vrc4173_selectreg &= SEL3 | SEL2; |
| break; |
| case KEYBOARD_12SCANLINES: |
| vrc4173_selectreg &= SEL3; |
| break; |
| case GPIO_0_15PINS: |
| vrc4173_selectreg |= SEL0; |
| break; |
| case GPIO_16_20PINS: |
| vrc4173_selectreg |= SEL3; |
| break; |
| } |
| |
| vrc4173_outw(vrc4173_selectreg, VRC4173_SELECTREG); |
| |
| spin_unlock_irq(&vrc4173_giu_lock); |
| } |
| } |
| |
| EXPORT_SYMBOL(vrc4173_select_function); |
| |
| static inline void vrc4173_giu_init(void) |
| { |
| vrc4173_selectreg = vrc4173_inw(VRC4173_SELECTREG); |
| |
| spin_lock_init(&vrc4173_giu_lock); |
| } |
| |
| void vrc4173_enable_piuint(uint16_t mask) |
| { |
| irq_desc_t *desc = irq_desc + VRC4173_PIU_IRQ; |
| unsigned long flags; |
| uint16_t val; |
| |
| spin_lock_irqsave(&desc->lock, flags); |
| val = vrc4173_inw(VRC4173_MPIUINTREG); |
| val |= mask; |
| vrc4173_outw(val, VRC4173_MPIUINTREG); |
| spin_unlock_irqrestore(&desc->lock, flags); |
| } |
| |
| EXPORT_SYMBOL(vrc4173_enable_piuint); |
| |
| void vrc4173_disable_piuint(uint16_t mask) |
| { |
| irq_desc_t *desc = irq_desc + VRC4173_PIU_IRQ; |
| unsigned long flags; |
| uint16_t val; |
| |
| spin_lock_irqsave(&desc->lock, flags); |
| val = vrc4173_inw(VRC4173_MPIUINTREG); |
| val &= ~mask; |
| vrc4173_outw(val, VRC4173_MPIUINTREG); |
| spin_unlock_irqrestore(&desc->lock, flags); |
| } |
| |
| EXPORT_SYMBOL(vrc4173_disable_piuint); |
| |
| void vrc4173_enable_aiuint(uint16_t mask) |
| { |
| irq_desc_t *desc = irq_desc + VRC4173_AIU_IRQ; |
| unsigned long flags; |
| uint16_t val; |
| |
| spin_lock_irqsave(&desc->lock, flags); |
| val = vrc4173_inw(VRC4173_MAIUINTREG); |
| val |= mask; |
| vrc4173_outw(val, VRC4173_MAIUINTREG); |
| spin_unlock_irqrestore(&desc->lock, flags); |
| } |
| |
| EXPORT_SYMBOL(vrc4173_enable_aiuint); |
| |
| void vrc4173_disable_aiuint(uint16_t mask) |
| { |
| irq_desc_t *desc = irq_desc + VRC4173_AIU_IRQ; |
| unsigned long flags; |
| uint16_t val; |
| |
| spin_lock_irqsave(&desc->lock, flags); |
| val = vrc4173_inw(VRC4173_MAIUINTREG); |
| val &= ~mask; |
| vrc4173_outw(val, VRC4173_MAIUINTREG); |
| spin_unlock_irqrestore(&desc->lock, flags); |
| } |
| |
| EXPORT_SYMBOL(vrc4173_disable_aiuint); |
| |
| void vrc4173_enable_kiuint(uint16_t mask) |
| { |
| irq_desc_t *desc = irq_desc + VRC4173_KIU_IRQ; |
| unsigned long flags; |
| uint16_t val; |
| |
| spin_lock_irqsave(&desc->lock, flags); |
| val = vrc4173_inw(VRC4173_MKIUINTREG); |
| val |= mask; |
| vrc4173_outw(val, VRC4173_MKIUINTREG); |
| spin_unlock_irqrestore(&desc->lock, flags); |
| } |
| |
| EXPORT_SYMBOL(vrc4173_enable_kiuint); |
| |
| void vrc4173_disable_kiuint(uint16_t mask) |
| { |
| irq_desc_t *desc = irq_desc + VRC4173_KIU_IRQ; |
| unsigned long flags; |
| uint16_t val; |
| |
| spin_lock_irqsave(&desc->lock, flags); |
| val = vrc4173_inw(VRC4173_MKIUINTREG); |
| val &= ~mask; |
| vrc4173_outw(val, VRC4173_MKIUINTREG); |
| spin_unlock_irqrestore(&desc->lock, flags); |
| } |
| |
| EXPORT_SYMBOL(vrc4173_disable_kiuint); |
| |
| static void enable_vrc4173_irq(unsigned int irq) |
| { |
| uint16_t val; |
| |
| val = vrc4173_inw(VRC4173_MSYSINT1REG); |
| val |= (uint16_t)1 << (irq - VRC4173_IRQ_BASE); |
| vrc4173_outw(val, VRC4173_MSYSINT1REG); |
| } |
| |
| static void disable_vrc4173_irq(unsigned int irq) |
| { |
| uint16_t val; |
| |
| val = vrc4173_inw(VRC4173_MSYSINT1REG); |
| val &= ~((uint16_t)1 << (irq - VRC4173_IRQ_BASE)); |
| vrc4173_outw(val, VRC4173_MSYSINT1REG); |
| } |
| |
| static unsigned int startup_vrc4173_irq(unsigned int irq) |
| { |
| enable_vrc4173_irq(irq); |
| return 0; /* never anything pending */ |
| } |
| |
| #define shutdown_vrc4173_irq disable_vrc4173_irq |
| #define ack_vrc4173_irq disable_vrc4173_irq |
| |
| static void end_vrc4173_irq(unsigned int irq) |
| { |
| if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS))) |
| enable_vrc4173_irq(irq); |
| } |
| |
| static struct hw_interrupt_type vrc4173_irq_type = { |
| .typename = "VRC4173", |
| .startup = startup_vrc4173_irq, |
| .shutdown = shutdown_vrc4173_irq, |
| .enable = enable_vrc4173_irq, |
| .disable = disable_vrc4173_irq, |
| .ack = ack_vrc4173_irq, |
| .end = end_vrc4173_irq, |
| }; |
| |
| static int vrc4173_get_irq_number(int irq) |
| { |
| uint16_t status, mask; |
| int i; |
| |
| status = vrc4173_inw(VRC4173_SYSINT1REG); |
| mask = vrc4173_inw(VRC4173_MSYSINT1REG); |
| |
| status &= mask; |
| if (status) { |
| for (i = 0; i < 16; i++) |
| if (status & (0x0001 << i)) |
| return VRC4173_IRQ(i); |
| } |
| |
| return -EINVAL; |
| } |
| |
| static inline int vrc4173_icu_init(int cascade_irq) |
| { |
| int i; |
| |
| if (cascade_irq < GIU_IRQ(0) || cascade_irq > GIU_IRQ(15)) |
| return -EINVAL; |
| |
| vrc4173_outw(0, VRC4173_MSYSINT1REG); |
| |
| vr41xx_set_irq_trigger(GIU_IRQ_TO_PIN(cascade_irq), TRIGGER_LEVEL, SIGNAL_THROUGH); |
| vr41xx_set_irq_level(GIU_IRQ_TO_PIN(cascade_irq), LEVEL_LOW); |
| |
| for (i = VRC4173_IRQ_BASE; i <= VRC4173_IRQ_LAST; i++) |
| irq_desc[i].handler = &vrc4173_irq_type; |
| |
| return 0; |
| } |
| |
| static int __devinit vrc4173_probe(struct pci_dev *dev, |
| const struct pci_device_id *id) |
| { |
| unsigned long start, flags; |
| int err; |
| |
| err = pci_enable_device(dev); |
| if (err < 0) { |
| printk(KERN_ERR "vrc4173: Failed to enable PCI device, aborting\n"); |
| return err; |
| } |
| |
| pci_set_master(dev); |
| |
| start = pci_resource_start(dev, 0); |
| if (start == 0) { |
| printk(KERN_ERR "vrc4173:No such PCI I/O resource, aborting\n"); |
| return -ENXIO; |
| } |
| |
| flags = pci_resource_flags(dev, 0); |
| if ((flags & IORESOURCE_IO) == 0) { |
| printk(KERN_ERR "vrc4173: No such PCI I/O resource, aborting\n"); |
| return -ENXIO; |
| } |
| |
| err = pci_request_regions(dev, "NEC VRC4173"); |
| if (err < 0) { |
| printk(KERN_ERR "vrc4173: PCI resources are busy, aborting\n"); |
| return err; |
| } |
| |
| set_vrc4173_io_offset(start); |
| |
| vrc4173_cmu_init(); |
| vrc4173_giu_init(); |
| |
| err = vrc4173_icu_init(dev->irq); |
| if (err < 0) { |
| printk(KERN_ERR "vrc4173: Invalid IRQ %d, aborting\n", dev->irq); |
| return err; |
| } |
| |
| err = vr41xx_cascade_irq(dev->irq, vrc4173_get_irq_number); |
| if (err < 0) { |
| printk(KERN_ERR "vrc4173: IRQ resource %d is busy, aborting\n", dev->irq); |
| return err; |
| } |
| |
| printk(KERN_INFO |
| "NEC VRC4173 at 0x%#08lx, IRQ is cascaded to %d\n", start, dev->irq); |
| |
| return 0; |
| } |
| |
| static void vrc4173_remove(struct pci_dev *dev) |
| { |
| free_irq(dev->irq, NULL); |
| |
| pci_release_regions(dev); |
| } |
| |
| static struct pci_driver vrc4173_driver = { |
| .name = "NEC VRC4173", |
| .probe = vrc4173_probe, |
| .remove = vrc4173_remove, |
| .id_table = vrc4173_id_table, |
| }; |
| |
| static int __devinit vrc4173_init(void) |
| { |
| int err; |
| |
| err = pci_module_init(&vrc4173_driver); |
| if (err < 0) |
| return err; |
| |
| vrc4173_initialized = 1; |
| |
| return 0; |
| } |
| |
| static void __devexit vrc4173_exit(void) |
| { |
| vrc4173_initialized = 0; |
| |
| pci_unregister_driver(&vrc4173_driver); |
| } |
| |
| module_init(vrc4173_init); |
| module_exit(vrc4173_exit); |
