From 2296a5e22c8fe51bcfa7ea899d61b825077cb640 Mon Sep 17 00:00:00 2001 From: Ian Moffett Date: Thu, 4 Apr 2024 22:26:39 -0400 Subject: kernel: xhci: Fix scratchpad buffer code Signed-off-by: Ian Moffett --- sys/dev/usb/xhci.c | 31 +++++++++++++++++++++++-------- 1 file changed, 23 insertions(+), 8 deletions(-) (limited to 'sys') diff --git a/sys/dev/usb/xhci.c b/sys/dev/usb/xhci.c index 26e155c..5659d61 100644 --- a/sys/dev/usb/xhci.c +++ b/sys/dev/usb/xhci.c @@ -35,7 +35,6 @@ #include #include #include -#include #include #include #include @@ -192,7 +191,7 @@ xhci_init_scratchpads(struct xhci_hc *hc) { struct xhci_caps *caps = XHCI_CAPS(hc->base); uint16_t max_bufs_lo, max_bufs_hi, max_bufs; - uintptr_t buffer_array; + uintptr_t *buffer_array, tmp; max_bufs_lo = XHCI_MAX_SP_LO(caps->hcsparams2); max_bufs_hi = XHCI_MAX_SP_HI(caps->hcsparams2); @@ -206,15 +205,31 @@ xhci_init_scratchpads(struct xhci_hc *hc) return 0; } - KINFO("HC requires %d max scratchpad buffers(s)\n", max_bufs); - buffer_array = vm_alloc_pageframe(max_bufs); - if (buffer_array == 0) { - KERR("Failed to allocate scratchpad buffer(s)\n"); + KINFO("Need %d scratchpad buffers\n", max_bufs); + + /* Allocate buffer array */ + buffer_array = dynalloc_memalign(sizeof(uintptr_t)*max_bufs, 0x1000); + if (buffer_array == NULL) { + KERR("Failed to allocate scratchpad buffer array\n"); return -1; } - vm_zero_page(PHYS_TO_VIRT(buffer_array), max_bufs); - hc->dcbaap[0] = buffer_array; + memset(buffer_array, 0, sizeof(uintptr_t)*max_bufs); + + /* Fill the buffer array */ + for (size_t i = 0; i < max_bufs; ++i) { + tmp = vm_alloc_pageframe(1); + + if (tmp == 0) { + /* TODO: Shutdown, free memory */ + KERR("Failed to fill scratchpad buffer array\n"); + return -1; + } + + buffer_array[i] = tmp; + } + + hc->dcbaap[0] = VIRT_TO_PHYS(buffer_array); return 0; } -- cgit v1.2.3