mirror of
https://github.com/openwrt/openwrt.git
synced 2024-12-23 07:22:33 +00:00
85 lines
2.4 KiB
Diff
85 lines
2.4 KiB
Diff
--- a/drivers/pcmcia/yenta.c
|
|
+++ b/drivers/pcmcia/yenta.c
|
|
@@ -543,6 +543,9 @@ static unsigned int yenta_probe_irq(pci_
|
|
* Probe for usable interrupts using the force
|
|
* register to generate bogus card status events.
|
|
*/
|
|
+
|
|
+#ifndef CONFIG_BCM947XX
|
|
+ /* WRT54G3G does not like this */
|
|
cb_writel(socket, CB_SOCKET_EVENT, -1);
|
|
cb_writel(socket, CB_SOCKET_MASK, CB_CSTSMASK);
|
|
exca_writeb(socket, I365_CSCINT, 0);
|
|
@@ -557,7 +560,8 @@ static unsigned int yenta_probe_irq(pci_
|
|
}
|
|
cb_writel(socket, CB_SOCKET_MASK, 0);
|
|
exca_writeb(socket, I365_CSCINT, 0);
|
|
-
|
|
+#endif
|
|
+
|
|
mask = probe_irq_mask(val) & 0xffff;
|
|
|
|
bridge_ctrl &= ~CB_BRIDGE_INTR;
|
|
@@ -578,6 +582,12 @@ static void yenta_get_socket_capabilitie
|
|
socket->cap.cb_dev = socket->dev;
|
|
socket->cap.bus = NULL;
|
|
|
|
+#ifdef CONFIG_BCM947XX
|
|
+ /* irq mask probing is broken for the WRT54G3G */
|
|
+ if (socket->cap.irq_mask == 0)
|
|
+ socket->cap.irq_mask = 0x6f8;
|
|
+#endif
|
|
+
|
|
printk(KERN_INFO "Yenta ISA IRQ mask 0x%04x, PCI irq %d\n",
|
|
socket->cap.irq_mask, socket->cb_irq);
|
|
}
|
|
@@ -609,6 +619,15 @@ static void yenta_open_bh(void * data)
|
|
printk(KERN_INFO "Socket status: %08x\n",
|
|
cb_readl(socket, CB_SOCKET_STATE));
|
|
|
|
+ /* Generate an interrupt on card insert/remove */
|
|
+ config_writew(socket, CB_SOCKET_MASK, CB_CSTSMASK | CB_CDMASK);
|
|
+
|
|
+ /* Set up Multifunction Routing Status Register */
|
|
+ config_writew(socket, 0x8C, 0x1000 /* MFUNC3 to GPIO3 */ | 0x2 /* MFUNC0 to INTA */);
|
|
+
|
|
+ /* Switch interrupts to parallelized */
|
|
+ config_writeb(socket, 0x92, 0x64);
|
|
+
|
|
/* Register it with the pcmcia layer.. */
|
|
cardbus_register(socket);
|
|
|
|
@@ -731,7 +750,7 @@ static void yenta_allocate_res(pci_socke
|
|
{
|
|
struct pci_bus *bus;
|
|
struct resource *root, *res;
|
|
- u32 start, end;
|
|
+ u32 start = 0, end = 0;
|
|
u32 align, size, min, max;
|
|
unsigned offset;
|
|
unsigned mask;
|
|
@@ -750,6 +769,15 @@ static void yenta_allocate_res(pci_socke
|
|
res->end = 0;
|
|
root = pci_find_parent_resource(socket->dev, res);
|
|
|
|
+#ifdef CONFIG_BCM947XX
|
|
+ /* default mem resources are completely fscked up on the wrt54g3g */
|
|
+ /* bypass the entire resource allocation stuff below and just set it statically */
|
|
+ if (type & IORESOURCE_MEM) {
|
|
+ res->start = 0x40004000;
|
|
+ res->end = res->start + 0x3fff;
|
|
+ }
|
|
+
|
|
+#else
|
|
if (!root)
|
|
return;
|
|
|
|
@@ -794,6 +822,7 @@ static void yenta_allocate_res(pci_socke
|
|
res->start = res->end = 0;
|
|
return;
|
|
}
|
|
+#endif
|
|
|
|
config_writel(socket, offset, res->start);
|
|
config_writel(socket, offset+4, res->end);
|