102ac6454SAndrew Thompson /*-
2*4d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro F. Giffuni *
402ac6454SAndrew Thompson * Copyright (c) 2008 Hans Petter Selasky. All rights reserved.
502ac6454SAndrew Thompson *
602ac6454SAndrew Thompson * Redistribution and use in source and binary forms, with or without
702ac6454SAndrew Thompson * modification, are permitted provided that the following conditions
802ac6454SAndrew Thompson * are met:
902ac6454SAndrew Thompson * 1. Redistributions of source code must retain the above copyright
1002ac6454SAndrew Thompson * notice, this list of conditions and the following disclaimer.
1102ac6454SAndrew Thompson * 2. Redistributions in binary form must reproduce the above copyright
1202ac6454SAndrew Thompson * notice, this list of conditions and the following disclaimer in the
1302ac6454SAndrew Thompson * documentation and/or other materials provided with the distribution.
1402ac6454SAndrew Thompson *
1502ac6454SAndrew Thompson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1602ac6454SAndrew Thompson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1702ac6454SAndrew Thompson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1802ac6454SAndrew Thompson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
1902ac6454SAndrew Thompson * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2002ac6454SAndrew Thompson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2102ac6454SAndrew Thompson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2202ac6454SAndrew Thompson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2302ac6454SAndrew Thompson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2402ac6454SAndrew Thompson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2502ac6454SAndrew Thompson * SUCH DAMAGE.
2602ac6454SAndrew Thompson */
2702ac6454SAndrew Thompson
28d2b99310SHans Petter Selasky #ifdef USB_GLOBAL_INCLUDE_FILE
29d2b99310SHans Petter Selasky #include USB_GLOBAL_INCLUDE_FILE
30d2b99310SHans Petter Selasky #else
31ed6d949aSAndrew Thompson #include <sys/stdint.h>
32ed6d949aSAndrew Thompson #include <sys/stddef.h>
33ed6d949aSAndrew Thompson #include <sys/param.h>
34ed6d949aSAndrew Thompson #include <sys/queue.h>
35ed6d949aSAndrew Thompson #include <sys/types.h>
36ed6d949aSAndrew Thompson #include <sys/systm.h>
37ed6d949aSAndrew Thompson #include <sys/kernel.h>
38ed6d949aSAndrew Thompson #include <sys/bus.h>
39ed6d949aSAndrew Thompson #include <sys/module.h>
40ed6d949aSAndrew Thompson #include <sys/lock.h>
41ed6d949aSAndrew Thompson #include <sys/mutex.h>
42ed6d949aSAndrew Thompson #include <sys/condvar.h>
43ed6d949aSAndrew Thompson #include <sys/sysctl.h>
44ed6d949aSAndrew Thompson #include <sys/sx.h>
45ed6d949aSAndrew Thompson #include <sys/unistd.h>
46ed6d949aSAndrew Thompson #include <sys/callout.h>
47ed6d949aSAndrew Thompson #include <sys/malloc.h>
48ed6d949aSAndrew Thompson #include <sys/priv.h>
49ed6d949aSAndrew Thompson
50ed6d949aSAndrew Thompson #include <dev/usb/usb.h>
51ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h>
52ed6d949aSAndrew Thompson #include <dev/usb/usb_dev.h>
5302ac6454SAndrew Thompson #include <dev/usb/usb_mbuf.h>
54d2b99310SHans Petter Selasky #endif /* USB_GLOBAL_INCLUDE_FILE */
5502ac6454SAndrew Thompson
5602ac6454SAndrew Thompson /*------------------------------------------------------------------------*
57a593f6b8SAndrew Thompson * usb_alloc_mbufs - allocate mbufs to an usbd interface queue
5802ac6454SAndrew Thompson *
5902ac6454SAndrew Thompson * Returns:
6002ac6454SAndrew Thompson * A pointer that should be passed to "free()" when the buffer(s)
6102ac6454SAndrew Thompson * should be released.
6202ac6454SAndrew Thompson *------------------------------------------------------------------------*/
6302ac6454SAndrew Thompson void *
usb_alloc_mbufs(struct malloc_type * type,struct usb_ifqueue * ifq,usb_size_t block_size,uint16_t nblocks)64a593f6b8SAndrew Thompson usb_alloc_mbufs(struct malloc_type *type, struct usb_ifqueue *ifq,
65f9cb546cSAndrew Thompson usb_size_t block_size, uint16_t nblocks)
6602ac6454SAndrew Thompson {
67760bc48eSAndrew Thompson struct usb_mbuf *m_ptr;
6802ac6454SAndrew Thompson uint8_t *data_ptr;
6902ac6454SAndrew Thompson void *free_ptr = NULL;
70f9cb546cSAndrew Thompson usb_size_t alloc_size;
7102ac6454SAndrew Thompson
7202ac6454SAndrew Thompson /* align data */
7302ac6454SAndrew Thompson block_size += ((-block_size) & (USB_HOST_ALIGN - 1));
7402ac6454SAndrew Thompson
7502ac6454SAndrew Thompson if (nblocks && block_size) {
76760bc48eSAndrew Thompson alloc_size = (block_size + sizeof(struct usb_mbuf)) * nblocks;
7702ac6454SAndrew Thompson
7802ac6454SAndrew Thompson free_ptr = malloc(alloc_size, type, M_WAITOK | M_ZERO);
7902ac6454SAndrew Thompson m_ptr = free_ptr;
8002ac6454SAndrew Thompson data_ptr = (void *)(m_ptr + nblocks);
8102ac6454SAndrew Thompson
8202ac6454SAndrew Thompson while (nblocks--) {
8302ac6454SAndrew Thompson m_ptr->cur_data_ptr =
8402ac6454SAndrew Thompson m_ptr->min_data_ptr = data_ptr;
8502ac6454SAndrew Thompson
8602ac6454SAndrew Thompson m_ptr->cur_data_len =
8702ac6454SAndrew Thompson m_ptr->max_data_len = block_size;
8802ac6454SAndrew Thompson
8902ac6454SAndrew Thompson USB_IF_ENQUEUE(ifq, m_ptr);
9002ac6454SAndrew Thompson
9102ac6454SAndrew Thompson m_ptr++;
9202ac6454SAndrew Thompson data_ptr += block_size;
9302ac6454SAndrew Thompson }
9402ac6454SAndrew Thompson }
9502ac6454SAndrew Thompson return (free_ptr);
9602ac6454SAndrew Thompson }
97