diff options
author | David S. Miller <davem@davemloft.net> | 2008-11-07 01:43:03 -0500 |
---|---|---|
committer | David S. Miller <davem@davemloft.net> | 2008-11-07 01:43:03 -0500 |
commit | 9eeda9abd1faf489f3df9a1f557975f4c8650363 (patch) | |
tree | 3e0a58e25b776cfbee193195460324dccb1886c7 /arch/sh/cchips/hd6446x | |
parent | 61c9eaf90081cbe6dc4f389e0056bff76eca19ec (diff) | |
parent | 4bab0ea1d42dd1927af9df6fbf0003fc00617c50 (diff) |
Merge branch 'master' of master.kernel.org:/pub/scm/linux/kernel/git/davem/net-2.6
Conflicts:
drivers/net/wireless/ath5k/base.c
net/8021q/vlan_core.c
Diffstat (limited to 'arch/sh/cchips/hd6446x')
-rw-r--r-- | arch/sh/cchips/hd6446x/Makefile | 1 | ||||
-rw-r--r-- | arch/sh/cchips/hd6446x/hd64465/Makefile | 6 | ||||
-rw-r--r-- | arch/sh/cchips/hd6446x/hd64465/gpio.c | 196 | ||||
-rw-r--r-- | arch/sh/cchips/hd6446x/hd64465/io.c | 211 | ||||
-rw-r--r-- | arch/sh/cchips/hd6446x/hd64465/setup.c | 181 |
5 files changed, 0 insertions, 595 deletions
diff --git a/arch/sh/cchips/hd6446x/Makefile b/arch/sh/cchips/hd6446x/Makefile index f7de4076e242..9682e3ab668f 100644 --- a/arch/sh/cchips/hd6446x/Makefile +++ b/arch/sh/cchips/hd6446x/Makefile | |||
@@ -1,4 +1,3 @@ | |||
1 | obj-$(CONFIG_HD64461) += hd64461.o | 1 | obj-$(CONFIG_HD64461) += hd64461.o |
2 | obj-$(CONFIG_HD64465) += hd64465/ | ||
3 | 2 | ||
4 | EXTRA_CFLAGS += -Werror | 3 | EXTRA_CFLAGS += -Werror |
diff --git a/arch/sh/cchips/hd6446x/hd64465/Makefile b/arch/sh/cchips/hd6446x/hd64465/Makefile deleted file mode 100644 index f66edcb52c5b..000000000000 --- a/arch/sh/cchips/hd6446x/hd64465/Makefile +++ /dev/null | |||
@@ -1,6 +0,0 @@ | |||
1 | # | ||
2 | # Makefile for the HD64465 | ||
3 | # | ||
4 | |||
5 | obj-y := setup.o io.o gpio.o | ||
6 | |||
diff --git a/arch/sh/cchips/hd6446x/hd64465/gpio.c b/arch/sh/cchips/hd6446x/hd64465/gpio.c deleted file mode 100644 index 43431855ec86..000000000000 --- a/arch/sh/cchips/hd6446x/hd64465/gpio.c +++ /dev/null | |||
@@ -1,196 +0,0 @@ | |||
1 | /* | ||
2 | * $Id: gpio.c,v 1.4 2003/05/19 22:24:18 lethal Exp $ | ||
3 | * by Greg Banks <gbanks@pocketpenguins.com> | ||
4 | * (c) 2000 PocketPenguins Inc | ||
5 | * | ||
6 | * GPIO pin support for HD64465 companion chip. | ||
7 | */ | ||
8 | |||
9 | #include <linux/kernel.h> | ||
10 | #include <linux/init.h> | ||
11 | #include <linux/module.h> | ||
12 | #include <linux/sched.h> | ||
13 | #include <linux/ioport.h> | ||
14 | #include <asm/io.h> | ||
15 | #include <asm/hd64465/gpio.h> | ||
16 | |||
17 | #define _PORTOF(portpin) (((portpin)>>3)&0x7) | ||
18 | #define _PINOF(portpin) ((portpin)&0x7) | ||
19 | |||
20 | /* Register addresses parametrised on port */ | ||
21 | #define GPIO_CR(port) (HD64465_REG_GPACR+((port)<<1)) | ||
22 | #define GPIO_DR(port) (HD64465_REG_GPADR+((port)<<1)) | ||
23 | #define GPIO_ICR(port) (HD64465_REG_GPAICR+((port)<<1)) | ||
24 | #define GPIO_ISR(port) (HD64465_REG_GPAISR+((port)<<1)) | ||
25 | |||
26 | #define GPIO_NPORTS 5 | ||
27 | |||
28 | #define MODNAME "hd64465_gpio" | ||
29 | |||
30 | EXPORT_SYMBOL(hd64465_gpio_configure); | ||
31 | EXPORT_SYMBOL(hd64465_gpio_get_pin); | ||
32 | EXPORT_SYMBOL(hd64465_gpio_get_port); | ||
33 | EXPORT_SYMBOL(hd64465_gpio_register_irq); | ||
34 | EXPORT_SYMBOL(hd64465_gpio_set_pin); | ||
35 | EXPORT_SYMBOL(hd64465_gpio_set_port); | ||
36 | EXPORT_SYMBOL(hd64465_gpio_unregister_irq); | ||
37 | |||
38 | /* TODO: each port should be protected with a spinlock */ | ||
39 | |||
40 | |||
41 | void hd64465_gpio_configure(int portpin, int direction) | ||
42 | { | ||
43 | unsigned short cr; | ||
44 | unsigned int shift = (_PINOF(portpin)<<1); | ||
45 | |||
46 | cr = inw(GPIO_CR(_PORTOF(portpin))); | ||
47 | cr &= ~(3<<shift); | ||
48 | cr |= direction<<shift; | ||
49 | outw(cr, GPIO_CR(_PORTOF(portpin))); | ||
50 | } | ||
51 | |||
52 | void hd64465_gpio_set_pin(int portpin, unsigned int value) | ||
53 | { | ||
54 | unsigned short d; | ||
55 | unsigned short mask = 1<<(_PINOF(portpin)); | ||
56 | |||
57 | d = inw(GPIO_DR(_PORTOF(portpin))); | ||
58 | if (value) | ||
59 | d |= mask; | ||
60 | else | ||
61 | d &= ~mask; | ||
62 | outw(d, GPIO_DR(_PORTOF(portpin))); | ||
63 | } | ||
64 | |||
65 | unsigned int hd64465_gpio_get_pin(int portpin) | ||
66 | { | ||
67 | return inw(GPIO_DR(_PORTOF(portpin))) & (1<<(_PINOF(portpin))); | ||
68 | } | ||
69 | |||
70 | /* TODO: for cleaner atomicity semantics, add a mask to this routine */ | ||
71 | |||
72 | void hd64465_gpio_set_port(int port, unsigned int value) | ||
73 | { | ||
74 | outw(value, GPIO_DR(port)); | ||
75 | } | ||
76 | |||
77 | unsigned int hd64465_gpio_get_port(int port) | ||
78 | { | ||
79 | return inw(GPIO_DR(port)); | ||
80 | } | ||
81 | |||
82 | |||
83 | static struct { | ||
84 | void (*func)(int portpin, void *dev); | ||
85 | void *dev; | ||
86 | } handlers[GPIO_NPORTS * 8]; | ||
87 | |||
88 | static irqreturn_t hd64465_gpio_interrupt(int irq, void *dev) | ||
89 | { | ||
90 | unsigned short port, pin, isr, mask, portpin; | ||
91 | |||
92 | for (port=0 ; port<GPIO_NPORTS ; port++) { | ||
93 | isr = inw(GPIO_ISR(port)); | ||
94 | |||
95 | for (pin=0 ; pin<8 ; pin++) { | ||
96 | mask = 1<<pin; | ||
97 | if (isr & mask) { | ||
98 | portpin = (port<<3)|pin; | ||
99 | if (handlers[portpin].func != 0) | ||
100 | handlers[portpin].func(portpin, handlers[portpin].dev); | ||
101 | else | ||
102 | printk(KERN_NOTICE "unexpected GPIO interrupt, pin %c%d\n", | ||
103 | port+'A', (int)pin); | ||
104 | } | ||
105 | } | ||
106 | |||
107 | /* Write 1s back to ISR to clear it? That's what the manual says.. */ | ||
108 | outw(isr, GPIO_ISR(port)); | ||
109 | } | ||
110 | |||
111 | return IRQ_HANDLED; | ||
112 | } | ||
113 | |||
114 | void hd64465_gpio_register_irq(int portpin, int mode, | ||
115 | void (*handler)(int portpin, void *dev), void *dev) | ||
116 | { | ||
117 | unsigned long flags; | ||
118 | unsigned short icr, mask; | ||
119 | |||
120 | if (handler == 0) | ||
121 | return; | ||
122 | |||
123 | local_irq_save(flags); | ||
124 | |||
125 | handlers[portpin].func = handler; | ||
126 | handlers[portpin].dev = dev; | ||
127 | |||
128 | /* | ||
129 | * Configure Interrupt Control Register | ||
130 | */ | ||
131 | icr = inw(GPIO_ICR(_PORTOF(portpin))); | ||
132 | mask = (1<<_PINOF(portpin)); | ||
133 | |||
134 | /* unmask interrupt */ | ||
135 | icr &= ~mask; | ||
136 | |||
137 | /* set TS bit */ | ||
138 | mask <<= 8; | ||
139 | icr &= ~mask; | ||
140 | if (mode == HD64465_GPIO_RISING) | ||
141 | icr |= mask; | ||
142 | |||
143 | outw(icr, GPIO_ICR(_PORTOF(portpin))); | ||
144 | |||
145 | local_irq_restore(flags); | ||
146 | } | ||
147 | |||
148 | void hd64465_gpio_unregister_irq(int portpin) | ||
149 | { | ||
150 | unsigned long flags; | ||
151 | unsigned short icr; | ||
152 | |||
153 | local_irq_save(flags); | ||
154 | |||
155 | /* | ||
156 | * Configure Interrupt Control Register | ||
157 | */ | ||
158 | icr = inw(GPIO_ICR(_PORTOF(portpin))); | ||
159 | icr |= (1<<_PINOF(portpin)); /* mask interrupt */ | ||
160 | outw(icr, GPIO_ICR(_PORTOF(portpin))); | ||
161 | |||
162 | handlers[portpin].func = 0; | ||
163 | handlers[portpin].dev = 0; | ||
164 | |||
165 | local_irq_restore(flags); | ||
166 | } | ||
167 | |||
168 | static int __init hd64465_gpio_init(void) | ||
169 | { | ||
170 | if (!request_region(HD64465_REG_GPACR, 0x1000, MODNAME)) | ||
171 | return -EBUSY; | ||
172 | if (request_irq(HD64465_IRQ_GPIO, hd64465_gpio_interrupt, | ||
173 | IRQF_DISABLED, MODNAME, 0)) | ||
174 | goto out_irqfailed; | ||
175 | |||
176 | printk("HD64465 GPIO layer on irq %d\n", HD64465_IRQ_GPIO); | ||
177 | |||
178 | return 0; | ||
179 | |||
180 | out_irqfailed: | ||
181 | release_region(HD64465_REG_GPACR, 0x1000); | ||
182 | |||
183 | return -EINVAL; | ||
184 | } | ||
185 | |||
186 | static void __exit hd64465_gpio_exit(void) | ||
187 | { | ||
188 | release_region(HD64465_REG_GPACR, 0x1000); | ||
189 | free_irq(HD64465_IRQ_GPIO, 0); | ||
190 | } | ||
191 | |||
192 | module_init(hd64465_gpio_init); | ||
193 | module_exit(hd64465_gpio_exit); | ||
194 | |||
195 | MODULE_LICENSE("GPL"); | ||
196 | |||
diff --git a/arch/sh/cchips/hd6446x/hd64465/io.c b/arch/sh/cchips/hd6446x/hd64465/io.c deleted file mode 100644 index 58704d066ae2..000000000000 --- a/arch/sh/cchips/hd6446x/hd64465/io.c +++ /dev/null | |||
@@ -1,211 +0,0 @@ | |||
1 | /* | ||
2 | * $Id: io.c,v 1.4 2003/08/03 03:05:10 lethal Exp $ | ||
3 | * by Greg Banks <gbanks@pocketpenguins.com> | ||
4 | * (c) 2000 PocketPenguins Inc | ||
5 | * | ||
6 | * Derived from io_hd64461.c, which bore the message: | ||
7 | * Copyright (C) 2000 YAEGASHI Takeshi | ||
8 | * | ||
9 | * Typical I/O routines for HD64465 system. | ||
10 | */ | ||
11 | |||
12 | #include <linux/kernel.h> | ||
13 | #include <linux/module.h> | ||
14 | #include <asm/io.h> | ||
15 | #include <asm/hd64465/hd64465.h> | ||
16 | |||
17 | |||
18 | #define HD64465_DEBUG 0 | ||
19 | |||
20 | #if HD64465_DEBUG | ||
21 | #define DPRINTK(args...) printk(args) | ||
22 | #define DIPRINTK(n, args...) if (hd64465_io_debug>(n)) printk(args) | ||
23 | #else | ||
24 | #define DPRINTK(args...) | ||
25 | #define DIPRINTK(n, args...) | ||
26 | #endif | ||
27 | |||
28 | |||
29 | |||
30 | /* This is a hack suitable only for debugging IO port problems */ | ||
31 | int hd64465_io_debug; | ||
32 | EXPORT_SYMBOL(hd64465_io_debug); | ||
33 | |||
34 | /* Low iomap maps port 0-1K to addresses in 8byte chunks */ | ||
35 | #define HD64465_IOMAP_LO_THRESH 0x400 | ||
36 | #define HD64465_IOMAP_LO_SHIFT 3 | ||
37 | #define HD64465_IOMAP_LO_MASK ((1<<HD64465_IOMAP_LO_SHIFT)-1) | ||
38 | #define HD64465_IOMAP_LO_NMAP (HD64465_IOMAP_LO_THRESH>>HD64465_IOMAP_LO_SHIFT) | ||
39 | static unsigned long hd64465_iomap_lo[HD64465_IOMAP_LO_NMAP]; | ||
40 | static unsigned char hd64465_iomap_lo_shift[HD64465_IOMAP_LO_NMAP]; | ||
41 | |||
42 | /* High iomap maps port 1K-64K to addresses in 1K chunks */ | ||
43 | #define HD64465_IOMAP_HI_THRESH 0x10000 | ||
44 | #define HD64465_IOMAP_HI_SHIFT 10 | ||
45 | #define HD64465_IOMAP_HI_MASK ((1<<HD64465_IOMAP_HI_SHIFT)-1) | ||
46 | #define HD64465_IOMAP_HI_NMAP (HD64465_IOMAP_HI_THRESH>>HD64465_IOMAP_HI_SHIFT) | ||
47 | static unsigned long hd64465_iomap_hi[HD64465_IOMAP_HI_NMAP]; | ||
48 | static unsigned char hd64465_iomap_hi_shift[HD64465_IOMAP_HI_NMAP]; | ||
49 | |||
50 | #define PORT2ADDR(x) (sh_mv.mv_isa_port2addr(x)) | ||
51 | |||
52 | void hd64465_port_map(unsigned short baseport, unsigned int nports, | ||
53 | unsigned long addr, unsigned char shift) | ||
54 | { | ||
55 | unsigned int port, endport = baseport + nports; | ||
56 | |||
57 | DPRINTK("hd64465_port_map(base=0x%04hx, n=0x%04hx, addr=0x%08lx,endport=0x%04x)\n", | ||
58 | baseport, nports, addr,endport); | ||
59 | |||
60 | for (port = baseport ; | ||
61 | port < endport && port < HD64465_IOMAP_LO_THRESH ; | ||
62 | port += (1<<HD64465_IOMAP_LO_SHIFT)) { | ||
63 | DPRINTK(" maplo[0x%x] = 0x%08lx\n", port, addr); | ||
64 | hd64465_iomap_lo[port>>HD64465_IOMAP_LO_SHIFT] = addr; | ||
65 | hd64465_iomap_lo_shift[port>>HD64465_IOMAP_LO_SHIFT] = shift; | ||
66 | addr += (1<<(HD64465_IOMAP_LO_SHIFT)); | ||
67 | } | ||
68 | |||
69 | for (port = max_t(unsigned int, baseport, HD64465_IOMAP_LO_THRESH); | ||
70 | port < endport && port < HD64465_IOMAP_HI_THRESH ; | ||
71 | port += (1<<HD64465_IOMAP_HI_SHIFT)) { | ||
72 | DPRINTK(" maphi[0x%x] = 0x%08lx\n", port, addr); | ||
73 | hd64465_iomap_hi[port>>HD64465_IOMAP_HI_SHIFT] = addr; | ||
74 | hd64465_iomap_hi_shift[port>>HD64465_IOMAP_HI_SHIFT] = shift; | ||
75 | addr += (1<<(HD64465_IOMAP_HI_SHIFT)); | ||
76 | } | ||
77 | } | ||
78 | EXPORT_SYMBOL(hd64465_port_map); | ||
79 | |||
80 | void hd64465_port_unmap(unsigned short baseport, unsigned int nports) | ||
81 | { | ||
82 | unsigned int port, endport = baseport + nports; | ||
83 | |||
84 | DPRINTK("hd64465_port_unmap(base=0x%04hx, n=0x%04hx)\n", | ||
85 | baseport, nports); | ||
86 | |||
87 | for (port = baseport ; | ||
88 | port < endport && port < HD64465_IOMAP_LO_THRESH ; | ||
89 | port += (1<<HD64465_IOMAP_LO_SHIFT)) { | ||
90 | hd64465_iomap_lo[port>>HD64465_IOMAP_LO_SHIFT] = 0; | ||
91 | } | ||
92 | |||
93 | for (port = max_t(unsigned int, baseport, HD64465_IOMAP_LO_THRESH); | ||
94 | port < endport && port < HD64465_IOMAP_HI_THRESH ; | ||
95 | port += (1<<HD64465_IOMAP_HI_SHIFT)) { | ||
96 | hd64465_iomap_hi[port>>HD64465_IOMAP_HI_SHIFT] = 0; | ||
97 | } | ||
98 | } | ||
99 | EXPORT_SYMBOL(hd64465_port_unmap); | ||
100 | |||
101 | unsigned long hd64465_isa_port2addr(unsigned long port) | ||
102 | { | ||
103 | unsigned long addr = 0; | ||
104 | unsigned char shift; | ||
105 | |||
106 | /* handle remapping of low IO ports */ | ||
107 | if (port < HD64465_IOMAP_LO_THRESH) { | ||
108 | addr = hd64465_iomap_lo[port >> HD64465_IOMAP_LO_SHIFT]; | ||
109 | shift = hd64465_iomap_lo_shift[port >> HD64465_IOMAP_LO_SHIFT]; | ||
110 | if (addr != 0) | ||
111 | addr += (port & HD64465_IOMAP_LO_MASK) << shift; | ||
112 | else | ||
113 | printk(KERN_NOTICE "io_hd64465: access to un-mapped port %lx\n", port); | ||
114 | } else if (port < HD64465_IOMAP_HI_THRESH) { | ||
115 | addr = hd64465_iomap_hi[port >> HD64465_IOMAP_HI_SHIFT]; | ||
116 | shift = hd64465_iomap_hi_shift[port >> HD64465_IOMAP_HI_SHIFT]; | ||
117 | if (addr != 0) | ||
118 | addr += (port & HD64465_IOMAP_HI_MASK) << shift; | ||
119 | else | ||
120 | printk(KERN_NOTICE "io_hd64465: access to un-mapped port %lx\n", port); | ||
121 | } | ||
122 | |||
123 | /* HD64465 internal devices (0xb0000000) */ | ||
124 | else if (port < 0x20000) | ||
125 | addr = CONFIG_HD64465_IOBASE + port - 0x10000; | ||
126 | |||
127 | /* Whole physical address space (0xa0000000) */ | ||
128 | else | ||
129 | addr = P2SEGADDR(port); | ||
130 | |||
131 | DIPRINTK(2, "PORT2ADDR(0x%08lx) = 0x%08lx\n", port, addr); | ||
132 | |||
133 | return addr; | ||
134 | } | ||
135 | |||
136 | static inline void delay(void) | ||
137 | { | ||
138 | ctrl_inw(0xa0000000); | ||
139 | } | ||
140 | |||
141 | unsigned char hd64465_inb(unsigned long port) | ||
142 | { | ||
143 | unsigned long addr = PORT2ADDR(port); | ||
144 | unsigned long b = (addr == 0 ? 0 : *(volatile unsigned char*)addr); | ||
145 | |||
146 | DIPRINTK(0, "inb(%08lx) = %02x\n", addr, (unsigned)b); | ||
147 | return b; | ||
148 | } | ||
149 | |||
150 | unsigned char hd64465_inb_p(unsigned long port) | ||
151 | { | ||
152 | unsigned long v; | ||
153 | unsigned long addr = PORT2ADDR(port); | ||
154 | |||
155 | v = (addr == 0 ? 0 : *(volatile unsigned char*)addr); | ||
156 | delay(); | ||
157 | DIPRINTK(0, "inb_p(%08lx) = %02x\n", addr, (unsigned)v); | ||
158 | return v; | ||
159 | } | ||
160 | |||
161 | unsigned short hd64465_inw(unsigned long port) | ||
162 | { | ||
163 | unsigned long addr = PORT2ADDR(port); | ||
164 | unsigned long b = (addr == 0 ? 0 : *(volatile unsigned short*)addr); | ||
165 | DIPRINTK(0, "inw(%08lx) = %04lx\n", addr, b); | ||
166 | return b; | ||
167 | } | ||
168 | |||
169 | unsigned int hd64465_inl(unsigned long port) | ||
170 | { | ||
171 | unsigned long addr = PORT2ADDR(port); | ||
172 | unsigned int b = (addr == 0 ? 0 : *(volatile unsigned long*)addr); | ||
173 | DIPRINTK(0, "inl(%08lx) = %08x\n", addr, b); | ||
174 | return b; | ||
175 | } | ||
176 | |||
177 | void hd64465_outb(unsigned char b, unsigned long port) | ||
178 | { | ||
179 | unsigned long addr = PORT2ADDR(port); | ||
180 | |||
181 | DIPRINTK(0, "outb(%02x, %08lx)\n", (unsigned)b, addr); | ||
182 | if (addr != 0) | ||
183 | *(volatile unsigned char*)addr = b; | ||
184 | } | ||
185 | |||
186 | void hd64465_outb_p(unsigned char b, unsigned long port) | ||
187 | { | ||
188 | unsigned long addr = PORT2ADDR(port); | ||
189 | |||
190 | DIPRINTK(0, "outb_p(%02x, %08lx)\n", (unsigned)b, addr); | ||
191 | if (addr != 0) | ||
192 | *(volatile unsigned char*)addr = b; | ||
193 | delay(); | ||
194 | } | ||
195 | |||
196 | void hd64465_outw(unsigned short b, unsigned long port) | ||
197 | { | ||
198 | unsigned long addr = PORT2ADDR(port); | ||
199 | DIPRINTK(0, "outw(%04x, %08lx)\n", (unsigned)b, addr); | ||
200 | if (addr != 0) | ||
201 | *(volatile unsigned short*)addr = b; | ||
202 | } | ||
203 | |||
204 | void hd64465_outl(unsigned int b, unsigned long port) | ||
205 | { | ||
206 | unsigned long addr = PORT2ADDR(port); | ||
207 | DIPRINTK(0, "outl(%08x, %08lx)\n", b, addr); | ||
208 | if (addr != 0) | ||
209 | *(volatile unsigned long*)addr = b; | ||
210 | } | ||
211 | |||
diff --git a/arch/sh/cchips/hd6446x/hd64465/setup.c b/arch/sh/cchips/hd6446x/hd64465/setup.c deleted file mode 100644 index 9b8820c36701..000000000000 --- a/arch/sh/cchips/hd6446x/hd64465/setup.c +++ /dev/null | |||
@@ -1,181 +0,0 @@ | |||
1 | /* | ||
2 | * $Id: setup.c,v 1.4 2003/08/03 03:05:10 lethal Exp $ | ||
3 | * | ||
4 | * Setup and IRQ handling code for the HD64465 companion chip. | ||
5 | * by Greg Banks <gbanks@pocketpenguins.com> | ||
6 | * Copyright (c) 2000 PocketPenguins Inc | ||
7 | * | ||
8 | * Derived from setup_hd64461.c which bore the message: | ||
9 | * Copyright (C) 2000 YAEGASHI Takeshi | ||
10 | */ | ||
11 | |||
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> | ||
20 | #include <asm/io.h> | ||
21 | #include <asm/irq.h> | ||
22 | #include <asm/hd64465/hd64465.h> | ||
23 | |||
24 | static void disable_hd64465_irq(unsigned int irq) | ||
25 | { | ||
26 | unsigned short nimr; | ||
27 | unsigned short mask = 1 << (irq - HD64465_IRQ_BASE); | ||
28 | |||
29 | pr_debug("disable_hd64465_irq(%d): mask=%x\n", irq, mask); | ||
30 | nimr = inw(HD64465_REG_NIMR); | ||
31 | nimr |= mask; | ||
32 | outw(nimr, HD64465_REG_NIMR); | ||
33 | } | ||
34 | |||
35 | static void enable_hd64465_irq(unsigned int irq) | ||
36 | { | ||
37 | unsigned short nimr; | ||
38 | unsigned short mask = 1 << (irq - HD64465_IRQ_BASE); | ||
39 | |||
40 | pr_debug("enable_hd64465_irq(%d): mask=%x\n", irq, mask); | ||
41 | nimr = inw(HD64465_REG_NIMR); | ||
42 | nimr &= ~mask; | ||
43 | outw(nimr, HD64465_REG_NIMR); | ||
44 | } | ||
45 | |||
46 | static void mask_and_ack_hd64465(unsigned int irq) | ||
47 | { | ||
48 | disable_hd64465_irq(irq); | ||
49 | } | ||
50 | |||
51 | static void end_hd64465_irq(unsigned int irq) | ||
52 | { | ||
53 | if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS))) | ||
54 | enable_hd64465_irq(irq); | ||
55 | } | ||
56 | |||
57 | static unsigned int startup_hd64465_irq(unsigned int irq) | ||
58 | { | ||
59 | enable_hd64465_irq(irq); | ||
60 | return 0; | ||
61 | } | ||
62 | |||
63 | static void shutdown_hd64465_irq(unsigned int irq) | ||
64 | { | ||
65 | disable_hd64465_irq(irq); | ||
66 | } | ||
67 | |||
68 | static struct hw_interrupt_type hd64465_irq_type = { | ||
69 | .typename = "HD64465-IRQ", | ||
70 | .startup = startup_hd64465_irq, | ||
71 | .shutdown = shutdown_hd64465_irq, | ||
72 | .enable = enable_hd64465_irq, | ||
73 | .disable = disable_hd64465_irq, | ||
74 | .ack = mask_and_ack_hd64465, | ||
75 | .end = end_hd64465_irq, | ||
76 | }; | ||
77 | |||
78 | static irqreturn_t hd64465_interrupt(int irq, void *dev_id) | ||
79 | { | ||
80 | printk(KERN_INFO | ||
81 | "HD64465: spurious interrupt, nirr: 0x%x nimr: 0x%x\n", | ||
82 | inw(HD64465_REG_NIRR), inw(HD64465_REG_NIMR)); | ||
83 | |||
84 | return IRQ_NONE; | ||
85 | } | ||
86 | |||
87 | /* | ||
88 | * Support for a secondary IRQ demux step. This is necessary | ||
89 | * because the HD64465 presents a very thin interface to the | ||
90 | * PCMCIA bus; a lot of features (such as remapping interrupts) | ||
91 | * normally done in hardware by other PCMCIA host bridges is | ||
92 | * instead done in software. | ||
93 | */ | ||
94 | static struct { | ||
95 | int (*func)(int, void *); | ||
96 | void *dev; | ||
97 | } hd64465_demux[HD64465_IRQ_NUM]; | ||
98 | |||
99 | void hd64465_register_irq_demux(int irq, | ||
100 | int (*demux)(int irq, void *dev), void *dev) | ||
101 | { | ||
102 | hd64465_demux[irq - HD64465_IRQ_BASE].func = demux; | ||
103 | hd64465_demux[irq - HD64465_IRQ_BASE].dev = dev; | ||
104 | } | ||
105 | EXPORT_SYMBOL(hd64465_register_irq_demux); | ||
106 | |||
107 | void hd64465_unregister_irq_demux(int irq) | ||
108 | { | ||
109 | hd64465_demux[irq - HD64465_IRQ_BASE].func = 0; | ||
110 | } | ||
111 | EXPORT_SYMBOL(hd64465_unregister_irq_demux); | ||
112 | |||
113 | int hd64465_irq_demux(int irq) | ||
114 | { | ||
115 | if (irq == CONFIG_HD64465_IRQ) { | ||
116 | unsigned short i, bit; | ||
117 | unsigned short nirr = inw(HD64465_REG_NIRR); | ||
118 | unsigned short nimr = inw(HD64465_REG_NIMR); | ||
119 | |||
120 | pr_debug("hd64465_irq_demux, nirr=%04x, nimr=%04x\n", nirr, nimr); | ||
121 | nirr &= ~nimr; | ||
122 | for (bit = 1, i = 0 ; i < HD64465_IRQ_NUM ; bit <<= 1, i++) | ||
123 | if (nirr & bit) | ||
124 | break; | ||
125 | |||
126 | if (i < HD64465_IRQ_NUM) { | ||
127 | irq = HD64465_IRQ_BASE + i; | ||
128 | if (hd64465_demux[i].func != 0) | ||
129 | irq = hd64465_demux[i].func(irq, hd64465_demux[i].dev); | ||
130 | } | ||
131 | } | ||
132 | return irq; | ||
133 | } | ||
134 | |||
135 | static struct irqaction irq0 = { | ||
136 | .handler = hd64465_interrupt, | ||
137 | .flags = IRQF_DISABLED, | ||
138 | .mask = CPU_MASK_NONE, | ||
139 | .name = "HD64465", | ||
140 | }; | ||
141 | |||
142 | static int __init setup_hd64465(void) | ||
143 | { | ||
144 | int i; | ||
145 | unsigned short rev; | ||
146 | unsigned short smscr; | ||
147 | |||
148 | if (!MACH_HD64465) | ||
149 | return 0; | ||
150 | |||
151 | printk(KERN_INFO "HD64465 configured at 0x%x on irq %d(mapped into %d to %d)\n", | ||
152 | CONFIG_HD64465_IOBASE, | ||
153 | CONFIG_HD64465_IRQ, | ||
154 | HD64465_IRQ_BASE, | ||
155 | HD64465_IRQ_BASE+HD64465_IRQ_NUM-1); | ||
156 | |||
157 | if (inw(HD64465_REG_SDID) != HD64465_SDID) { | ||
158 | printk(KERN_ERR "HD64465 device ID not found, check base address\n"); | ||
159 | } | ||
160 | |||
161 | rev = inw(HD64465_REG_SRR); | ||
162 | printk(KERN_INFO "HD64465 hardware revision %d.%d\n", (rev >> 8) & 0xff, rev & 0xff); | ||
163 | |||
164 | outw(0xffff, HD64465_REG_NIMR); /* mask all interrupts */ | ||
165 | |||
166 | for (i = 0; i < HD64465_IRQ_NUM ; i++) { | ||
167 | irq_desc[HD64465_IRQ_BASE + i].chip = &hd64465_irq_type; | ||
168 | } | ||
169 | |||
170 | setup_irq(CONFIG_HD64465_IRQ, &irq0); | ||
171 | |||
172 | /* wake up the UART from STANDBY at this point */ | ||
173 | smscr = inw(HD64465_REG_SMSCR); | ||
174 | outw(smscr & (~HD64465_SMSCR_UARTST), HD64465_REG_SMSCR); | ||
175 | |||
176 | /* remap IO ports for first ISA serial port to HD64465 UART */ | ||
177 | hd64465_port_map(0x3f8, 8, CONFIG_HD64465_IOBASE + 0x8000, 1); | ||
178 | |||
179 | return 0; | ||
180 | } | ||
181 | module_init(setup_hd64465); | ||