openwrt-xburst/target/linux/brcm-2.4/patches/009-wrt54g3g_pcmcia.patch

Index: linux-2.4.35.4/drivers/pcmcia/yenta.c
===================================================================
--- linux-2.4.35.4.orig/drivers/pcmcia/yenta.c
+++ linux-2.4.35.4/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);