3 * Hidetoshi Shimokawa. All rights reserved.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
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:
16 * This product includes software developed by Hidetoshi Shimokawa.
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.
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
34 * $FreeBSD: src/sys/dev/firewire/fwdma.c,v 1.5 2003/08/24 17:46:07 obrien Exp $
37 #include <sys/param.h>
38 #include <sys/systm.h>
41 #include <sys/types.h>
42 #include <sys/kernel.h>
43 #include <sys/malloc.h>
44 #if defined(__FreeBSD__) && __FreeBSD_version >= 501102
46 #include <sys/mutex.h>
50 #include <bus/firewire/firewire.h>
51 #include <bus/firewire/firewirereg.h>
52 #include <bus/firewire/fwdma.h>
54 #include <dev/firewire/firewire.h>
55 #include <dev/firewire/firewirereg.h>
56 #include <dev/firewire/fwdma.h>
60 fwdma_map_cb(void *arg
, bus_dma_segment_t
*segs
, int nseg
, int error
)
65 kprintf("fwdma_map_cb: error=%d\n", error
);
66 baddr
= (bus_addr_t
*)arg
;
67 *baddr
= segs
->ds_addr
;
71 fwdma_malloc(struct firewire_comm
*fc
, int alignment
, bus_size_t size
,
72 struct fwdma_alloc
*dma
, int flag
)
77 err
= bus_dma_tag_create(
79 /*alignment*/ alignment
,
81 /*lowaddr*/ BUS_SPACE_MAXADDR_32BIT
,
82 /*highaddr*/ BUS_SPACE_MAXADDR
,
83 /*filter*/NULL
, /*filterarg*/NULL
,
86 /*maxsegsz*/ BUS_SPACE_MAXSIZE_32BIT
,
87 /*flags*/ BUS_DMA_ALLOCNOW
,
88 #if defined(__FreeBSD__) && __FreeBSD_version >= 501102
89 /*lockfunc*/busdma_lock_mutex
,
94 kprintf("fwdma_malloc: failed(1)\n");
98 err
= bus_dmamem_alloc(dma
->dma_tag
, &dma
->v_addr
,
101 kprintf("fwdma_malloc: failed(2)\n");
102 /* XXX destory tag */
106 bus_dmamap_load(dma
->dma_tag
, dma
->dma_map
, dma
->v_addr
,
107 size
, fwdma_map_cb
, &dma
->bus_addr
, /*flags*/0);
113 fwdma_free(struct firewire_comm
*fc
, struct fwdma_alloc
*dma
)
115 bus_dmamap_unload(dma
->dma_tag
, dma
->dma_map
);
116 bus_dmamem_free(dma
->dma_tag
, dma
->v_addr
, dma
->dma_map
);
117 bus_dma_tag_destroy(dma
->dma_tag
);
122 fwdma_malloc_size(bus_dma_tag_t dmat
, bus_dmamap_t
*dmamap
,
123 bus_size_t size
, bus_addr_t
*bus_addr
, int flag
)
127 if (bus_dmamem_alloc(dmat
, &v_addr
, flag
, dmamap
)) {
128 kprintf("fwdma_malloc_size: failed(1)\n");
131 bus_dmamap_load(dmat
, *dmamap
, v_addr
, size
,
132 fwdma_map_cb
, bus_addr
, /*flags*/0);
137 fwdma_free_size(bus_dma_tag_t dmat
, bus_dmamap_t dmamap
,
138 void *vaddr
, bus_size_t size
)
140 bus_dmamap_unload(dmat
, dmamap
);
141 bus_dmamem_free(dmat
, vaddr
, dmamap
);
145 * Allocate multisegment dma buffers
146 * each segment size is eqaul to ssize except last segment.
148 struct fwdma_alloc_multi
*
149 fwdma_malloc_multiseg(struct firewire_comm
*fc
, int alignment
,
150 int esize
, int n
, int flag
)
152 struct fwdma_alloc_multi
*am
;
153 struct fwdma_seg
*seg
;
157 if (esize
> PAGE_SIZE
) {
158 /* round up to PAGE_SIZE */
159 esize
= ssize
= roundup2(esize
, PAGE_SIZE
);
162 /* allocate PAGE_SIZE segment for small elements */
163 ssize
= rounddown(PAGE_SIZE
, esize
);
164 nseg
= howmany(n
, ssize
/ esize
);
166 am
= (struct fwdma_alloc_multi
*)kmalloc(sizeof(struct fwdma_alloc_multi
)
167 + sizeof(struct fwdma_seg
)*nseg
, M_FW
, M_WAITOK
);
171 if (bus_dma_tag_create(
173 /*alignment*/ alignment
,
175 /*lowaddr*/ BUS_SPACE_MAXADDR_32BIT
,
176 /*highaddr*/ BUS_SPACE_MAXADDR
,
177 /*filter*/NULL
, /*filterarg*/NULL
,
180 /*maxsegsz*/ BUS_SPACE_MAXSIZE_32BIT
,
181 /*flags*/ BUS_DMA_ALLOCNOW
,
182 #if defined(__FreeBSD__) && __FreeBSD_version >= 501102
183 /*lockfunc*/busdma_lock_mutex
,
187 kprintf("fwdma_malloc_multiseg: tag_create failed\n");
193 #if defined(__DragonFly__) || __FreeBSD_version < 500000
194 kprintf("malloc_multi: ssize=%d nseg=%d\n", ssize
, nseg
);
196 kprintf("malloc_multi: ssize=%td nseg=%d\n", ssize
, nseg
);
199 for (seg
= &am
->seg
[0]; nseg
--; seg
++) {
200 seg
->v_addr
= fwdma_malloc_size(am
->dma_tag
, &seg
->dma_map
,
201 ssize
, &seg
->bus_addr
, flag
);
202 if (seg
->v_addr
== NULL
) {
203 kprintf("fwdma_malloc_multi: malloc_size failed %d\n",
205 fwdma_free_multiseg(am
);
214 fwdma_free_multiseg(struct fwdma_alloc_multi
*am
)
216 struct fwdma_seg
*seg
;
218 for (seg
= &am
->seg
[0]; am
->nseg
--; seg
++) {
219 fwdma_free_size(am
->dma_tag
, seg
->dma_map
,
220 seg
->v_addr
, am
->ssize
);
222 bus_dma_tag_destroy(am
->dma_tag
);