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
)
29 unsigned short mask
= 1 << (irq
- HD64465_IRQ_BASE
);
31 pr_debug("disable_hd64465_irq(%d): mask=%x\n", irq
, mask
);
32 nimr
= inw(HD64465_REG_NIMR
);
34 outw(nimr
, HD64465_REG_NIMR
);
38 static void enable_hd64465_irq(unsigned int irq
)
41 unsigned short mask
= 1 << (irq
- HD64465_IRQ_BASE
);
43 pr_debug("enable_hd64465_irq(%d): mask=%x\n", irq
, mask
);
44 nimr
= inw(HD64465_REG_NIMR
);
46 outw(nimr
, HD64465_REG_NIMR
);
50 static void mask_and_ack_hd64465(unsigned int irq
)
52 disable_hd64465_irq(irq
);
56 static void end_hd64465_irq(unsigned int irq
)
58 if (!(irq_desc
[irq
].status
& (IRQ_DISABLED
|IRQ_INPROGRESS
)))
59 enable_hd64465_irq(irq
);
63 static unsigned int startup_hd64465_irq(unsigned int irq
)
65 enable_hd64465_irq(irq
);
70 static void shutdown_hd64465_irq(unsigned int irq
)
72 disable_hd64465_irq(irq
);
76 static struct hw_interrupt_type hd64465_irq_type
= {
77 .typename
= "HD64465-IRQ",
78 .startup
= startup_hd64465_irq
,
79 .shutdown
= shutdown_hd64465_irq
,
80 .enable
= enable_hd64465_irq
,
81 .disable
= disable_hd64465_irq
,
82 .ack
= mask_and_ack_hd64465
,
83 .end
= end_hd64465_irq
,
87 static irqreturn_t
hd64465_interrupt(int irq
, void *dev_id
)
90 "HD64465: spurious interrupt, nirr: 0x%x nimr: 0x%x\n",
91 inw(HD64465_REG_NIRR
), inw(HD64465_REG_NIMR
));
97 /*====================================================*/
100 * Support for a secondary IRQ demux step. This is necessary
101 * because the HD64465 presents a very thin interface to the
102 * PCMCIA bus; a lot of features (such as remapping interrupts)
103 * normally done in hardware by other PCMCIA host bridges is
104 * instead done in software.
108 int (*func
)(int, void *);
110 } hd64465_demux
[HD64465_IRQ_NUM
];
112 void hd64465_register_irq_demux(int irq
,
113 int (*demux
)(int irq
, void *dev
), void *dev
)
115 hd64465_demux
[irq
- HD64465_IRQ_BASE
].func
= demux
;
116 hd64465_demux
[irq
- HD64465_IRQ_BASE
].dev
= dev
;
118 EXPORT_SYMBOL(hd64465_register_irq_demux
);
120 void hd64465_unregister_irq_demux(int irq
)
122 hd64465_demux
[irq
- HD64465_IRQ_BASE
].func
= 0;
124 EXPORT_SYMBOL(hd64465_unregister_irq_demux
);
128 int hd64465_irq_demux(int irq
)
130 if (irq
== CONFIG_HD64465_IRQ
) {
131 unsigned short i
, bit
;
132 unsigned short nirr
= inw(HD64465_REG_NIRR
);
133 unsigned short nimr
= inw(HD64465_REG_NIMR
);
135 pr_debug("hd64465_irq_demux, nirr=%04x, nimr=%04x\n", nirr
, nimr
);
137 for (bit
= 1, i
= 0 ; i
< HD64465_IRQ_NUM
; bit
<<= 1, i
++)
141 if (i
< HD64465_IRQ_NUM
) {
142 irq
= HD64465_IRQ_BASE
+ i
;
143 if (hd64465_demux
[i
].func
!= 0)
144 irq
= hd64465_demux
[i
].func(irq
, hd64465_demux
[i
].dev
);
150 static struct irqaction irq0
= { hd64465_interrupt
, IRQF_DISABLED
, CPU_MASK_NONE
, "HD64465", NULL
, NULL
};
153 static int __init
setup_hd64465(void)
157 unsigned short smscr
;
162 printk(KERN_INFO
"HD64465 configured at 0x%x on irq %d(mapped into %d to %d)\n",
163 CONFIG_HD64465_IOBASE
,
166 HD64465_IRQ_BASE
+HD64465_IRQ_NUM
-1);
168 if (inw(HD64465_REG_SDID
) != HD64465_SDID
) {
169 printk(KERN_ERR
"HD64465 device ID not found, check base address\n");
172 rev
= inw(HD64465_REG_SRR
);
173 printk(KERN_INFO
"HD64465 hardware revision %d.%d\n", (rev
>> 8) & 0xff, rev
& 0xff);
175 outw(0xffff, HD64465_REG_NIMR
); /* mask all interrupts */
177 for (i
= 0; i
< HD64465_IRQ_NUM
; i
++) {
178 irq_desc
[HD64465_IRQ_BASE
+ i
].chip
= &hd64465_irq_type
;
181 setup_irq(CONFIG_HD64465_IRQ
, &irq0
);
184 /* wake up the UART from STANDBY at this point */
185 smscr
= inw(HD64465_REG_SMSCR
);
186 outw(smscr
& (~HD64465_SMSCR_UARTST
), HD64465_REG_SMSCR
);
188 /* remap IO ports for first ISA serial port to HD64465 UART */
189 hd64465_port_map(0x3f8, 8, CONFIG_HD64465_IOBASE
+ 0x8000, 1);
195 module_init(setup_hd64465
);