2 * $Id: setup.c,v 1.4 2003/08/03 03:05:10 lethal Exp $
4 * Setup and IRQ handling code for the HD64465 companion chip.
5 * by Greg Banks <gbanks@pocketpenguins.com>
6 * Copyright (c) 2000 PocketPenguins Inc
8 * Derived from setup_hd64461.c which bore the message:
9 * Copyright (C) 2000 YAEGASHI Takeshi
12 #include <linux/sched.h>
13 #include <linux/module.h>
14 #include <linux/kernel.h>
15 #include <linux/param.h>
16 #include <linux/ioport.h>
17 #include <linux/interrupt.h>
18 #include <linux/init.h>
19 #include <linux/irq.h>
24 #include <asm/hd64465/hd64465.h>
26 static void disable_hd64465_irq(unsigned int irq)
30 unsigned short mask = 1 << (irq - HD64465_IRQ_BASE);
32 pr_debug("disable_hd64465_irq(%d): mask=%x\n", irq, mask);
33 local_irq_save(flags);
34 nimr = inw(HD64465_REG_NIMR);
36 outw(nimr, HD64465_REG_NIMR);
37 local_irq_restore(flags);
41 static void enable_hd64465_irq(unsigned int irq)
45 unsigned short mask = 1 << (irq - HD64465_IRQ_BASE);
47 pr_debug("enable_hd64465_irq(%d): mask=%x\n", irq, mask);
48 local_irq_save(flags);
49 nimr = inw(HD64465_REG_NIMR);
51 outw(nimr, HD64465_REG_NIMR);
52 local_irq_restore(flags);
56 static void mask_and_ack_hd64465(unsigned int irq)
58 disable_hd64465_irq(irq);
62 static void end_hd64465_irq(unsigned int irq)
64 if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS)))
65 enable_hd64465_irq(irq);
69 static unsigned int startup_hd64465_irq(unsigned int irq)
71 enable_hd64465_irq(irq);
76 static void shutdown_hd64465_irq(unsigned int irq)
78 disable_hd64465_irq(irq);
82 static struct hw_interrupt_type hd64465_irq_type = {
83 .typename = "HD64465-IRQ",
84 .startup = startup_hd64465_irq,
85 .shutdown = shutdown_hd64465_irq,
86 .enable = enable_hd64465_irq,
87 .disable = disable_hd64465_irq,
88 .ack = mask_and_ack_hd64465,
89 .end = end_hd64465_irq,
93 static irqreturn_t hd64465_interrupt(int irq, void *dev_id, struct pt_regs *regs)
96 "HD64465: spurious interrupt, nirr: 0x%x nimr: 0x%x\n",
97 inw(HD64465_REG_NIRR), inw(HD64465_REG_NIMR));
103 /*====================================================*/
106 * Support for a secondary IRQ demux step. This is necessary
107 * because the HD64465 presents a very thin interface to the
108 * PCMCIA bus; a lot of features (such as remapping interrupts)
109 * normally done in hardware by other PCMCIA host bridges is
110 * instead done in software.
114 int (*func)(int, void *);
116 } hd64465_demux[HD64465_IRQ_NUM];
118 void hd64465_register_irq_demux(int irq,
119 int (*demux)(int irq, void *dev), void *dev)
121 hd64465_demux[irq - HD64465_IRQ_BASE].func = demux;
122 hd64465_demux[irq - HD64465_IRQ_BASE].dev = dev;
124 EXPORT_SYMBOL(hd64465_register_irq_demux);
126 void hd64465_unregister_irq_demux(int irq)
128 hd64465_demux[irq - HD64465_IRQ_BASE].func = 0;
130 EXPORT_SYMBOL(hd64465_unregister_irq_demux);
134 int hd64465_irq_demux(int irq)
136 if (irq == CONFIG_HD64465_IRQ) {
137 unsigned short i, bit;
138 unsigned short nirr = inw(HD64465_REG_NIRR);
139 unsigned short nimr = inw(HD64465_REG_NIMR);
141 pr_debug("hd64465_irq_demux, nirr=%04x, nimr=%04x\n", nirr, nimr);
143 for (bit = 1, i = 0 ; i < HD64465_IRQ_NUM ; bit <<= 1, i++)
147 if (i < HD64465_IRQ_NUM) {
148 irq = HD64465_IRQ_BASE + i;
149 if (hd64465_demux[i].func != 0)
150 irq = hd64465_demux[i].func(irq, hd64465_demux[i].dev);
156 static struct irqaction irq0 = { hd64465_interrupt, IRQF_DISABLED, CPU_MASK_NONE, "HD64465", NULL, NULL};
159 static int __init setup_hd64465(void)
163 unsigned short smscr;
168 printk(KERN_INFO "HD64465 configured at 0x%x on irq %d(mapped into %d to %d)\n",
169 CONFIG_HD64465_IOBASE,
172 HD64465_IRQ_BASE+HD64465_IRQ_NUM-1);
174 if (inw(HD64465_REG_SDID) != HD64465_SDID) {
175 printk(KERN_ERR "HD64465 device ID not found, check base address\n");
178 rev = inw(HD64465_REG_SRR);
179 printk(KERN_INFO "HD64465 hardware revision %d.%d\n", (rev >> 8) & 0xff, rev & 0xff);
181 outw(0xffff, HD64465_REG_NIMR); /* mask all interrupts */
183 for (i = 0; i < HD64465_IRQ_NUM ; i++) {
184 irq_desc[HD64465_IRQ_BASE + i].chip = &hd64465_irq_type;
187 setup_irq(CONFIG_HD64465_IRQ, &irq0);
190 /* wake up the UART from STANDBY at this point */
191 smscr = inw(HD64465_REG_SMSCR);
192 outw(smscr & (~HD64465_SMSCR_UARTST), HD64465_REG_SMSCR);
194 /* remap IO ports for first ISA serial port to HD64465 UART */
195 hd64465_port_map(0x3f8, 8, CONFIG_HD64465_IOBASE + 0x8000, 1);
201 module_init(setup_hd64465);