diff options
Diffstat (limited to 'src/device')
-rw-r--r-- | src/device/Makefile.inc | 3 | ||||
-rw-r--r-- | src/device/xhci.c | 110 | ||||
-rw-r--r-- | src/device/xhci_resource.c | 116 |
3 files changed, 134 insertions, 95 deletions
diff --git a/src/device/Makefile.inc b/src/device/Makefile.inc index 3018ef9626..7da6ea85d3 100644 --- a/src/device/Makefile.inc +++ b/src/device/Makefile.inc @@ -61,7 +61,8 @@ ramstage-y += mmio.c ramstage-y += resource_allocator_common.c ramstage-y += resource_allocator_v4.c -ramstage-$(CONFIG_XHCI_UTILS) += xhci.c +ramstage-$(CONFIG_XHCI_UTILS) += xhci.c xhci_resource.c +smm-$(CONFIG_XHCI_UTILS) += xhci_resource.c ramstage-y += gpio.c ramstage-y += mdio.c diff --git a/src/device/xhci.c b/src/device/xhci.c index f7c5958a6c..0961d0c988 100644 --- a/src/device/xhci.c +++ b/src/device/xhci.c @@ -2,31 +2,18 @@ #include <console/console.h> #include <device/mmio.h> +#include <device/device.h> #include <device/pci_def.h> #include <device/xhci.h> -#include <string.h> - -union xhci_ext_caps_header { - uint32_t val; - struct { - uint32_t cap_id : 8; - uint32_t next_ptr : 8; - uint32_t reserved : 16; - }; -}; enum cb_err xhci_for_each_ext_cap(const struct device *device, void *context, void (*callback)(void *context, const struct xhci_ext_cap *cap)) { - struct resource *res; - uint32_t *ext_cap_ptr; - uint32_t ext_caps_word_offset; - union xhci_ext_caps_header header; - struct xhci_ext_cap cap; + const struct resource *res; - if (!device || !callback) - return CB_ERR_ARG; + if (!device) + return CB_ERR; res = probe_resource(device, PCI_BASE_ADDRESS_0); if (!res) { @@ -35,89 +22,24 @@ enum cb_err xhci_for_each_ext_cap(const struct device *device, void *context, return CB_ERR; } - if (!(res->flags & IORESOURCE_ASSIGNED)) { - printk(BIOS_ERR, "%s: BAR is not assigned\n", __func__); - return CB_ERR; - } - - if (res->limit > 0xFFFFFFFF) { - printk(BIOS_ERR, "%s: 64-bit BAR is not supported\n", __func__); - return CB_ERR; - } - - ext_caps_word_offset = read16(res2mmio(res, XHCI_HCCPARAMS1_XECP, 0)); - - if (!ext_caps_word_offset) { - printk(BIOS_ERR, "%s: No extended capabilities defined\n", __func__); - return CB_ERR; - } - - ext_cap_ptr = res2mmio(res, ext_caps_word_offset << 2, 0); - - while ((uintptr_t)ext_cap_ptr < (uintptr_t)res->limit) { - header.val = read32(ext_cap_ptr); - - cap.cap_id = header.cap_id; - - if (header.cap_id == XHCI_ECP_CAP_ID_SUPP) { - cap.supported_protocol.reg0 = header.val; - cap.supported_protocol.reg1 = read32(ext_cap_ptr + 1); - cap.supported_protocol.reg2 = read32(ext_cap_ptr + 2); - } - - callback(context, &cap); - - if (!header.next_ptr) - break; - - ext_cap_ptr += header.next_ptr; - } - - return CB_SUCCESS; -} - -struct supported_usb_cap_context { - void *context; - void (*callback)(void *context, const struct xhci_supported_protocol *data); -}; - -static void xhci_supported_usb_cap_handler(void *context, const struct xhci_ext_cap *cap) -{ - const struct xhci_supported_protocol *data; - struct supported_usb_cap_context *internal_context = context; - - if (cap->cap_id != XHCI_ECP_CAP_ID_SUPP) - return; - - data = &cap->supported_protocol; - - if (memcmp(data->name, "USB ", 4)) { - printk(BIOS_DEBUG, "%s: Unknown Protocol: %.*s\n", __func__, - (int)sizeof(data->name), data->name); - return; - } - - internal_context->callback(internal_context->context, data); + return xhci_resource_for_each_ext_cap(res, context, callback); } enum cb_err xhci_for_each_supported_usb_cap( const struct device *device, void *context, void (*callback)(void *context, const struct xhci_supported_protocol *data)) { - struct supported_usb_cap_context internal_context = { - .context = context, - .callback = callback, - }; + const struct resource *res; - return xhci_for_each_ext_cap(device, &internal_context, xhci_supported_usb_cap_handler); -} + if (!device) + return CB_ERR; -void xhci_print_supported_protocol(const struct xhci_supported_protocol *supported_protocol) -{ - printk(BIOS_DEBUG, "xHCI Supported Protocol:\n"); - printk(BIOS_DEBUG, " Major: %#x, Minor: %#x, Protocol: '%.*s'\n", - supported_protocol->major_rev, supported_protocol->minor_rev, - (int)sizeof(supported_protocol->name), supported_protocol->name); - printk(BIOS_DEBUG, " Port Offset: %d, Port Count: %d\n", - supported_protocol->port_offset, supported_protocol->port_count); + res = probe_resource(device, PCI_BASE_ADDRESS_0); + if (!res) { + printk(BIOS_ERR, "%s: Unable to find BAR resource for %s\n", __func__, + dev_path(device)); + return CB_ERR; + } + + return xhci_resource_for_each_supported_usb_cap(res, context, callback); } diff --git a/src/device/xhci_resource.c b/src/device/xhci_resource.c new file mode 100644 index 0000000000..31f2610823 --- /dev/null +++ b/src/device/xhci_resource.c @@ -0,0 +1,116 @@ +/* SPDX-License-Identifier: GPL-2.0-or-later */ + +#include <arch/mmio.h> +#include <console/console.h> +#include <device/pci_def.h> +#include <device/xhci.h> +#include <string.h> + +union xhci_ext_caps_header { + uint32_t val; + struct { + uint32_t cap_id : 8; + uint32_t next_ptr : 8; + uint32_t reserved : 16; + }; +}; + +enum cb_err xhci_resource_for_each_ext_cap(const struct resource *res, void *context, + void (*callback)(void *context, + const struct xhci_ext_cap *cap)) +{ + uint32_t *ext_cap_ptr; + uint32_t ext_caps_word_offset; + union xhci_ext_caps_header header; + struct xhci_ext_cap cap; + + if (!res || !callback) + return CB_ERR_ARG; + + if (!(res->flags & IORESOURCE_ASSIGNED)) { + printk(BIOS_ERR, "%s: BAR is not assigned\n", __func__); + return CB_ERR; + } + + if (res->limit > 0xFFFFFFFF) { + printk(BIOS_ERR, "%s: 64-bit BAR is not supported\n", __func__); + return CB_ERR; + } + + ext_caps_word_offset = read16(res2mmio(res, XHCI_HCCPARAMS1_XECP, 0)); + + if (!ext_caps_word_offset) { + printk(BIOS_ERR, "%s: No extended capabilities defined\n", __func__); + return CB_ERR; + } + + ext_cap_ptr = res2mmio(res, ext_caps_word_offset << 2, 0); + + while ((uintptr_t)ext_cap_ptr < (uintptr_t)res->limit) { + header.val = read32(ext_cap_ptr); + + cap.cap_id = header.cap_id; + + if (header.cap_id == XHCI_ECP_CAP_ID_SUPP) { + cap.supported_protocol.reg0 = header.val; + cap.supported_protocol.reg1 = read32(ext_cap_ptr + 1); + cap.supported_protocol.reg2 = read32(ext_cap_ptr + 2); + } + + callback(context, &cap); + + if (!header.next_ptr) + break; + + ext_cap_ptr += header.next_ptr; + } + + return CB_SUCCESS; +} + +struct supported_usb_cap_context { + void *context; + void (*callback)(void *context, const struct xhci_supported_protocol *data); +}; + +static void xhci_supported_usb_cap_handler(void *context, const struct xhci_ext_cap *cap) +{ + const struct xhci_supported_protocol *data; + struct supported_usb_cap_context *internal_context = context; + + if (cap->cap_id != XHCI_ECP_CAP_ID_SUPP) + return; + + data = &cap->supported_protocol; + + if (memcmp(data->name, "USB ", 4)) { + printk(BIOS_DEBUG, "%s: Unknown Protocol: %.*s\n", __func__, + (int)sizeof(data->name), data->name); + return; + } + + internal_context->callback(internal_context->context, data); +} + +enum cb_err xhci_resource_for_each_supported_usb_cap( + const struct resource *res, void *context, + void (*callback)(void *context, const struct xhci_supported_protocol *data)) +{ + struct supported_usb_cap_context internal_context = { + .context = context, + .callback = callback, + }; + + return xhci_resource_for_each_ext_cap(res, &internal_context, + xhci_supported_usb_cap_handler); +} + +void xhci_print_supported_protocol(const struct xhci_supported_protocol *supported_protocol) +{ + printk(BIOS_DEBUG, "xHCI Supported Protocol:\n"); + printk(BIOS_DEBUG, " Major: %#x, Minor: %#x, Protocol: '%.*s'\n", + supported_protocol->major_rev, supported_protocol->minor_rev, + (int)sizeof(supported_protocol->name), supported_protocol->name); + printk(BIOS_DEBUG, " Port Offset: %d, Port Count: %d\n", + supported_protocol->port_offset, supported_protocol->port_count); +} |