/* * vrc4173.c, NEC VRC4173 base driver for NEC VR4122/VR4131. * * Copyright (C) 2001-2003 MontaVista Software Inc. * Author: Yoichi Yuasa * Copyright (C) 2004 Yoichi Yuasa * 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 #include #include #include #include #include #include #include #include MODULE_DESCRIPTION("NEC VRC4173 base driver for NEC VR4122/4131"); MODULE_AUTHOR("Yoichi Yuasa "); 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 DEFINE_SPINLOCK(vrc4173_cmu_lock); static DEFINE_SPINLOCK(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) { struct irq_desc *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) { struct irq_desc *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) { struct irq_desc *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) { struct irq_desc *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) { struct irq_desc *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) { struct irq_desc *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 irq_chip 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].chip = &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_register_driver(&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);