Factor out a few commonly duplicated functions from northbridge.c.
[coreboot.git] / src / northbridge / via / cn400 / northbridge.c
index 95941828642066ddfd66c88263c2d8ff6c261612..3982c9877c73c05de56adb841fc0e8e9e8c81f10 100644 (file)
@@ -41,19 +41,19 @@ static void memctrl_init(device_t dev)
        u8 ranks, pagec, paged, pagee, pagef, shadowreg, reg8;
        int i, j;
 
-       printk_spew("Entering cn400 memctrl_init.\n");
+       printk(BIOS_SPEW, "Entering cn400 memctrl_init.\n");
        /* vlink mirror */
        vlink_dev = dev_find_device(PCI_VENDOR_ID_VIA,
                                    PCI_DEVICE_ID_VIA_CN400_VLINK, 0);
-       
-       /* Setup Low Memory Top                                                 */
-       /* 0x47 == HA(32:25)                                                */
+
+       /* Setup Low Memory Top */
+       /* 0x47 == HA(32:25)    */
        /* 0x84/85 == HA(31:20) << 4 | DRAM Granularity */
        ranks = pci_read_config8(dev, 0x47);
        reg16 = (((u16)(ranks - 1) << 9) & 0xFFF0) | 0x01F0;
 
        pci_write_config16(dev, 0x84, reg16);
-       printk_spew("Low Top Address = 0x%04X\n", reg16);
+       printk(BIOS_SPEW, "Low Top Address = 0x%04X\n", reg16);
 
        /* Set up the VGA framebuffer size and Base Address   */
        /* Note dependencies between agp.c and vga.c and here */
@@ -104,26 +104,26 @@ static void memctrl_init(device_t dev)
                pci_write_config8(vlink_dev, 0x63, shadowreg);
 
        /* Activate VGA Frame Buffer */
-       
+
        reg8 = pci_read_config8(dev, 0xA0);
        reg8 |= 0x01;
        pci_write_config8(dev, 0xA0, reg8);
 
 #ifdef DEBUG_CN400
-       printk_spew("%s PCI Header Regs::\n", dev_path(dev));
+       printk(BIOS_SPEW, "%s PCI Header Regs::\n", dev_path(dev));
 
        for (i = 0 ; i < 16; i++)
        {
-               printk_spew("%02X: ", i*16);
+               printk(BIOS_SPEW, "%02X: ", i*16);
                for (j = 0; j < 16; j++)
                {
                        reg8 = pci_read_config8(dev, j+(i*16));
-                       printk_spew("%02X ", reg8);
+                       printk(BIOS_SPEW, "%02X ", reg8);
                }
-               printk_spew("\n");
+               printk(BIOS_SPEW, "\n");
        }
 #endif
