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