IRQ handler rewrite by Gabor Juhos, uses C no longer assembly

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@7464 3c298f89-4303-0410-b956-a3cf2f4a3e73

3 files changed, 171 insertions, 68 deletions

diff --git a/target/linux/adm5120-2.6/files/arch/mips/pci/fixup-adm5120.c b/target/linux/adm5120-2.6/files/arch/mips/pci/fixup-adm5120.c
new file mode 100644
index 000000000..9f65e350a
--- /dev/null
+++ b/target/linux/adm5120-2.6/files/arch/mips/pci/fixup-adm5120.c
@@ -0,0 +1,99 @@
+/*
+ *  $Id$
+ *
+ *  ADM5120 specific PCI fixups
+ *
+ *  Copyright (C) ADMtek Incorporated.
+ *  Copyright (C) 2005 Jeroen Vreeken (pe1rxq@amsat.org)
+ *  Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
+ *  Copyright (C) 2007 OpenWrt.org
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the
+ *  Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
+ *  Boston, MA  02110-1301, USA.
+ *
+ */
+
+#include <linux/autoconf.h>
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/pci.h>
+#include <linux/pci_ids.h>
+#include <linux/pci_regs.h>
+
+#include <asm/delay.h>
+#include <asm/bootinfo.h>
+
+#include <asm/mach-adm5120/adm5120_info.h>
+#include <asm/mach-adm5120/adm5120_defs.h>
+#include <asm/mach-adm5120/adm5120_irq.h>
+
+static void adm5120_pci_fixup(struct pci_dev *dev)
+{
+	if (dev->devfn !=0)
+		return;
+
+	/* setup COMMAND register */
+	pci_write_config_word(dev, PCI_COMMAND, 
+		(PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER));
+
+	/* setup CACHE_LINE_SIZE register */
+	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, 4);
+
+	/* setting up BARS */
+	pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, 0);
+	pci_write_config_dword(dev, PCI_BASE_ADDRESS_1, 0);
+}
+
+DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_ADMTEK, PCI_DEVICE_ID_ADMTEK_ADM5120, 
+	adm5120_pci_fixup);
+
+
+int __init pcibios_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
+{
+	int irq;
+	
+	irq = -1;
+#if 1
+	/* FIXME: this code should be working on all boards? */
+	if (slot > 0 && slot < 4)
+		irq = ADM5120_IRQ_PCI0+slot-1;
+#else	
+	switch (mips_machtype) {
+	case MACH_ADM5120_RB_111:
+	case MACH_ADM5120_RB_112:
+	case MACH_ADM5120_RB_133:
+	case MACH_ADM5120_RB_133C:
+	case MACH_ADM5120_RB_153:
+		if (slot > 0 && slot < 4)
+			irq = ADM5120_IRQ_PCI0+slot-1;
+		break;
+	default:
+		if (slot > 1 && slot < 5)
+			irq = ADM5120_IRQ_PCI0+slot-2;
+		break;
+	}
+#endif
+	printk(KERN_INFO "PCI: mapping irq for device %s, slot:%u, pin:%u, "
+		"irq:%d\n", pci_name(dev), slot, pin, irq);
+		
+	return irq;
+}
+
+int pcibios_plat_dev_init(struct pci_dev *dev)
+{
+	return 0;
+}
+
diff --git a/target/linux/adm5120-2.6/files/arch/mips/pci/ops-adm5120.c b/target/linux/adm5120-2.6/files/arch/mips/pci/ops-adm5120.c
index 91dae8999..ff768033e 100644
--- a/target/linux/adm5120-2.6/files/arch/mips/pci/ops-adm5120.c
+++ b/target/linux/adm5120-2.6/files/arch/mips/pci/ops-adm5120.c
@@ -1,17 +1,36 @@
 /*
- *	Copyright (C) ADMtek Incorporated.
- *	Copyright (C) 2005 Jeroen Vreeken (pe1rxq@amsat.org)
- *	Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
- *	Copyright (C) 2007 OpenWrt.org
+ *  $Id$
+ *
+ *  ADM5120 specific PCI operations
+ *
+ *  Copyright (C) ADMtek Incorporated.
+ *  Copyright (C) 2005 Jeroen Vreeken (pe1rxq@amsat.org)
+ *  Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
+ *  Copyright (C) 2007 OpenWrt.org
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the
+ *  Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
+ *  Boston, MA  02110-1301, USA.
+ *
  */
 
-#include <linux/autoconf.h>
 #include <linux/types.h>
 #include <linux/pci.h>
 #include <linux/kernel.h>
 #include <linux/init.h>
 
-#include <adm5120_defs.h>
+#include <asm/mach-adm5120/adm5120_defs.h>
 
 volatile u32* pci_config_address_reg = (volatile u32*)KSEG1ADDR(ADM5120_PCICFG_ADDR);
 volatile u32* pci_config_data_reg = (volatile u32*)KSEG1ADDR(ADM5120_PCICFG_DATA);
@@ -24,14 +43,15 @@ static int pci_config_read(struct pci_bus *bus, unsigned int devfn, int where,
 	*pci_config_address_reg = ((bus->number & 0xff) << 0x10) |
 	    ((devfn & 0xff) << 0x08) | (where & 0xfc) | PCI_ENABLE;
 	switch (size) {
-		case 1:
-			*val = ((*pci_config_data_reg)>>((where&3)<<3))&0xff;
-			break;
-		case 2:
-			*val = ((*pci_config_data_reg)>>((where&3)<<3))&0xffff;
-			break;
-		default:
-			*val = (*pci_config_data_reg);
+	case 1:
+		*val = ((*pci_config_data_reg)>>((where&3)<<3))&0xff;
+		break;
+	case 2:
+		*val = ((*pci_config_data_reg)>>((where&3)<<3))&0xffff;
+		break;
+	default:
+		*val = (*pci_config_data_reg);
+		break;
 	}
 	return PCIBIOS_SUCCESSFUL;
 }
