1 /* 2 * Copyright (c) 2003 3 * Hidetoshi Shimokawa. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. All advertising materials mentioning features or use of this software 14 * must display the following acknowledgement: 15 * 16 * This product includes software developed by Hidetoshi Shimokawa. 17 * 18 * 4. Neither the name of the author nor the names of its contributors 19 * may be used to endorse or promote products derived from this software 20 * without specific prior written permission. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32 * SUCH DAMAGE. 33 * 34 * $FreeBSD$ 35 */ 36 #include <sys/param.h> 37 #include <sys/systm.h> 38 #include <sys/types.h> 39 #include <sys/kernel.h> 40 #include <sys/malloc.h> 41 #include <sys/lock.h> 42 #include <sys/mutex.h> 43 44 #include <sys/bus.h> 45 #include <machine/bus.h> 46 47 #include <dev/firewire/firewire.h> 48 #include <dev/firewire/firewirereg.h> 49 #include <dev/firewire/fwdma.h> 50 51 static void 52 fwdma_map_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error) 53 { 54 bus_addr_t *baddr; 55 56 if (error) 57 printf("fwdma_map_cb: error=%d\n", error); 58 baddr = (bus_addr_t *)arg; 59 *baddr = segs->ds_addr; 60 } 61 62 void * 63 fwdma_malloc(struct firewire_comm *fc, int alignment, bus_size_t size, 64 struct fwdma_alloc *dma, int flag) 65 { 66 int err; 67 68 dma->v_addr = NULL; 69 err = bus_dma_tag_create( 70 /*parent*/ fc->dmat, 71 /*alignment*/ alignment, 72 /*boundary*/ 0, 73 /*lowaddr*/ BUS_SPACE_MAXADDR_32BIT, 74 /*highaddr*/ BUS_SPACE_MAXADDR, 75 /*filter*/NULL, /*filterarg*/NULL, 76 /*maxsize*/ size, 77 /*nsegments*/ 1, 78 /*maxsegsz*/ BUS_SPACE_MAXSIZE_32BIT, 79 /*flags*/ BUS_DMA_ALLOCNOW, 80 #if __FreeBSD_version >= 501102 81 /*lockfunc*/busdma_lock_mutex, 82 /*lockarg*/&Giant, 83 #endif 84 &dma->dma_tag); 85 if (err) { 86 printf("fwdma_malloc: failed(1)\n"); 87 return(NULL); 88 } 89 90 err = bus_dmamem_alloc(dma->dma_tag, &dma->v_addr, 91 flag, &dma->dma_map); 92 if (err) { 93 printf("fwdma_malloc: failed(2)\n"); 94 /* XXX destory tag */ 95 return(NULL); 96 } 97 98 bus_dmamap_load(dma->dma_tag, dma->dma_map, dma->v_addr, 99 size, fwdma_map_cb, &dma->bus_addr, /*flags*/0); 100 101 return(dma->v_addr); 102 } 103 104 void 105 fwdma_free(struct firewire_comm *fc, struct fwdma_alloc *dma) 106 { 107 bus_dmamap_unload(dma->dma_tag, dma->dma_map); 108 bus_dmamem_free(dma->dma_tag, dma->v_addr, dma->dma_map); 109 bus_dma_tag_destroy(dma->dma_tag); 110 } 111 112 113 void * 114 fwdma_malloc_size(bus_dma_tag_t dmat, bus_dmamap_t *dmamap, 115 bus_size_t size, bus_addr_t *bus_addr, int flag) 116 { 117 void *v_addr; 118 119 if (bus_dmamem_alloc(dmat, &v_addr, flag, dmamap)) { 120 printf("fwdma_malloc_size: failed(1)\n"); 121 return(NULL); 122 } 123 bus_dmamap_load(dmat, *dmamap, v_addr, size, 124 fwdma_map_cb, bus_addr, /*flags*/0); 125 return(v_addr); 126 } 127 128 void 129 fwdma_free_size(bus_dma_tag_t dmat, bus_dmamap_t dmamap, 130 void *vaddr, bus_size_t size) 131 { 132 bus_dmamap_unload(dmat, dmamap); 133 bus_dmamem_free(dmat, vaddr, dmamap); 134 } 135 136 /* 137 * Allocate multisegment dma buffers 138 * each segment size is eqaul to ssize except last segment. 139 */ 140 struct fwdma_alloc_multi * 141 fwdma_malloc_multiseg(struct firewire_comm *fc, int alignment, 142 int esize, int n, int flag) 143 { 144 struct fwdma_alloc_multi *am; 145 struct fwdma_seg *seg; 146 bus_size_t ssize; 147 int nseg; 148 149 if (esize > PAGE_SIZE) { 150 /* round up to PAGE_SIZE */ 151 esize = ssize = roundup2(esize, PAGE_SIZE); 152 nseg = n; 153 } else { 154 /* allocate PAGE_SIZE segment for small elements */ 155 ssize = rounddown(PAGE_SIZE, esize); 156 nseg = howmany(n, ssize / esize); 157 } 158 am = (struct fwdma_alloc_multi *)malloc(sizeof(struct fwdma_alloc_multi) 159 + sizeof(struct fwdma_seg)*nseg, M_FW, M_WAITOK); 160 if (am == NULL) { 161 printf("fwdma_malloc_multiseg: malloc failed\n"); 162 return(NULL); 163 } 164 am->ssize = ssize; 165 am->esize = esize; 166 am->nseg = 0; 167 if (bus_dma_tag_create( 168 /*parent*/ fc->dmat, 169 /*alignment*/ alignment, 170 /*boundary*/ 0, 171 /*lowaddr*/ BUS_SPACE_MAXADDR_32BIT, 172 /*highaddr*/ BUS_SPACE_MAXADDR, 173 /*filter*/NULL, /*filterarg*/NULL, 174 /*maxsize*/ ssize, 175 /*nsegments*/ 1, 176 /*maxsegsz*/ BUS_SPACE_MAXSIZE_32BIT, 177 /*flags*/ BUS_DMA_ALLOCNOW, 178 #if __FreeBSD_version >= 501102 179 /*lockfunc*/busdma_lock_mutex, 180 /*lockarg*/&Giant, 181 #endif 182 &am->dma_tag)) { 183 printf("fwdma_malloc_multiseg: tag_create failed\n"); 184 free(am, M_FW); 185 return(NULL); 186 } 187 188 #if 0 189 #if __FreeBSD_version < 500000 190 printf("malloc_multi: ssize=%d nseg=%d\n", ssize, nseg); 191 #else 192 printf("malloc_multi: ssize=%td nseg=%d\n", ssize, nseg); 193 #endif 194 #endif 195 for (seg = &am->seg[0]; nseg --; seg ++) { 196 seg->v_addr = fwdma_malloc_size(am->dma_tag, &seg->dma_map, 197 ssize, &seg->bus_addr, flag); 198 if (seg->v_addr == NULL) { 199 printf("fwdma_malloc_multi: malloc_size failed %d\n", 200 am->nseg); 201 fwdma_free_multiseg(am); 202 return(NULL); 203 } 204 am->nseg++; 205 } 206 return(am); 207 } 208 209 void 210 fwdma_free_multiseg(struct fwdma_alloc_multi *am) 211 { 212 struct fwdma_seg *seg; 213 214 for (seg = &am->seg[0]; am->nseg --; seg ++) { 215 fwdma_free_size(am->dma_tag, seg->dma_map, 216 seg->v_addr, am->ssize); 217 } 218 bus_dma_tag_destroy(am->dma_tag); 219 free(am, M_FW); 220 } 221