openwrtv3/target/linux/cns3xxx/patches-3.3/480-cns3xxx_pcie_early_init.patch

--- a/arch/arm/mach-cns3xxx/cns3420vb.c
+++ b/arch/arm/mach-cns3xxx/cns3420vb.c
@@ -203,7 +203,6 @@ static void __init cns3420_init(void)
 		NR_IRQS_CNS3XXX);
 	cns3xxx_gpio_init(32, 32, CNS3XXX_GPIOB_BASE_VIRT, IRQ_CNS3XXX_GPIOB,
 		NR_IRQS_CNS3XXX + 32);
-	cns3xxx_pcie_init(0x3);
 
 	pm_power_off = cns3xxx_power_off;
 }
@@ -220,11 +219,21 @@ static struct map_desc cns3420_io_desc[]
 static void __init cns3420_map_io(void)
 {
 	cns3xxx_common_init();
+	cns3xxx_pcie_iotable_init();
 	iotable_init(cns3420_io_desc, ARRAY_SIZE(cns3420_io_desc));
 
 	cns3420_early_serial_setup();
 }
 
+static int __init cns3420vb_pcie_init(void)
+{
+	if (!machine_is_cns3420vb())
+		return 0;
+
+	return cns3xxx_pcie_init();
+}
+subsys_initcall(cns3420vb_pcie_init);
+
 MACHINE_START(CNS3420VB, "Cavium Networks CNS3420 Validation Board")
 	.atag_offset	= 0x100,
 	.map_io		= cns3420_map_io,
--- a/arch/arm/mach-cns3xxx/core.h
+++ b/arch/arm/mach-cns3xxx/core.h
@@ -12,8 +12,8 @@
 #define __CNS3XXX_CORE_H
 
 extern struct sys_timer cns3xxx_timer;
-extern int cns3xxx_pcie_init(u8 bitmap);
-extern void cns3xxx_pcie_iotable_init(u8 bitmap);
+extern void cns3xxx_pcie_iotable_init(void);
+
 
 #ifdef CONFIG_CACHE_L2X0
 void __init cns3xxx_l2x0_init(void);
@@ -23,6 +23,7 @@ static inline void cns3xxx_l2x0_init(voi
 
 void __init cns3xxx_common_init(void);
 void __init cns3xxx_init_irq(void);
+int  __init cns3xxx_pcie_init(void);
 void cns3xxx_power_off(void);
 void cns3xxx_restart(char, const char *);
 
--- a/arch/arm/mach-cns3xxx/laguna.c
+++ b/arch/arm/mach-cns3xxx/laguna.c
@@ -729,7 +731,7 @@ static struct map_desc laguna_io_desc[]
 static void __init laguna_map_io(void)
 {
 	cns3xxx_common_init();
-	cns3xxx_pcie_iotable_init(0x3);
+	cns3xxx_pcie_iotable_init();
 	iotable_init(ARRAY_AND_SIZE(laguna_io_desc));
 	laguna_early_serial_setup();
 }
@@ -753,11 +755,19 @@ static int laguna_register_gpio(struct g
 	return ret;
 }
 
+static int __init laguna_pcie_init(void)
+{
+	if (!machine_is_gw2388())
+		return 0;
+
+	return cns3xxx_pcie_init();
+}
+subsys_initcall(laguna_pcie_init);
+
 static int __init laguna_model_setup(void)
 {
 	u32 __iomem *mem;
 	u32 reg;
-	u8 pcie_bitmap = 0;
 
 	printk("Running on Gateworks Laguna %s\n", laguna_info.model);
 	cns3xxx_gpio_init( 0, 32, CNS3XXX_GPIOA_BASE_VIRT, IRQ_CNS3XXX_GPIOA,
@@ -779,14 +789,6 @@ static int __init laguna_model_setup(voi
 		    (laguna_info.config_bitmap & SATA1_LOAD))
 			cns3xxx_ahci_init();
 
-		if (laguna_info.config_bitmap & (PCIE0_LOAD))
-			pcie_bitmap |= 0x1;
-
-		if (laguna_info.config_bitmap & (PCIE1_LOAD))
-			pcie_bitmap |= 0x2;
-
-		cns3xxx_pcie_init(pcie_bitmap);
-
 		if (laguna_info.config_bitmap & (USB0_LOAD)) {
 			cns3xxx_pwr_power_up(1 << PM_PLL_HM_PD_CTRL_REG_OFFSET_PLL_USB);
 
@@ -926,7 +928,6 @@ static int __init laguna_model_setup(voi
 	}
 	return 0;
 }
-
 late_initcall(laguna_model_setup);
 
 MACHINE_START(GW2388, "Gateworks Corporation Laguna Platform")
--- a/arch/arm/mach-cns3xxx/pcie.c
+++ b/arch/arm/mach-cns3xxx/pcie.c
@@ -456,23 +456,18 @@ static int cns3xxx_pcie_abort_handler(un
 	return 0;
 }
 
-void __init cns3xxx_pcie_iotable_init(u8 bitmap)
+
+void __init cns3xxx_pcie_iotable_init()
 {
-	static int _iotable_init = 0;
 	int i;
 
-	bitmap &= ~_iotable_init;
 	for (i = 0; i < ARRAY_SIZE(cns3xxx_pcie); i++) {
-		if (!(bitmap & (1 << i)))
-			continue;
-
 		iotable_init(cns3xxx_pcie[i].cfg_bases,
 			     ARRAY_SIZE(cns3xxx_pcie[i].cfg_bases));
 	}
-	_iotable_init |= bitmap;
 }
 
-int __init cns3xxx_pcie_init(u8 bitmap)
+int __init cns3xxx_pcie_init(void)
 {
 	int i;
 
@@ -482,14 +477,12 @@ int __init cns3xxx_pcie_init(u8 bitmap)
 	hook_fault_code(16 + 6, cns3xxx_pcie_abort_handler, SIGBUS, 0,
 			"imprecise external abort");
 
-	cns3xxx_pcie_iotable_init(bitmap);
 	for (i = 0; i < ARRAY_SIZE(cns3xxx_pcie); i++) {
-		if (!(bitmap & (1 << i)))
-			continue;
-
 		cns3xxx_pcie_check_link(&cns3xxx_pcie[i]);
-		cns3xxx_pcie_hw_init(&cns3xxx_pcie[i]);
-		pci_common_init(&cns3xxx_pcie[i].hw_pci);
+		if (cns3xxx_pcie[i].linked) {
+			cns3xxx_pcie_hw_init(&cns3xxx_pcie[i]);
+			pci_common_init(&cns3xxx_pcie[i].hw_pci);
+		}
 	}
 
 	pci_assign_unassigned_resources();