@@ -42,16 +62,16 @@ static int pci_config_write(struct pci_bus *bus, unsigned int devfn, int where,
 	*pci_config_address_reg = ((bus->number & 0xff) << 0x10) |
 	    ((devfn & 0xff) << 0x08) | (where & 0xfc) | PCI_ENABLE;
 	switch (size) {
-		case 1:
-			*(volatile u8 *)(((int)pci_config_data_reg) +
+	case 1:
+		*(volatile u8 *)(((int)pci_config_data_reg) +
 			    (where & 3)) = val;
-			break;
-		case 2:
-			*(volatile u16 *)(((int)pci_config_data_reg) +
+		break;
+	case 2:
+		*(volatile u16 *)(((int)pci_config_data_reg) +
 			    (where & 2)) = (val);
-			break;
-		default:
-			*pci_config_data_reg = (val);
+		break;
+	default:
+		*pci_config_data_reg = (val);
 	}
 
 	return PCIBIOS_SUCCESSFUL;
diff --git a/target/linux/adm5120-2.6/files/arch/mips/pci/pci-adm5120.c b/target/linux/adm5120-2.6/files/arch/mips/pci/pci-adm5120.c
index 0fa3986e1..f10422104 100644
--- a/target/linux/adm5120-2.6/files/arch/mips/pci/pci-adm5120.c
+++ b/target/linux/adm5120-2.6/files/arch/mips/pci/pci-adm5120.c
@@ -1,38 +1,48 @@
 /*
- *	Copyright (C) ADMtek Incorporated.
- *	Copyright (C) 2005 Jeroen Vreeken (pe1rxq@amsat.org)
- *	Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
- *	Copyright (C) 2007 OpenWrt.org
+ *  $Id$
+ *
+ *  ADM5120 PCI Host Controller driver
+ *
+ *  Copyright (C) ADMtek Incorporated.
+ *  Copyright (C) 2005 Jeroen Vreeken (pe1rxq@amsat.org)
+ *  Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
+ *  Copyright (C) 2007 OpenWrt.org
+ *
+ *  This program is free software; you can redistribute it and/or
+ *  modify it under the terms of the GNU General Public License
+ *  as published by the Free Software Foundation; either version 2
+ *  of the License, or (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with this program; if not, write to the
+ *  Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
+ *  Boston, MA  02110-1301, USA.
+ *
  */
-
-#include <linux/autoconf.h>
 #include <linux/types.h>
 #include <linux/pci.h>
 #include <linux/kernel.h>
 #include <linux/init.h>
 
-#include <adm5120_info.h>
-#include <adm5120_defs.h>
+#include <asm/mach-adm5120/adm5120_info.h>
+#include <asm/mach-adm5120/adm5120_defs.h>
+#include <asm/mach-adm5120/adm5120_irq.h>
 
 extern struct pci_ops adm5120_pci_ops;
 
-#define PCI_CMM_IOACC_EN	0x1
-#define PCI_CMM_MEMACC_EN	0x2
-#define PCI_CMM_MASTER_EN	0x4
-#define PCI_CMM_DEF \
-		(PCI_CMM_IOACC_EN | PCI_CMM_MEMACC_EN | PCI_CMM_MASTER_EN)
-
-#define PCI_DEF_CACHE_LINE_SZ	4
-
-
-struct resource pci_io_resource = {
+static struct resource pci_io_resource = {
 	.name = "ADM5120 PCI I/O",
 	.start = ADM5120_PCIIO_BASE,
 	.end = ADM5120_PCICFG_ADDR-1,
 	.flags = IORESOURCE_IO
 };
 
-struct resource pci_mem_resource = {
+static struct resource pci_mem_resource = {
 	.name = "ADM5120 PCI MEM",
 	.start = ADM5120_PCIMEM_BASE,
 	.end = ADM5120_PCIIO_BASE-1,
@@ -45,32 +55,6 @@ static struct pci_controller adm5120_controller = {
 	.mem_resource	= &pci_mem_resource,
 };
 
-int __init pcibios_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
-{
-	if (slot < 2 || slot > 4)
-		return -1;
-	return slot + 4;
-}
-
-static void adm5120_pci_fixup(struct pci_dev *dev)
-{
-	if (dev->devfn == 0) {
-		pci_write_config_word(dev, PCI_COMMAND, PCI_CMM_DEF);
-		pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE,
-		    PCI_DEF_CACHE_LINE_SZ);
-		pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, 0);
-		pci_write_config_dword(dev, PCI_BASE_ADDRESS_1, 0);
-	}
-}
-
-DECLARE_PCI_FIXUP_HEADER(PCI_ANY_ID, PCI_ANY_ID, adm5120_pci_fixup);
-
-
-int pcibios_plat_dev_init(struct pci_dev *dev)
-{
-	return 0;
-}
-
 static int __init adm5120_pci_setup(void)
 {
 	int pci_bios;
@@ -79,7 +63,7 @@ static int __init adm5120_pci_setup(void)
 
 	printk("adm5120: system has %sPCI BIOS\n", pci_bios ? "" : "no ");
 	if (pci_bios == 0)
-		return 1;
+		return -1;
 
 	/* Avoid ISA compat ranges.  */
 	PCIBIOS_MIN_IO = 0x00000000;