diff options
Diffstat (limited to 'arch/sparc64/kernel/iommu_common.c')
-rw-r--r-- | arch/sparc64/kernel/iommu_common.c | 51 |
1 files changed, 30 insertions, 21 deletions
diff --git a/arch/sparc64/kernel/iommu_common.c b/arch/sparc64/kernel/iommu_common.c index 12c93a3eee26..d7ca900ec51d 100644 --- a/arch/sparc64/kernel/iommu_common.c +++ b/arch/sparc64/kernel/iommu_common.c | |||
@@ -12,18 +12,22 @@ | |||
12 | */ | 12 | */ |
13 | 13 | ||
14 | #ifdef VERIFY_SG | 14 | #ifdef VERIFY_SG |
15 | static int verify_lengths(struct scatterlist *sg, int nents, int npages) | 15 | static int verify_lengths(struct scatterlist *sglist, int nents, int npages) |
16 | { | 16 | { |
17 | int sg_len, dma_len; | 17 | int sg_len, dma_len; |
18 | int i, pgcount; | 18 | int i, pgcount; |
19 | struct scatterlist *sg; | ||
19 | 20 | ||
20 | sg_len = 0; | 21 | sg_len = 0; |
21 | for (i = 0; i < nents; i++) | 22 | for_each_sg(sglist, sg, nents, i) |
22 | sg_len += sg[i].length; | 23 | sg_len += sg->length; |
23 | 24 | ||
24 | dma_len = 0; | 25 | dma_len = 0; |
25 | for (i = 0; i < nents && sg[i].dma_length; i++) | 26 | for_each_sg(sglist, sg, nents, i) { |
26 | dma_len += sg[i].dma_length; | 27 | if (!sg->dma_length) |
28 | break; | ||
29 | dma_len += sg->dma_length; | ||
30 | } | ||
27 | 31 | ||
28 | if (sg_len != dma_len) { | 32 | if (sg_len != dma_len) { |
29 | printk("verify_lengths: Error, different, sg[%d] dma[%d]\n", | 33 | printk("verify_lengths: Error, different, sg[%d] dma[%d]\n", |
@@ -32,13 +36,16 @@ static int verify_lengths(struct scatterlist *sg, int nents, int npages) | |||
32 | } | 36 | } |
33 | 37 | ||
34 | pgcount = 0; | 38 | pgcount = 0; |
35 | for (i = 0; i < nents && sg[i].dma_length; i++) { | 39 | for_each_sg(sglist, sg, nents, i) { |
36 | unsigned long start, end; | 40 | unsigned long start, end; |
37 | 41 | ||
38 | start = sg[i].dma_address; | 42 | if (!sg->dma_length) |
43 | break; | ||
44 | |||
45 | start = sg->dma_address; | ||
39 | start = start & IO_PAGE_MASK; | 46 | start = start & IO_PAGE_MASK; |
40 | 47 | ||
41 | end = sg[i].dma_address + sg[i].dma_length; | 48 | end = sg->dma_address + sg->dma_length; |
42 | end = (end + (IO_PAGE_SIZE - 1)) & IO_PAGE_MASK; | 49 | end = (end + (IO_PAGE_SIZE - 1)) & IO_PAGE_MASK; |
43 | 50 | ||
44 | pgcount += ((end - start) >> IO_PAGE_SHIFT); | 51 | pgcount += ((end - start) >> IO_PAGE_SHIFT); |
@@ -113,7 +120,7 @@ static int verify_one_map(struct scatterlist *dma_sg, struct scatterlist **__sg, | |||
113 | if (dlen > 0 && ((daddr & ~IO_PAGE_MASK) == 0)) | 120 | if (dlen > 0 && ((daddr & ~IO_PAGE_MASK) == 0)) |
114 | iopte++; | 121 | iopte++; |
115 | 122 | ||
116 | sg++; | 123 | sg = sg_next(sg); |
117 | if (--nents <= 0) | 124 | if (--nents <= 0) |
118 | break; | 125 | break; |
119 | sgaddr = (unsigned long) (page_address(sg->page) + sg->offset); | 126 | sgaddr = (unsigned long) (page_address(sg->page) + sg->offset); |
@@ -147,7 +154,7 @@ static int verify_maps(struct scatterlist *sg, int nents, iopte_t *iopte) | |||
147 | nents = verify_one_map(dma_sg, &sg, nents, &iopte); | 154 | nents = verify_one_map(dma_sg, &sg, nents, &iopte); |
148 | if (nents <= 0) | 155 | if (nents <= 0) |
149 | break; | 156 | break; |
150 | dma_sg++; | 157 | dma_sg = sg_next(dma_sg); |
151 | if (dma_sg->dma_length == 0) | 158 | if (dma_sg->dma_length == 0) |
152 | break; | 159 | break; |
153 | } | 160 | } |
@@ -169,22 +176,24 @@ static int verify_maps(struct scatterlist *sg, int nents, iopte_t *iopte) | |||
169 | return 0; | 176 | return 0; |
170 | } | 177 | } |
171 | 178 | ||
172 | void verify_sglist(struct scatterlist *sg, int nents, iopte_t *iopte, int npages) | 179 | void verify_sglist(struct scatterlist *sglist, int nents, iopte_t *iopte, int npages) |
173 | { | 180 | { |
174 | if (verify_lengths(sg, nents, npages) < 0 || | 181 | struct scatterlist *sg; |
175 | verify_maps(sg, nents, iopte) < 0) { | 182 | |
183 | if (verify_lengths(sglist, nents, npages) < 0 || | ||
184 | verify_maps(sglist, nents, iopte) < 0) { | ||
176 | int i; | 185 | int i; |
177 | 186 | ||
178 | printk("verify_sglist: Crap, messed up mappings, dumping, iodma at "); | 187 | printk("verify_sglist: Crap, messed up mappings, dumping, iodma at "); |
179 | printk("%016lx.\n", sg->dma_address & IO_PAGE_MASK); | 188 | printk("%016lx.\n", sglist->dma_address & IO_PAGE_MASK); |
180 | 189 | ||
181 | for (i = 0; i < nents; i++) { | 190 | for_each_sg(sglist, sg, nents, i) { |
182 | printk("sg(%d): page_addr(%p) off(%x) length(%x) " | 191 | printk("sg(%d): page_addr(%p) off(%x) length(%x) " |
183 | "dma_address[%016lx] dma_length[%016lx]\n", | 192 | "dma_address[%016x] dma_length[%016x]\n", |
184 | i, | 193 | i, |
185 | page_address(sg[i].page), sg[i].offset, | 194 | page_address(sg->page), sg->offset, |
186 | sg[i].length, | 195 | sg->length, |
187 | sg[i].dma_address, sg[i].dma_length); | 196 | sg->dma_address, sg->dma_length); |
188 | } | 197 | } |
189 | } | 198 | } |
190 | 199 | ||
@@ -205,12 +214,12 @@ unsigned long prepare_sg(struct scatterlist *sg, int nents) | |||
205 | while (--nents) { | 214 | while (--nents) { |
206 | unsigned long addr; | 215 | unsigned long addr; |
207 | 216 | ||
208 | sg++; | 217 | sg = sg_next(sg); |
209 | addr = (unsigned long) (page_address(sg->page) + sg->offset); | 218 | addr = (unsigned long) (page_address(sg->page) + sg->offset); |
210 | if (! VCONTIG(prev, addr)) { | 219 | if (! VCONTIG(prev, addr)) { |
211 | dma_sg->dma_address = dent_addr; | 220 | dma_sg->dma_address = dent_addr; |
212 | dma_sg->dma_length = dent_len; | 221 | dma_sg->dma_length = dent_len; |
213 | dma_sg++; | 222 | dma_sg = sg_next(dma_sg); |
214 | 223 | ||
215 | dent_addr = ((dent_addr + | 224 | dent_addr = ((dent_addr + |
216 | dent_len + | 225 | dent_len + |