-       printk_spew("Leaving cn400 %s.\n", __func__);
+       printk(BIOS_SPEW, "Leaving cn400 %s.\n", __func__);
 }
 
 static const struct device_operations memctrl_operations = {
@@ -144,7 +144,7 @@ static void cn400_domain_read_resources(device_t dev)
 {
        struct resource *resource;
 
-       printk_spew("Entering %s.\n", __func__);
+       printk(BIOS_SPEW, "Entering %s.\n", __func__);
 
        /* Initialize the system wide I/O space constraints. */
        resource = new_resource(dev, IOINDEX_SUBTRACTIVE(0, 0));
@@ -158,29 +158,16 @@ static void cn400_domain_read_resources(device_t dev)
        resource->flags = IORESOURCE_MEM | IORESOURCE_SUBTRACTIVE |
            IORESOURCE_ASSIGNED;
 
-       printk_spew("Leaving %s.\n", __func__);
-}
-
-static void ram_resource(device_t dev, unsigned long index,
-                        unsigned long basek, unsigned long sizek)
-{
-       struct resource *resource;
-
-       if (!sizek)
-               return;
-       resource = new_resource(dev, index);
-       resource->base = (resource_t) (basek << 10);
-       resource->size = (resource_t) (sizek << 10);
-       resource->flags = IORESOURCE_MEM | IORESOURCE_CACHEABLE |
-           IORESOURCE_FIXED | IORESOURCE_STORED | IORESOURCE_ASSIGNED;
+       printk(BIOS_SPEW, "Leaving %s.\n", __func__);
 }
 
+#ifdef UNUSED_CODE
 static void ram_reservation(device_t dev, unsigned long index,
                         unsigned long base, unsigned long size)
 {
        struct resource *res;
 
-       printk_spew("Configuring Via C3 LAPIC Fixed Resource\n");
+       printk(BIOS_SPEW, "Configuring Via C3 LAPIC Fixed Resource\n");
        /* Fixed LAPIC resource */
        res = new_resource(dev, 1);
        res->base = (resource_t) base;
@@ -188,37 +175,9 @@ static void ram_reservation(device_t dev, unsigned long index,
        res->flags = IORESOURCE_MEM | IORESOURCE_FIXED |
                     IORESOURCE_STORED | IORESOURCE_ASSIGNED;
 }
+#endif
 
-static void tolm_test(void *gp, struct device *dev, struct resource *new)
-{
-       struct resource **best_p = gp;
-       struct resource *best;
-
-       best = *best_p;
-       if (!best || (best->base > new->base))
-               best = new;
-       *best_p = best;
-}
-
-static u32 find_pci_tolm(struct bus *bus)
-{
-       struct resource *min = NULL;
-       u32 tolm;
-
-       printk_spew("Entering CN400 find_pci_tolm\n");
-
-       search_bus_resources(bus, IORESOURCE_MEM, IORESOURCE_MEM,
-                            tolm_test, &min);
-       tolm = 0xffffffffUL;
-       if (min && tolm > min->base)
-               tolm = min->base;
-
-       printk_spew("Leaving CN400 find_pci_tolm\n");
-
-       return tolm;
-}
-
-#if CONFIG_HAVE_HIGH_TABLES==1
+#if CONFIG_WRITE_HIGH_TABLES==1
 /* maximum size of high tables in KB */
 #define HIGH_TABLES_SIZE 64
 extern uint64_t high_tables_base, high_tables_size;
@@ -229,32 +188,32 @@ static void cn400_domain_set_resources(device_t dev)
        device_t mc_dev;
        u32 pci_tolm;
 
-       printk_spew("Entering %s.\n", __func__);
+       printk(BIOS_SPEW, "Entering %s.\n", __func__);
 
-       pci_tolm = find_pci_tolm(&dev->link[0]);
+       pci_tolm = find_pci_tolm(dev->link_list);
        mc_dev = dev_find_device(PCI_VENDOR_ID_VIA,
                                 PCI_DEVICE_ID_VIA_CN400_MEMCTRL, 0);
 
        if (mc_dev) {
                unsigned long tomk, tolmk;
                unsigned char rambits;
-               int i, idx;
+               int idx;
 
                rambits = pci_read_config8(mc_dev, 0x47);
                tomk = rambits * 32 * 1024;
                /* Compute the Top Of Low Memory (TOLM), in Kb. */
                tolmk = pci_tolm >> 10;
-               printk_spew("tomk is 0x%x, tolmk is 0x%08X\n", tomk, tolmk);
+               printk(BIOS_SPEW, "tomk is 0x%lx, tolmk is 0x%08lX\n", tomk, tolmk);
                if (tolmk >= tomk) {
                        /* The PCI hole does does not overlap the memory. */
                        tolmk = tomk;
                }
 
-#if CONFIG_HAVE_HIGH_TABLES == 1
+#if CONFIG_WRITE_HIGH_TABLES == 1
                /* Locate the High Tables at the Top of Low Memory below the Video RAM */
                high_tables_base = (uint64_t) (tolmk - (CONFIG_VIDEO_MB *1024) - HIGH_TABLES_SIZE) * 1024;
                high_tables_size = (uint64_t) HIGH_TABLES_SIZE* 1024;
-               printk_spew("tom: %lx, high_tables_base: %llx, high_tables_size: %llx\n", tomk*1024, high_tables_base, high_tables_size);
+               printk(BIOS_SPEW, "tom: %lx, high_tables_base: %llx, high_tables_size: %llx\n", tomk*1024, high_tables_base, high_tables_size);
 #endif
 
                /* Report the memory regions. */
@@ -265,37 +224,37 @@ static void cn400_domain_set_resources(device_t dev)
                ram_resource(dev, idx++, 768,
                             (tolmk - 768 - CONFIG_VIDEO_MB * 1024));
        }
-       assign_resources(&dev->link[0]);
-       
-       printk_spew("Leaving %s.\n", __func__);
+       assign_resources(dev->link_list);
+
+       printk(BIOS_SPEW, "Leaving %s.\n", __func__);
 }
 
 static unsigned int cn400_domain_scan_bus(device_t dev, unsigned int max)
 {
-       printk_debug("Entering %s.\n", __func__);
+       printk(BIOS_DEBUG, "Entering %s.\n", __func__);
 
-       max = pci_scan_bus(&dev->link[0], PCI_DEVFN(0, 0), 0xff, max);
+       max = pci_scan_bus(dev->link_list, PCI_DEVFN(0, 0), 0xff, max);
        return max;
 }
 
-static const struct device_operations pci_domain_ops = {
+static struct device_operations pci_domain_ops = {
        .read_resources   = cn400_domain_read_resources,
        .set_resources    = cn400_domain_set_resources,
-       .enable_resources = enable_childrens_resources,
-       .init             = 0,
+       .enable_resources = NULL,
+       .init             = NULL,
        .scan_bus         = cn400_domain_scan_bus,
 };
 
 static void cpu_bus_init(device_t dev)
 {
-       initialize_cpus(&dev->link[0]);
+       initialize_cpus(dev->link_list);
 }
 
 static void cpu_bus_noop(device_t dev)
 {
 }
 
-static const struct device_operations cpu_bus_ops = {
+static struct device_operations cpu_bus_ops = {
        .read_resources   = cpu_bus_noop,
        .set_resources    = cpu_bus_noop,
        .enable_resources = cpu_bus_noop,
@@ -305,7 +264,7 @@ static const struct device_operations cpu_bus_ops = {
 
 static void enable_dev(struct device *dev)
 {
-       printk_spew("In cn400 enable_dev for device %s.\n", dev_path(dev));
+       printk(BIOS_SPEW, "CN400: enable_dev for device %s.\n", dev_path(dev));
 
        /* Set the operations if it is a special bus type. */
        if (dev->path.type == DEVICE_PATH_PCI_DOMAIN) {