1207673Sjoel/*- 2207673Sjoel * Copyright (c) 2007-2008 Kip Macy <kmacy@freebsd.org> 3168490Skmacy * All rights reserved. 4168490Skmacy * 5168490Skmacy * Redistribution and use in source and binary forms, with or without 6207673Sjoel * modification, are permitted provided that the following conditions 7207673Sjoel * are met: 8207673Sjoel * 1. Redistributions of source code must retain the above copyright 9207673Sjoel * notice, this list of conditions and the following disclaimer. 10207673Sjoel * 2. Redistributions in binary form must reproduce the above copyright 11207673Sjoel * notice, this list of conditions and the following disclaimer in the 12207673Sjoel * documentation and/or other materials provided with the distribution. 13168490Skmacy * 14207673Sjoel * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15207673Sjoel * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16168490Skmacy * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17207673Sjoel * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18207673Sjoel * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19207673Sjoel * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20207673Sjoel * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21207673Sjoel * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22207673Sjoel * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23207673Sjoel * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24207673Sjoel * SUCH DAMAGE. 25207673Sjoel */ 26168490Skmacy 27168490Skmacy#include <sys/cdefs.h> 28168490Skmacy__FBSDID("$FreeBSD$"); 29168490Skmacy 30168490Skmacy#include <sys/param.h> 31168490Skmacy#include <sys/systm.h> 32168490Skmacy#include <sys/kernel.h> 33168490Skmacy#include <sys/lock.h> 34168490Skmacy#include <sys/malloc.h> 35168490Skmacy#include <sys/mbuf.h> 36168496Skmacy#include <sys/ktr.h> 37168490Skmacy 38174640Skmacy#include <vm/vm.h> 39174640Skmacy#include <vm/pmap.h> 40174640Skmacy 41168496Skmacy#include <machine/bus.h> 42170076Skmacy 43170076Skmacy#include <cxgb_include.h> 44174640Skmacy#include <sys/mvec.h> 45170076Skmacy 46168736Skmacy#ifdef INVARIANTS 47168736Skmacy#define M_SANITY m_sanity 48168736Skmacy#else 49168736Skmacy#define M_SANITY(a, b) 50168736Skmacy#endif 51168736Skmacy 52168496Skmacyint 53195006Snpbusdma_map_sg_collapse(bus_dma_tag_t tag, bus_dmamap_t map, 54194521Skmacy struct mbuf **m, bus_dma_segment_t *segs, int *nsegs) 55168490Skmacy{ 56194521Skmacy struct mbuf *n = *m; 57194521Skmacy int seg_count, defragged = 0, err = 0; 58194521Skmacy bus_dma_segment_t *psegs; 59175347Skmacy 60174640Skmacy KASSERT(n->m_pkthdr.len, ("packet has zero header len")); 61175340Skmacy if (n->m_pkthdr.len <= PIO_LEN) 62175340Skmacy return (0); 63174640Skmacyretry: 64194521Skmacy psegs = segs; 65174640Skmacy seg_count = 0; 66174640Skmacy if (n->m_next == NULL) { 67195006Snp busdma_map_mbuf_fast(tag, map, n, segs); 68174640Skmacy *nsegs = 1; 69174640Skmacy return (0); 70168490Skmacy } 71194521Skmacy#if defined(__i386__) || defined(__amd64__) 72174640Skmacy while (n && seg_count < TX_MAX_SEGS) { 73174640Skmacy /* 74174640Skmacy * firmware doesn't like empty segments 75174640Skmacy */ 76194521Skmacy if (__predict_true(n->m_len != 0)) { 77174640Skmacy seg_count++; 78195006Snp busdma_map_mbuf_fast(tag, map, n, psegs); 79194521Skmacy psegs++; 80194521Skmacy } 81174640Skmacy n = n->m_next; 82174640Skmacy } 83194521Skmacy#else 84195006Snp err = bus_dmamap_load_mbuf_sg(tag, map, *m, segs, &seg_count, 0); 85194521Skmacy#endif 86174640Skmacy if (seg_count == 0) { 87174640Skmacy if (cxgb_debug) 88174640Skmacy printf("empty segment chain\n"); 89174640Skmacy err = EFBIG; 90174640Skmacy goto err_out; 91194521Skmacy } else if (err == EFBIG || seg_count >= TX_MAX_SEGS) { 92174640Skmacy if (cxgb_debug) 93175121Skmacy printf("mbuf chain too long: %d max allowed %d\n", 94175121Skmacy seg_count, TX_MAX_SEGS); 95174640Skmacy if (!defragged) { 96243857Sglebius n = m_defrag(*m, M_NOWAIT); 97174640Skmacy if (n == NULL) { 98174640Skmacy err = ENOBUFS; 99174640Skmacy goto err_out; 100174640Skmacy } 101174640Skmacy *m = n; 102174640Skmacy defragged = 1; 103174640Skmacy goto retry; 104174640Skmacy } 105174640Skmacy err = EFBIG; 106174640Skmacy goto err_out; 107174640Skmacy } 108174640Skmacy 109174640Skmacy *nsegs = seg_count; 110194521Skmacyerr_out: 111168886Skmacy return (err); 112168490Skmacy} 113168490Skmacy 114174640Skmacyvoid 115195006Snpbusdma_map_sg_vec(bus_dma_tag_t tag, bus_dmamap_t map, 116194521Skmacy struct mbuf *m, bus_dma_segment_t *segs, int *nsegs) 117168750Skmacy{ 118175375Skmacy 119194521Skmacy for (*nsegs = 0; m != NULL ; segs++, *nsegs += 1, m = m->m_nextpkt) 120195006Snp busdma_map_mbuf_fast(tag, map, m, segs); 121168750Skmacy} 122168750Skmacy 123