diff options
Diffstat (limited to 'src/soc/amd/stoneyridge')
-rw-r--r-- | src/soc/amd/stoneyridge/lpc.c | 119 |
1 files changed, 24 insertions, 95 deletions
diff --git a/src/soc/amd/stoneyridge/lpc.c b/src/soc/amd/stoneyridge/lpc.c index 3cd9acb7a4..1e03feabb6 100644 --- a/src/soc/amd/stoneyridge/lpc.c +++ b/src/soc/amd/stoneyridge/lpc.c @@ -158,39 +158,14 @@ static void lpc_set_resources(struct device *dev) pci_dev_set_resources(dev); } -/* - * Structure to simplify code obtaining the total of used wide IO - * registers and the size assigned to each. Used on set_child_resource - * and lpc_enable_childrens_resources. - */ -struct _wide_IO_enable_bits { - u32 enable[3]; - u8 alt[3]; -} wio_en = { - { - LPC_WIDEIO0_ENABLE, - LPC_WIDEIO1_ENABLE, - LPC_WIDEIO2_ENABLE - }, - { - LPC_ALT_WIDEIO0_ENABLE, - LPC_ALT_WIDEIO1_ENABLE, - LPC_ALT_WIDEIO2_ENABLE - } -}; - static void set_child_resource(device_t child, - int *wio_total_ptr, - u16 *reg_var, u32 *reg, - u32 *reg_x, - u8 *wiosize) + u32 *reg_x) { struct resource *res; u32 base, end; u32 rsize = 0, set = 0, set_x = 0; - int i, wio_total = *wio_total_ptr; - u16 reg_size[3]; + int wideio_index; /* * Be a bit relaxed, tolerate that LPC region might be bigger than @@ -203,17 +178,6 @@ static void set_child_resource(device_t child, * setting a new wide IO resource if one is already set. */ - /* - * For each wideIO get the current size, 16, 512, - * or 0 if it isn't used. - */ - for (i = 0; i < 3; i++) { - if (i < wio_total) /* convert to index */ - reg_size[i] = (*wiosize & wio_en.alt[i]) ? 16 : 512; - else - reg_size[i] = 0; - } - for (res = child->resource_list; res; res = res->next) { if (!(res->flags & IORESOURCE_IO)) continue; @@ -289,18 +253,11 @@ static void set_child_resource(device_t child, break; default: rsize = 0; - if (wio_total > 0) { - for (i = 0; i < wio_total; i++) { - if ((base >= reg_var[i]) && - ((base + res->size) <= - (reg_var[i] + reg_size[i]))) { - rsize = reg_size[i]; - printk(BIOS_DEBUG, - "Covered by wideIO"); - printk(BIOS_DEBUG, " %d\n", i); - break; - } - } + wideio_index = sb_find_wideio_range(base, res->size); + if (wideio_index != WIDEIO_RANGE_ERROR) { + rsize = sb_wideio_size(wideio_index); + printk(BIOS_DEBUG, "Covered by wideIO"); + printk(BIOS_DEBUG, " %d\n", wideio_index); } } /* check if region found and matches the enable */ @@ -308,18 +265,23 @@ static void set_child_resource(device_t child, *reg |= set; *reg_x |= set_x; /* check if we can fit resource in variable range */ - } else if ((wio_total < 3) && (res->size <= 512)) { - reg_var[wio_total] = base; - *reg_x |= wio_en.enable[i]; - if (res->size <= 16) - *wiosize |= wio_en.alt[wio_total]; - wio_total++; - *wio_total_ptr = wio_total; } else { - printk(BIOS_ERR, - "cannot fit LPC decode region:"); - printk(BIOS_ERR, "%s, base = 0x%08x, end = 0x%08x\n", - dev_path(child), base, end); + wideio_index = sb_set_wideio_range(base, res->size); + if (wideio_index != WIDEIO_RANGE_ERROR) { + /* preserve wide IO related bits. */ + *reg_x = pci_read_config32(SOC_LPC_DEV, + LPC_IO_OR_MEM_DECODE_ENABLE); + + printk(BIOS_DEBUG, + "Range assigned to wide IO %d\n", + wideio_index); + } else { + printk(BIOS_ERR, + "cannot fit LPC decode region:"); + printk(BIOS_ERR, + "%s, base = 0x%08x, end = 0x%08x\n", + dev_path(child), base, end); + } } } } @@ -334,27 +296,10 @@ static void lpc_enable_childrens_resources(device_t dev) { struct bus *link; u32 reg, reg_x; - int i, wio_total = 0; - u16 reg_var[3]; - u8 wiosize = pci_read_config8(dev, LPC_ALT_WIDEIO_RANGE_ENABLE); reg = pci_read_config32(dev, LPC_IO_PORT_DECODE_ENABLE); reg_x = pci_read_config32(dev, LPC_IO_OR_MEM_DECODE_ENABLE); - /* - * Detect the number of used ranges (wide IO), and don't use those - * already taken. - */ - for (i = 0; i < 3; i++) { - if (reg_x & wio_en.enable[i]) - wio_total = i + 1; - } - - reg_var[2] = pci_read_config16(dev, LPC_WIDEIO2_GENERIC_PORT); - reg_var[1] = pci_read_config16(dev, LPC_WIDEIO1_GENERIC_PORT); - reg_var[0] = pci_read_config16(dev, LPC_WIDEIO_GENERIC_PORT); - - /* todo: clean up the code style here */ for (link = dev->link_list; link; link = link->next) { device_t child; for (child = link->children; child; @@ -362,29 +307,13 @@ static void lpc_enable_childrens_resources(device_t dev) if (child->enabled && (child->path.type == DEVICE_PATH_PNP)) { set_child_resource(child, - &wio_total, - reg_var, ®, - ®_x, - &wiosize); + ®_x); } } } pci_write_config32(dev, LPC_IO_PORT_DECODE_ENABLE, reg); pci_write_config32(dev, LPC_IO_OR_MEM_DECODE_ENABLE, reg_x); - /* Set WideIO for as many IOs found (fall through is on purpose) */ - switch (wio_total) { - case 3: - pci_write_config16(dev, LPC_WIDEIO2_GENERIC_PORT, reg_var[2]); - /* fall through */ - case 2: - pci_write_config16(dev, LPC_WIDEIO1_GENERIC_PORT, reg_var[1]); - /* fall through */ - case 1: - pci_write_config16(dev, LPC_WIDEIO_GENERIC_PORT, reg_var[0]); - break; - } - pci_write_config8(dev, LPC_ALT_WIDEIO_RANGE_ENABLE, wiosize); } static void lpc_enable_resources(device_t dev) |