18930c119SMarkus Pfeiffer /* $FreeBSD: head/sys/dev/usb/usb_mbuf.c 246122 2013-01-30 15:26:04Z hselasky $ */
212bd3c8bSSascha Wildner /*-
312bd3c8bSSascha Wildner * Copyright (c) 2008 Hans Petter Selasky. All rights reserved.
412bd3c8bSSascha Wildner *
512bd3c8bSSascha Wildner * Redistribution and use in source and binary forms, with or without
612bd3c8bSSascha Wildner * modification, are permitted provided that the following conditions
712bd3c8bSSascha Wildner * are met:
812bd3c8bSSascha Wildner * 1. Redistributions of source code must retain the above copyright
912bd3c8bSSascha Wildner * notice, this list of conditions and the following disclaimer.
1012bd3c8bSSascha Wildner * 2. Redistributions in binary form must reproduce the above copyright
1112bd3c8bSSascha Wildner * notice, this list of conditions and the following disclaimer in the
1212bd3c8bSSascha Wildner * documentation and/or other materials provided with the distribution.
1312bd3c8bSSascha Wildner *
1412bd3c8bSSascha Wildner * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1512bd3c8bSSascha Wildner * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1612bd3c8bSSascha Wildner * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1712bd3c8bSSascha Wildner * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
1812bd3c8bSSascha Wildner * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
1912bd3c8bSSascha Wildner * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2012bd3c8bSSascha Wildner * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2112bd3c8bSSascha Wildner * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2212bd3c8bSSascha Wildner * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2312bd3c8bSSascha Wildner * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2412bd3c8bSSascha Wildner * SUCH DAMAGE.
2512bd3c8bSSascha Wildner */
2612bd3c8bSSascha Wildner
2712bd3c8bSSascha Wildner #include <sys/stdint.h>
2812bd3c8bSSascha Wildner #include <sys/param.h>
2912bd3c8bSSascha Wildner #include <sys/queue.h>
3012bd3c8bSSascha Wildner #include <sys/types.h>
3112bd3c8bSSascha Wildner #include <sys/systm.h>
3212bd3c8bSSascha Wildner #include <sys/kernel.h>
3312bd3c8bSSascha Wildner #include <sys/bus.h>
3412bd3c8bSSascha Wildner #include <sys/module.h>
3512bd3c8bSSascha Wildner #include <sys/lock.h>
3612bd3c8bSSascha Wildner #include <sys/condvar.h>
3712bd3c8bSSascha Wildner #include <sys/sysctl.h>
3812bd3c8bSSascha Wildner #include <sys/unistd.h>
3912bd3c8bSSascha Wildner #include <sys/callout.h>
4012bd3c8bSSascha Wildner #include <sys/malloc.h>
41*2b3f93eaSMatthew Dillon #include <sys/caps.h>
4212bd3c8bSSascha Wildner
43722d05c3SSascha Wildner #include <bus/u4b/usb.h>
44722d05c3SSascha Wildner #include <bus/u4b/usbdi.h>
45722d05c3SSascha Wildner #include <bus/u4b/usb_dev.h>
46722d05c3SSascha Wildner #include <bus/u4b/usb_mbuf.h>
4712bd3c8bSSascha Wildner
4812bd3c8bSSascha Wildner /*------------------------------------------------------------------------*
4912bd3c8bSSascha Wildner * usb_alloc_mbufs - allocate mbufs to an usbd interface queue
5012bd3c8bSSascha Wildner *
5112bd3c8bSSascha Wildner * Returns:
5212bd3c8bSSascha Wildner * A pointer that should be passed to "free()" when the buffer(s)
5312bd3c8bSSascha Wildner * should be released.
5412bd3c8bSSascha Wildner *------------------------------------------------------------------------*/
5512bd3c8bSSascha Wildner void *
usb_alloc_mbufs(struct malloc_type * type,struct usb_ifqueue * ifq,usb_size_t block_size,uint16_t nblocks)5612bd3c8bSSascha Wildner usb_alloc_mbufs(struct malloc_type *type, struct usb_ifqueue *ifq,
5712bd3c8bSSascha Wildner usb_size_t block_size, uint16_t nblocks)
5812bd3c8bSSascha Wildner {
5912bd3c8bSSascha Wildner struct usb_mbuf *m_ptr;
6012bd3c8bSSascha Wildner uint8_t *data_ptr;
6112bd3c8bSSascha Wildner void *free_ptr = NULL;
6212bd3c8bSSascha Wildner usb_size_t alloc_size;
6312bd3c8bSSascha Wildner
6412bd3c8bSSascha Wildner /* align data */
6512bd3c8bSSascha Wildner block_size += ((-block_size) & (USB_HOST_ALIGN - 1));
6612bd3c8bSSascha Wildner
6712bd3c8bSSascha Wildner if (nblocks && block_size) {
6812bd3c8bSSascha Wildner
6912bd3c8bSSascha Wildner alloc_size = (block_size + sizeof(struct usb_mbuf)) * nblocks;
7012bd3c8bSSascha Wildner
71722d05c3SSascha Wildner free_ptr = kmalloc(alloc_size, type, M_WAITOK | M_ZERO);
7212bd3c8bSSascha Wildner
7357bed822SMarkus Pfeiffer if (free_ptr == NULL) {
7457bed822SMarkus Pfeiffer goto done;
7557bed822SMarkus Pfeiffer }
7612bd3c8bSSascha Wildner m_ptr = free_ptr;
7712bd3c8bSSascha Wildner data_ptr = (void *)(m_ptr + nblocks);
7812bd3c8bSSascha Wildner
7912bd3c8bSSascha Wildner while (nblocks--) {
8012bd3c8bSSascha Wildner
8112bd3c8bSSascha Wildner m_ptr->cur_data_ptr =
8212bd3c8bSSascha Wildner m_ptr->min_data_ptr = data_ptr;
8312bd3c8bSSascha Wildner
8412bd3c8bSSascha Wildner m_ptr->cur_data_len =
8512bd3c8bSSascha Wildner m_ptr->max_data_len = block_size;
8612bd3c8bSSascha Wildner
8712bd3c8bSSascha Wildner USB_IF_ENQUEUE(ifq, m_ptr);
8812bd3c8bSSascha Wildner
8912bd3c8bSSascha Wildner m_ptr++;
9012bd3c8bSSascha Wildner data_ptr += block_size;
9112bd3c8bSSascha Wildner }
9212bd3c8bSSascha Wildner }
9357bed822SMarkus Pfeiffer done:
9412bd3c8bSSascha Wildner return (free_ptr);
9512bd3c8bSSascha Wildner }
96