diff options
Diffstat (limited to 'lib')
-rw-r--r-- | lib/swiotlb.c | 58 |
1 files changed, 29 insertions, 29 deletions
diff --git a/lib/swiotlb.c b/lib/swiotlb.c index c0cbfa1116c0..8c4791f17ec1 100644 --- a/lib/swiotlb.c +++ b/lib/swiotlb.c | |||
@@ -57,8 +57,7 @@ int swiotlb_force; | |||
57 | * swiotlb_tbl_sync_single_*, to see if the memory was in fact allocated by this | 57 | * swiotlb_tbl_sync_single_*, to see if the memory was in fact allocated by this |
58 | * API. | 58 | * API. |
59 | */ | 59 | */ |
60 | static char *io_tlb_start; | 60 | static phys_addr_t io_tlb_start, io_tlb_end; |
61 | static phys_addr_t io_tlb_end; | ||
62 | 61 | ||
63 | /* | 62 | /* |
64 | * The number of IO TLB blocks (in groups of 64) between io_tlb_start and | 63 | * The number of IO TLB blocks (in groups of 64) between io_tlb_start and |
@@ -126,16 +125,15 @@ static dma_addr_t swiotlb_virt_to_bus(struct device *hwdev, | |||
126 | void swiotlb_print_info(void) | 125 | void swiotlb_print_info(void) |
127 | { | 126 | { |
128 | unsigned long bytes = io_tlb_nslabs << IO_TLB_SHIFT; | 127 | unsigned long bytes = io_tlb_nslabs << IO_TLB_SHIFT; |
129 | phys_addr_t pstart; | 128 | unsigned char *vstart, *vend; |
130 | unsigned char *vend; | ||
131 | 129 | ||
132 | pstart = virt_to_phys(io_tlb_start); | 130 | vstart = phys_to_virt(io_tlb_start); |
133 | vend = phys_to_virt(io_tlb_end); | 131 | vend = phys_to_virt(io_tlb_end); |
134 | 132 | ||
135 | printk(KERN_INFO "software IO TLB [mem %#010llx-%#010llx] (%luMB) mapped at [%p-%p]\n", | 133 | printk(KERN_INFO "software IO TLB [mem %#010llx-%#010llx] (%luMB) mapped at [%p-%p]\n", |
136 | (unsigned long long)pstart, | 134 | (unsigned long long)io_tlb_start, |
137 | (unsigned long long)io_tlb_end, | 135 | (unsigned long long)io_tlb_end, |
138 | bytes >> 20, io_tlb_start, vend - 1); | 136 | bytes >> 20, vstart, vend - 1); |
139 | } | 137 | } |
140 | 138 | ||
141 | void __init swiotlb_init_with_tbl(char *tlb, unsigned long nslabs, int verbose) | 139 | void __init swiotlb_init_with_tbl(char *tlb, unsigned long nslabs, int verbose) |
@@ -145,8 +143,8 @@ void __init swiotlb_init_with_tbl(char *tlb, unsigned long nslabs, int verbose) | |||
145 | bytes = nslabs << IO_TLB_SHIFT; | 143 | bytes = nslabs << IO_TLB_SHIFT; |
146 | 144 | ||
147 | io_tlb_nslabs = nslabs; | 145 | io_tlb_nslabs = nslabs; |
148 | io_tlb_start = tlb; | 146 | io_tlb_start = __pa(tlb); |
149 | io_tlb_end = __pa(io_tlb_start) + bytes; | 147 | io_tlb_end = io_tlb_start + bytes; |
150 | 148 | ||
151 | /* | 149 | /* |
152 | * Allocate and initialize the free list array. This array is used | 150 | * Allocate and initialize the free list array. This array is used |
@@ -176,6 +174,7 @@ void __init swiotlb_init_with_tbl(char *tlb, unsigned long nslabs, int verbose) | |||
176 | static void __init | 174 | static void __init |
177 | swiotlb_init_with_default_size(size_t default_size, int verbose) | 175 | swiotlb_init_with_default_size(size_t default_size, int verbose) |
178 | { | 176 | { |
177 | unsigned char *vstart; | ||
179 | unsigned long bytes; | 178 | unsigned long bytes; |
180 | 179 | ||
181 | if (!io_tlb_nslabs) { | 180 | if (!io_tlb_nslabs) { |
@@ -188,11 +187,11 @@ swiotlb_init_with_default_size(size_t default_size, int verbose) | |||
188 | /* | 187 | /* |
189 | * Get IO TLB memory from the low pages | 188 | * Get IO TLB memory from the low pages |
190 | */ | 189 | */ |
191 | io_tlb_start = alloc_bootmem_low_pages(PAGE_ALIGN(bytes)); | 190 | vstart = alloc_bootmem_low_pages(PAGE_ALIGN(bytes)); |
192 | if (!io_tlb_start) | 191 | if (!vstart) |
193 | panic("Cannot allocate SWIOTLB buffer"); | 192 | panic("Cannot allocate SWIOTLB buffer"); |
194 | 193 | ||
195 | swiotlb_init_with_tbl(io_tlb_start, io_tlb_nslabs, verbose); | 194 | swiotlb_init_with_tbl(vstart, io_tlb_nslabs, verbose); |
196 | } | 195 | } |
197 | 196 | ||
198 | void __init | 197 | void __init |
@@ -210,6 +209,7 @@ int | |||
210 | swiotlb_late_init_with_default_size(size_t default_size) | 209 | swiotlb_late_init_with_default_size(size_t default_size) |
211 | { | 210 | { |
212 | unsigned long bytes, req_nslabs = io_tlb_nslabs; | 211 | unsigned long bytes, req_nslabs = io_tlb_nslabs; |
212 | unsigned char *vstart = NULL; | ||
213 | unsigned int order; | 213 | unsigned int order; |
214 | int rc = 0; | 214 | int rc = 0; |
215 | 215 | ||
@@ -226,14 +226,14 @@ swiotlb_late_init_with_default_size(size_t default_size) | |||
226 | bytes = io_tlb_nslabs << IO_TLB_SHIFT; | 226 | bytes = io_tlb_nslabs << IO_TLB_SHIFT; |
227 | 227 | ||
228 | while ((SLABS_PER_PAGE << order) > IO_TLB_MIN_SLABS) { | 228 | while ((SLABS_PER_PAGE << order) > IO_TLB_MIN_SLABS) { |
229 | io_tlb_start = (void *)__get_free_pages(GFP_DMA | __GFP_NOWARN, | 229 | vstart = (void *)__get_free_pages(GFP_DMA | __GFP_NOWARN, |
230 | order); | 230 | order); |
231 | if (io_tlb_start) | 231 | if (vstart) |
232 | break; | 232 | break; |
233 | order--; | 233 | order--; |
234 | } | 234 | } |
235 | 235 | ||
236 | if (!io_tlb_start) { | 236 | if (!vstart) { |
237 | io_tlb_nslabs = req_nslabs; | 237 | io_tlb_nslabs = req_nslabs; |
238 | return -ENOMEM; | 238 | return -ENOMEM; |
239 | } | 239 | } |
@@ -242,9 +242,9 @@ swiotlb_late_init_with_default_size(size_t default_size) | |||
242 | "for software IO TLB\n", (PAGE_SIZE << order) >> 20); | 242 | "for software IO TLB\n", (PAGE_SIZE << order) >> 20); |
243 | io_tlb_nslabs = SLABS_PER_PAGE << order; | 243 | io_tlb_nslabs = SLABS_PER_PAGE << order; |
244 | } | 244 | } |
245 | rc = swiotlb_late_init_with_tbl(io_tlb_start, io_tlb_nslabs); | 245 | rc = swiotlb_late_init_with_tbl(vstart, io_tlb_nslabs); |
246 | if (rc) | 246 | if (rc) |
247 | free_pages((unsigned long)io_tlb_start, order); | 247 | free_pages((unsigned long)vstart, order); |
248 | return rc; | 248 | return rc; |
249 | } | 249 | } |
250 | 250 | ||
@@ -256,10 +256,10 @@ swiotlb_late_init_with_tbl(char *tlb, unsigned long nslabs) | |||
256 | bytes = nslabs << IO_TLB_SHIFT; | 256 | bytes = nslabs << IO_TLB_SHIFT; |
257 | 257 | ||
258 | io_tlb_nslabs = nslabs; | 258 | io_tlb_nslabs = nslabs; |
259 | io_tlb_start = tlb; | 259 | io_tlb_start = virt_to_phys(tlb); |
260 | io_tlb_end = virt_to_phys(io_tlb_start) + bytes; | 260 | io_tlb_end = io_tlb_start + bytes; |
261 | 261 | ||
262 | memset(io_tlb_start, 0, bytes); | 262 | memset(tlb, 0, bytes); |
263 | 263 | ||
264 | /* | 264 | /* |
265 | * Allocate and initialize the free list array. This array is used | 265 | * Allocate and initialize the free list array. This array is used |
@@ -308,7 +308,7 @@ cleanup3: | |||
308 | io_tlb_list = NULL; | 308 | io_tlb_list = NULL; |
309 | cleanup2: | 309 | cleanup2: |
310 | io_tlb_end = 0; | 310 | io_tlb_end = 0; |
311 | io_tlb_start = NULL; | 311 | io_tlb_start = 0; |
312 | io_tlb_nslabs = 0; | 312 | io_tlb_nslabs = 0; |
313 | return -ENOMEM; | 313 | return -ENOMEM; |
314 | } | 314 | } |
@@ -325,7 +325,7 @@ void __init swiotlb_free(void) | |||
325 | get_order(io_tlb_nslabs * sizeof(phys_addr_t))); | 325 | get_order(io_tlb_nslabs * sizeof(phys_addr_t))); |
326 | free_pages((unsigned long)io_tlb_list, get_order(io_tlb_nslabs * | 326 | free_pages((unsigned long)io_tlb_list, get_order(io_tlb_nslabs * |
327 | sizeof(int))); | 327 | sizeof(int))); |
328 | free_pages((unsigned long)io_tlb_start, | 328 | free_pages((unsigned long)phys_to_virt(io_tlb_start), |
329 | get_order(io_tlb_nslabs << IO_TLB_SHIFT)); | 329 | get_order(io_tlb_nslabs << IO_TLB_SHIFT)); |
330 | } else { | 330 | } else { |
331 | free_bootmem_late(__pa(io_tlb_overflow_buffer), | 331 | free_bootmem_late(__pa(io_tlb_overflow_buffer), |
@@ -334,7 +334,7 @@ void __init swiotlb_free(void) | |||
334 | PAGE_ALIGN(io_tlb_nslabs * sizeof(phys_addr_t))); | 334 | PAGE_ALIGN(io_tlb_nslabs * sizeof(phys_addr_t))); |
335 | free_bootmem_late(__pa(io_tlb_list), | 335 | free_bootmem_late(__pa(io_tlb_list), |
336 | PAGE_ALIGN(io_tlb_nslabs * sizeof(int))); | 336 | PAGE_ALIGN(io_tlb_nslabs * sizeof(int))); |
337 | free_bootmem_late(__pa(io_tlb_start), | 337 | free_bootmem_late(io_tlb_start, |
338 | PAGE_ALIGN(io_tlb_nslabs << IO_TLB_SHIFT)); | 338 | PAGE_ALIGN(io_tlb_nslabs << IO_TLB_SHIFT)); |
339 | } | 339 | } |
340 | io_tlb_nslabs = 0; | 340 | io_tlb_nslabs = 0; |
@@ -342,7 +342,7 @@ void __init swiotlb_free(void) | |||
342 | 342 | ||
343 | static int is_swiotlb_buffer(phys_addr_t paddr) | 343 | static int is_swiotlb_buffer(phys_addr_t paddr) |
344 | { | 344 | { |
345 | return paddr >= virt_to_phys(io_tlb_start) && paddr < io_tlb_end; | 345 | return paddr >= io_tlb_start && paddr < io_tlb_end; |
346 | } | 346 | } |
347 | 347 | ||
348 | /* | 348 | /* |
@@ -455,7 +455,7 @@ void *swiotlb_tbl_map_single(struct device *hwdev, dma_addr_t tbl_dma_addr, | |||
455 | io_tlb_list[i] = 0; | 455 | io_tlb_list[i] = 0; |
456 | for (i = index - 1; (OFFSET(i, IO_TLB_SEGSIZE) != IO_TLB_SEGSIZE - 1) && io_tlb_list[i]; i--) | 456 | for (i = index - 1; (OFFSET(i, IO_TLB_SEGSIZE) != IO_TLB_SEGSIZE - 1) && io_tlb_list[i]; i--) |
457 | io_tlb_list[i] = ++count; | 457 | io_tlb_list[i] = ++count; |
458 | dma_addr = io_tlb_start + (index << IO_TLB_SHIFT); | 458 | dma_addr = (char *)phys_to_virt(io_tlb_start) + (index << IO_TLB_SHIFT); |
459 | 459 | ||
460 | /* | 460 | /* |
461 | * Update the indices to avoid searching in the next | 461 | * Update the indices to avoid searching in the next |
@@ -499,7 +499,7 @@ static void * | |||
499 | map_single(struct device *hwdev, phys_addr_t phys, size_t size, | 499 | map_single(struct device *hwdev, phys_addr_t phys, size_t size, |
500 | enum dma_data_direction dir) | 500 | enum dma_data_direction dir) |
501 | { | 501 | { |
502 | dma_addr_t start_dma_addr = swiotlb_virt_to_bus(hwdev, io_tlb_start); | 502 | dma_addr_t start_dma_addr = phys_to_dma(hwdev, io_tlb_start); |
503 | 503 | ||
504 | return swiotlb_tbl_map_single(hwdev, start_dma_addr, phys, size, dir); | 504 | return swiotlb_tbl_map_single(hwdev, start_dma_addr, phys, size, dir); |
505 | } | 505 | } |
@@ -513,7 +513,7 @@ swiotlb_tbl_unmap_single(struct device *hwdev, char *dma_addr, size_t size, | |||
513 | { | 513 | { |
514 | unsigned long flags; | 514 | unsigned long flags; |
515 | int i, count, nslots = ALIGN(size, 1 << IO_TLB_SHIFT) >> IO_TLB_SHIFT; | 515 | int i, count, nslots = ALIGN(size, 1 << IO_TLB_SHIFT) >> IO_TLB_SHIFT; |
516 | int index = (dma_addr - io_tlb_start) >> IO_TLB_SHIFT; | 516 | int index = (dma_addr - (char *)phys_to_virt(io_tlb_start)) >> IO_TLB_SHIFT; |
517 | phys_addr_t phys = io_tlb_orig_addr[index]; | 517 | phys_addr_t phys = io_tlb_orig_addr[index]; |
518 | 518 | ||
519 | /* | 519 | /* |
@@ -554,7 +554,7 @@ swiotlb_tbl_sync_single(struct device *hwdev, char *dma_addr, size_t size, | |||
554 | enum dma_data_direction dir, | 554 | enum dma_data_direction dir, |
555 | enum dma_sync_target target) | 555 | enum dma_sync_target target) |
556 | { | 556 | { |
557 | int index = (dma_addr - io_tlb_start) >> IO_TLB_SHIFT; | 557 | int index = (dma_addr - (char *)phys_to_virt(io_tlb_start)) >> IO_TLB_SHIFT; |
558 | phys_addr_t phys = io_tlb_orig_addr[index]; | 558 | phys_addr_t phys = io_tlb_orig_addr[index]; |
559 | 559 | ||
560 | phys += ((unsigned long)dma_addr & ((1 << IO_TLB_SHIFT) - 1)); | 560 | phys += ((unsigned long)dma_addr & ((1 << IO_TLB_SHIFT) - 1)); |