]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/powerpc/powerpc/busdma_machdep.c
Import DTS files from Linux 5.3
[FreeBSD/FreeBSD.git] / sys / powerpc / powerpc / busdma_machdep.c
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 1997, 1998 Justin T. Gibbs.
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions, and the following disclaimer,
12  *    without modification, immediately at the beginning of the file.
13  * 2. The name of the author may not be used to endorse or promote products
14  *    derived from this software without specific prior written permission.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
20  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26  * SUCH DAMAGE.
27  */
28
29 /*
30  * From amd64/busdma_machdep.c, r204214
31  */
32
33 #include <sys/cdefs.h>
34 __FBSDID("$FreeBSD$");
35
36 #include <sys/param.h>
37 #include <sys/systm.h>
38 #include <sys/malloc.h>
39 #include <sys/bus.h>
40 #include <sys/interrupt.h>
41 #include <sys/kernel.h>
42 #include <sys/ktr.h>
43 #include <sys/lock.h>
44 #include <sys/proc.h>
45 #include <sys/memdesc.h>
46 #include <sys/mutex.h>
47 #include <sys/sysctl.h>
48 #include <sys/uio.h>
49
50 #include <vm/vm.h>
51 #include <vm/vm_extern.h>
52 #include <vm/vm_kern.h>
53 #include <vm/vm_page.h>
54 #include <vm/vm_map.h>
55
56 #include <machine/atomic.h>
57 #include <machine/bus.h>
58 #include <machine/cpufunc.h>
59 #include <machine/md_var.h>
60
61 #include "iommu_if.h"
62
63 #define MAX_BPAGES MIN(8192, physmem/40)
64
65 struct bounce_zone;
66
67 struct bus_dma_tag {
68         bus_dma_tag_t     parent;
69         bus_size_t        alignment;
70         bus_addr_t        boundary;
71         bus_addr_t        lowaddr;
72         bus_addr_t        highaddr;
73         bus_dma_filter_t *filter;
74         void             *filterarg;
75         bus_size_t        maxsize;
76         bus_size_t        maxsegsz;
77         u_int             nsegments;
78         int               flags;
79         int               ref_count;
80         int               map_count;
81         bus_dma_lock_t   *lockfunc;
82         void             *lockfuncarg;
83         struct bounce_zone *bounce_zone;
84         device_t          iommu;
85         void             *iommu_cookie;
86 };
87
88 struct bounce_page {
89         vm_offset_t     vaddr;          /* kva of bounce buffer */
90         bus_addr_t      busaddr;        /* Physical address */
91         vm_offset_t     datavaddr;      /* kva of client data */
92         vm_page_t       datapage;       /* physical page of client data */
93         vm_offset_t     dataoffs;       /* page offset of client data */
94         bus_size_t      datacount;      /* client data count */
95         STAILQ_ENTRY(bounce_page) links;
96 };
97
98 int busdma_swi_pending;
99
100 struct bounce_zone {
101         STAILQ_ENTRY(bounce_zone) links;
102         STAILQ_HEAD(bp_list, bounce_page) bounce_page_list;
103         int             total_bpages;
104         int             free_bpages;
105         int             reserved_bpages;
106         int             active_bpages;
107         int             total_bounced;
108         int             total_deferred;
109         int             map_count;
110         bus_size_t      alignment;
111         bus_addr_t      lowaddr;
112         char            zoneid[8];
113         char            lowaddrid[20];
114         struct sysctl_ctx_list sysctl_tree;
115         struct sysctl_oid *sysctl_tree_top;
116 };
117
118 static struct mtx bounce_lock;
119 static int total_bpages;
120 static int busdma_zonecount;
121 static STAILQ_HEAD(, bounce_zone) bounce_zone_list;
122
123 static SYSCTL_NODE(_hw, OID_AUTO, busdma, CTLFLAG_RD, 0, "Busdma parameters");
124 SYSCTL_INT(_hw_busdma, OID_AUTO, total_bpages, CTLFLAG_RD, &total_bpages, 0,
125            "Total bounce pages");
126
127 struct bus_dmamap {
128         struct bp_list         bpages;
129         int                    pagesneeded;
130         int                    pagesreserved;
131         bus_dma_tag_t          dmat;
132         struct memdesc         mem;
133         bus_dma_segment_t     *segments;
134         int                    nsegs;
135         bus_dmamap_callback_t *callback;
136         void                  *callback_arg;
137         STAILQ_ENTRY(bus_dmamap) links;
138         int                    contigalloc;
139 };
140
141 static STAILQ_HEAD(, bus_dmamap) bounce_map_waitinglist;
142 static STAILQ_HEAD(, bus_dmamap) bounce_map_callbacklist;
143
144 static void init_bounce_pages(void *dummy);
145 static int alloc_bounce_zone(bus_dma_tag_t dmat);
146 static int alloc_bounce_pages(bus_dma_tag_t dmat, u_int numpages);
147 static int reserve_bounce_pages(bus_dma_tag_t dmat, bus_dmamap_t map,
148                                 int commit);
149 static bus_addr_t add_bounce_page(bus_dma_tag_t dmat, bus_dmamap_t map,
150                                   vm_offset_t vaddr, bus_addr_t addr,
151                                   bus_size_t size);
152 static void free_bounce_page(bus_dma_tag_t dmat, struct bounce_page *bpage);
153 static __inline int run_filter(bus_dma_tag_t dmat, bus_addr_t paddr);
154
155 /*
156  * Return true if a match is made.
157  *
158  * To find a match walk the chain of bus_dma_tag_t's looking for 'paddr'.
159  *
160  * If paddr is within the bounds of the dma tag then call the filter callback
161  * to check for a match, if there is no filter callback then assume a match.
162  */
163 static __inline int
164 run_filter(bus_dma_tag_t dmat, bus_addr_t paddr)
165 {
166         int retval;
167
168         retval = 0;
169
170         do {
171                 if (dmat->filter == NULL && dmat->iommu == NULL &&
172                     paddr > dmat->lowaddr && paddr <= dmat->highaddr)
173                         retval = 1;
174                 if (dmat->filter == NULL &&
175                     (paddr & (dmat->alignment - 1)) != 0)
176                         retval = 1;
177                 if (dmat->filter != NULL &&
178                     (*dmat->filter)(dmat->filterarg, paddr) != 0)
179                         retval = 1;
180
181                 dmat = dmat->parent;            
182         } while (retval == 0 && dmat != NULL);
183         return (retval);
184 }
185
186 /*
187  * Convenience function for manipulating driver locks from busdma (during
188  * busdma_swi, for example).  Drivers that don't provide their own locks
189  * should specify &Giant to dmat->lockfuncarg.  Drivers that use their own
190  * non-mutex locking scheme don't have to use this at all.
191  */
192 void
193 busdma_lock_mutex(void *arg, bus_dma_lock_op_t op)
194 {
195         struct mtx *dmtx;
196
197         dmtx = (struct mtx *)arg;
198         switch (op) {
199         case BUS_DMA_LOCK:
200                 mtx_lock(dmtx);
201                 break;
202         case BUS_DMA_UNLOCK:
203                 mtx_unlock(dmtx);
204                 break;
205         default:
206                 panic("Unknown operation 0x%x for busdma_lock_mutex!", op);
207         }
208 }
209
210 /*
211  * dflt_lock should never get called.  It gets put into the dma tag when
212  * lockfunc == NULL, which is only valid if the maps that are associated
213  * with the tag are meant to never be defered.
214  * XXX Should have a way to identify which driver is responsible here.
215  */
216 static void
217 dflt_lock(void *arg, bus_dma_lock_op_t op)
218 {
219         panic("driver error: busdma dflt_lock called");
220 }
221
222 #define BUS_DMA_COULD_BOUNCE    BUS_DMA_BUS3
223 #define BUS_DMA_MIN_ALLOC_COMP  BUS_DMA_BUS4
224 /*
225  * Allocate a device specific dma_tag.
226  */
227 int
228 bus_dma_tag_create(bus_dma_tag_t parent, bus_size_t alignment,
229                    bus_addr_t boundary, bus_addr_t lowaddr,
230                    bus_addr_t highaddr, bus_dma_filter_t *filter,
231                    void *filterarg, bus_size_t maxsize, int nsegments,
232                    bus_size_t maxsegsz, int flags, bus_dma_lock_t *lockfunc,
233                    void *lockfuncarg, bus_dma_tag_t *dmat)
234 {
235         bus_dma_tag_t newtag;
236         int error = 0;
237
238         /* Basic sanity checking */
239         if (boundary != 0 && boundary < maxsegsz)
240                 maxsegsz = boundary;
241
242         if (maxsegsz == 0) {
243                 return (EINVAL);
244         }
245
246         /* Return a NULL tag on failure */
247         *dmat = NULL;
248
249         newtag = (bus_dma_tag_t)malloc(sizeof(*newtag), M_DEVBUF,
250             M_ZERO | M_NOWAIT);
251         if (newtag == NULL) {
252                 CTR4(KTR_BUSDMA, "%s returned tag %p tag flags 0x%x error %d",
253                     __func__, newtag, 0, error);
254                 return (ENOMEM);
255         }
256
257         newtag->parent = parent;
258         newtag->alignment = alignment;
259         newtag->boundary = boundary;
260         newtag->lowaddr = trunc_page((vm_paddr_t)lowaddr) + (PAGE_SIZE - 1);
261         newtag->highaddr = trunc_page((vm_paddr_t)highaddr) + (PAGE_SIZE - 1);
262         newtag->filter = filter;
263         newtag->filterarg = filterarg;
264         newtag->maxsize = maxsize;
265         newtag->nsegments = nsegments;
266         newtag->maxsegsz = maxsegsz;
267         newtag->flags = flags;
268         newtag->ref_count = 1; /* Count ourself */
269         newtag->map_count = 0;
270         if (lockfunc != NULL) {
271                 newtag->lockfunc = lockfunc;
272                 newtag->lockfuncarg = lockfuncarg;
273         } else {
274                 newtag->lockfunc = dflt_lock;
275                 newtag->lockfuncarg = NULL;
276         }
277
278         /* Take into account any restrictions imposed by our parent tag */
279         if (parent != NULL) {
280                 newtag->lowaddr = MIN(parent->lowaddr, newtag->lowaddr);
281                 newtag->highaddr = MAX(parent->highaddr, newtag->highaddr);
282                 if (newtag->boundary == 0)
283                         newtag->boundary = parent->boundary;
284                 else if (parent->boundary != 0)
285                         newtag->boundary = MIN(parent->boundary,
286                                                newtag->boundary);
287                 if (newtag->filter == NULL) {
288                         /*
289                          * Short circuit looking at our parent directly
290                          * since we have encapsulated all of its information
291                          */
292                         newtag->filter = parent->filter;
293                         newtag->filterarg = parent->filterarg;
294                         newtag->parent = parent->parent;
295                 }
296                 if (newtag->parent != NULL)
297                         atomic_add_int(&parent->ref_count, 1);
298                 newtag->iommu = parent->iommu;
299                 newtag->iommu_cookie = parent->iommu_cookie;
300         }
301
302         if (newtag->lowaddr < ptoa((vm_paddr_t)Maxmem) && newtag->iommu == NULL)
303                 newtag->flags |= BUS_DMA_COULD_BOUNCE;
304
305         if (newtag->alignment > 1)
306                 newtag->flags |= BUS_DMA_COULD_BOUNCE;
307
308         if (((newtag->flags & BUS_DMA_COULD_BOUNCE) != 0) &&
309             (flags & BUS_DMA_ALLOCNOW) != 0) {
310                 struct bounce_zone *bz;
311
312                 /* Must bounce */
313
314                 if ((error = alloc_bounce_zone(newtag)) != 0) {
315                         free(newtag, M_DEVBUF);
316                         return (error);
317                 }
318                 bz = newtag->bounce_zone;
319
320                 if (ptoa(bz->total_bpages) < maxsize) {
321                         int pages;
322
323                         pages = atop(maxsize) - bz->total_bpages;
324
325                         /* Add pages to our bounce pool */
326                         if (alloc_bounce_pages(newtag, pages) < pages)
327                                 error = ENOMEM;
328                 }
329                 /* Performed initial allocation */
330                 newtag->flags |= BUS_DMA_MIN_ALLOC_COMP;
331         }
332         
333         if (error != 0) {
334                 free(newtag, M_DEVBUF);
335         } else {
336                 *dmat = newtag;
337         }
338         CTR4(KTR_BUSDMA, "%s returned tag %p tag flags 0x%x error %d",
339             __func__, newtag, (newtag != NULL ? newtag->flags : 0), error);
340         return (error);
341 }
342
343 int
344 bus_dma_tag_set_domain(bus_dma_tag_t dmat, int domain)
345 {
346
347         return (0);
348 }
349
350 int
351 bus_dma_tag_destroy(bus_dma_tag_t dmat)
352 {
353         bus_dma_tag_t dmat_copy __unused;
354         int error;
355
356         error = 0;
357         dmat_copy = dmat;
358
359         if (dmat != NULL) {
360
361                 if (dmat->map_count != 0) {
362                         error = EBUSY;
363                         goto out;
364                 }
365
366                 while (dmat != NULL) {
367                         bus_dma_tag_t parent;
368
369                         parent = dmat->parent;
370                         atomic_subtract_int(&dmat->ref_count, 1);
371                         if (dmat->ref_count == 0) {
372                                 free(dmat, M_DEVBUF);
373                                 /*
374                                  * Last reference count, so
375                                  * release our reference
376                                  * count on our parent.
377                                  */
378                                 dmat = parent;
379                         } else
380                                 dmat = NULL;
381                 }
382         }
383 out:
384         CTR3(KTR_BUSDMA, "%s tag %p error %d", __func__, dmat_copy, error);
385         return (error);
386 }
387
388 /*
389  * Allocate a handle for mapping from kva/uva/physical
390  * address space into bus device space.
391  */
392 int
393 bus_dmamap_create(bus_dma_tag_t dmat, int flags, bus_dmamap_t *mapp)
394 {
395         int error;
396
397         error = 0;
398
399         *mapp = (bus_dmamap_t)malloc(sizeof(**mapp), M_DEVBUF,
400                                      M_NOWAIT | M_ZERO);
401         if (*mapp == NULL) {
402                 CTR3(KTR_BUSDMA, "%s: tag %p error %d",
403                     __func__, dmat, ENOMEM);
404                 return (ENOMEM);
405         }
406
407
408         /*
409          * Bouncing might be required if the driver asks for an active
410          * exclusion region, a data alignment that is stricter than 1, and/or
411          * an active address boundary.
412          */
413         if (dmat->flags & BUS_DMA_COULD_BOUNCE) {
414
415                 /* Must bounce */
416                 struct bounce_zone *bz;
417                 int maxpages;
418
419                 if (dmat->bounce_zone == NULL) {
420                         if ((error = alloc_bounce_zone(dmat)) != 0)
421                                 return (error);
422                 }
423                 bz = dmat->bounce_zone;
424
425                 /* Initialize the new map */
426                 STAILQ_INIT(&((*mapp)->bpages));
427
428                 /*
429                  * Attempt to add pages to our pool on a per-instance
430                  * basis up to a sane limit.
431                  */
432                 if (dmat->alignment > 1)
433                         maxpages = MAX_BPAGES;
434                 else
435                         maxpages = MIN(MAX_BPAGES, Maxmem -atop(dmat->lowaddr));
436                 if ((dmat->flags & BUS_DMA_MIN_ALLOC_COMP) == 0
437                  || (bz->map_count > 0 && bz->total_bpages < maxpages)) {
438                         int pages;
439
440                         pages = MAX(atop(dmat->maxsize), 1);
441                         pages = MIN(maxpages - bz->total_bpages, pages);
442                         pages = MAX(pages, 1);
443                         if (alloc_bounce_pages(dmat, pages) < pages)
444                                 error = ENOMEM;
445
446                         if ((dmat->flags & BUS_DMA_MIN_ALLOC_COMP) == 0) {
447                                 if (error == 0)
448                                         dmat->flags |= BUS_DMA_MIN_ALLOC_COMP;
449                         } else {
450                                 error = 0;
451                         }
452                 }
453                 bz->map_count++;
454         }
455
456         (*mapp)->nsegs = 0;
457         (*mapp)->segments = (bus_dma_segment_t *)malloc(
458             sizeof(bus_dma_segment_t) * dmat->nsegments, M_DEVBUF,
459             M_NOWAIT);
460         if ((*mapp)->segments == NULL) {
461                 CTR3(KTR_BUSDMA, "%s: tag %p error %d",
462                     __func__, dmat, ENOMEM);
463                 return (ENOMEM);
464         }
465
466         if (error == 0)
467                 dmat->map_count++;
468         CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x error %d",
469             __func__, dmat, dmat->flags, error);
470         return (error);
471 }
472
473 /*
474  * Destroy a handle for mapping from kva/uva/physical
475  * address space into bus device space.
476  */
477 int
478 bus_dmamap_destroy(bus_dma_tag_t dmat, bus_dmamap_t map)
479 {
480         if (dmat->flags & BUS_DMA_COULD_BOUNCE) {
481                 if (STAILQ_FIRST(&map->bpages) != NULL) {
482                         CTR3(KTR_BUSDMA, "%s: tag %p error %d",
483                             __func__, dmat, EBUSY);
484                         return (EBUSY);
485                 }
486                 if (dmat->bounce_zone)
487                         dmat->bounce_zone->map_count--;
488         }
489         free(map->segments, M_DEVBUF);
490         free(map, M_DEVBUF);
491         dmat->map_count--;
492         CTR2(KTR_BUSDMA, "%s: tag %p error 0", __func__, dmat);
493         return (0);
494 }
495
496
497 /*
498  * Allocate a piece of memory that can be efficiently mapped into
499  * bus device space based on the constraints lited in the dma tag.
500  * A dmamap to for use with dmamap_load is also allocated.
501  */
502 int
503 bus_dmamem_alloc(bus_dma_tag_t dmat, void** vaddr, int flags,
504                  bus_dmamap_t *mapp)
505 {
506         vm_memattr_t attr;
507         int mflags;
508
509         if (flags & BUS_DMA_NOWAIT)
510                 mflags = M_NOWAIT;
511         else
512                 mflags = M_WAITOK;
513
514         bus_dmamap_create(dmat, flags, mapp);
515
516         if (flags & BUS_DMA_ZERO)
517                 mflags |= M_ZERO;
518         if (flags & BUS_DMA_NOCACHE)
519                 attr = VM_MEMATTR_UNCACHEABLE;
520         else
521                 attr = VM_MEMATTR_DEFAULT;
522
523         /* 
524          * XXX:
525          * (dmat->alignment <= dmat->maxsize) is just a quick hack; the exact
526          * alignment guarantees of malloc need to be nailed down, and the
527          * code below should be rewritten to take that into account.
528          *
529          * In the meantime, we'll warn the user if malloc gets it wrong.
530          */
531         if ((dmat->maxsize <= PAGE_SIZE) &&
532            (dmat->alignment <= dmat->maxsize) &&
533             dmat->lowaddr >= ptoa((vm_paddr_t)Maxmem) &&
534             attr == VM_MEMATTR_DEFAULT) {
535                 *vaddr = malloc(dmat->maxsize, M_DEVBUF, mflags);
536         } else {
537                 /*
538                  * XXX Use Contigmalloc until it is merged into this facility
539                  *     and handles multi-seg allocations.  Nobody is doing
540                  *     multi-seg allocations yet though.
541                  * XXX Certain AGP hardware does.
542                  */
543                 *vaddr = (void *)kmem_alloc_contig(dmat->maxsize, mflags, 0ul,
544                     dmat->lowaddr, dmat->alignment ? dmat->alignment : 1ul,
545                     dmat->boundary, attr);
546                 (*mapp)->contigalloc = 1;
547         }
548         if (*vaddr == NULL) {
549                 CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x error %d",
550                     __func__, dmat, dmat->flags, ENOMEM);
551                 return (ENOMEM);
552         } else if (vtophys(*vaddr) & (dmat->alignment - 1)) {
553                 printf("bus_dmamem_alloc failed to align memory properly.\n");
554         }
555         CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x error %d",
556             __func__, dmat, dmat->flags, 0);
557         return (0);
558 }
559
560 /*
561  * Free a piece of memory and it's allociated dmamap, that was allocated
562  * via bus_dmamem_alloc.  Make the same choice for free/contigfree.
563  */
564 void
565 bus_dmamem_free(bus_dma_tag_t dmat, void *vaddr, bus_dmamap_t map)
566 {
567
568         if (!map->contigalloc)
569                 free(vaddr, M_DEVBUF);
570         else
571                 kmem_free((vm_offset_t)vaddr, dmat->maxsize);
572         bus_dmamap_destroy(dmat, map);
573         CTR3(KTR_BUSDMA, "%s: tag %p flags 0x%x", __func__, dmat, dmat->flags);
574 }
575
576 static void
577 _bus_dmamap_count_phys(bus_dma_tag_t dmat, bus_dmamap_t map, vm_paddr_t buf,
578     bus_size_t buflen, int flags)
579 {
580         bus_addr_t curaddr;
581         bus_size_t sgsize;
582
583         if (map->pagesneeded == 0) {
584                 CTR4(KTR_BUSDMA, "lowaddr= %d Maxmem= %d, boundary= %d, "
585                     "alignment= %d", dmat->lowaddr, ptoa((vm_paddr_t)Maxmem),
586                     dmat->boundary, dmat->alignment);
587                 CTR2(KTR_BUSDMA, "map= %p, pagesneeded= %d", map, map->pagesneeded);
588                 /*
589                  * Count the number of bounce pages
590                  * needed in order to complete this transfer
591                  */
592                 curaddr = buf;
593                 while (buflen != 0) {
594                         sgsize = MIN(buflen, dmat->maxsegsz);
595                         if (run_filter(dmat, curaddr) != 0) {
596                                 sgsize = MIN(sgsize,
597                                     PAGE_SIZE - (curaddr & PAGE_MASK));
598                                 map->pagesneeded++;
599                         }
600                         curaddr += sgsize;
601                         buflen -= sgsize;
602                 }
603                 CTR1(KTR_BUSDMA, "pagesneeded= %d\n", map->pagesneeded);
604         }
605 }
606
607 static void
608 _bus_dmamap_count_pages(bus_dma_tag_t dmat, bus_dmamap_t map, pmap_t pmap,
609     void *buf, bus_size_t buflen, int flags)
610 {
611         vm_offset_t vaddr;
612         vm_offset_t vendaddr;
613         bus_addr_t paddr;
614
615         if (map->pagesneeded == 0) {
616                 CTR4(KTR_BUSDMA, "lowaddr= %d Maxmem= %d, boundary= %d, "
617                     "alignment= %d", dmat->lowaddr, ptoa((vm_paddr_t)Maxmem),
618                     dmat->boundary, dmat->alignment);
619                 CTR2(KTR_BUSDMA, "map= %p, pagesneeded= %d", map, map->pagesneeded);
620                 /*
621                  * Count the number of bounce pages
622                  * needed in order to complete this transfer
623                  */
624                 vaddr = (vm_offset_t)buf;
625                 vendaddr = (vm_offset_t)buf + buflen;
626
627                 while (vaddr < vendaddr) {
628                         bus_size_t sg_len;
629
630                         sg_len = PAGE_SIZE - ((vm_offset_t)vaddr & PAGE_MASK);
631                         if (pmap == kernel_pmap)
632                                 paddr = pmap_kextract(vaddr);
633                         else
634                                 paddr = pmap_extract(pmap, vaddr);
635                         if (run_filter(dmat, paddr) != 0) {
636                                 sg_len = roundup2(sg_len, dmat->alignment);
637                                 map->pagesneeded++;
638                         }
639                         vaddr += sg_len;
640                 }
641                 CTR1(KTR_BUSDMA, "pagesneeded= %d\n", map->pagesneeded);
642         }
643 }
644
645 static int
646 _bus_dmamap_reserve_pages(bus_dma_tag_t dmat, bus_dmamap_t map, int flags)
647 {
648
649         /* Reserve Necessary Bounce Pages */
650         mtx_lock(&bounce_lock);
651         if (flags & BUS_DMA_NOWAIT) {
652                 if (reserve_bounce_pages(dmat, map, 0) != 0) {
653                         mtx_unlock(&bounce_lock);
654                         return (ENOMEM);
655                 }
656         } else {
657                 if (reserve_bounce_pages(dmat, map, 1) != 0) {
658                         /* Queue us for resources */
659                         STAILQ_INSERT_TAIL(&bounce_map_waitinglist,
660                             map, links);
661                         mtx_unlock(&bounce_lock);
662                         return (EINPROGRESS);
663                 }
664         }
665         mtx_unlock(&bounce_lock);
666
667         return (0);
668 }
669
670 /*
671  * Add a single contiguous physical range to the segment list.
672  */
673 static int
674 _bus_dmamap_addseg(bus_dma_tag_t dmat, bus_dmamap_t map, bus_addr_t curaddr,
675                    bus_size_t sgsize, bus_dma_segment_t *segs, int *segp)
676 {
677         bus_addr_t baddr, bmask;
678         int seg;
679
680         /*
681          * Make sure we don't cross any boundaries.
682          */
683         bmask = ~(dmat->boundary - 1);
684         if (dmat->boundary > 0) {
685                 baddr = (curaddr + dmat->boundary) & bmask;
686                 if (sgsize > (baddr - curaddr))
687                         sgsize = (baddr - curaddr);
688         }
689
690         /*
691          * Insert chunk into a segment, coalescing with
692          * previous segment if possible.
693          */
694         seg = *segp;
695         if (seg == -1) {
696                 seg = 0;
697                 segs[seg].ds_addr = curaddr;
698                 segs[seg].ds_len = sgsize;
699         } else {
700                 if (curaddr == segs[seg].ds_addr + segs[seg].ds_len &&
701                     (segs[seg].ds_len + sgsize) <= dmat->maxsegsz &&
702                     (dmat->boundary == 0 ||
703                      (segs[seg].ds_addr & bmask) == (curaddr & bmask)))
704                         segs[seg].ds_len += sgsize;
705                 else {
706                         if (++seg >= dmat->nsegments)
707                                 return (0);
708                         segs[seg].ds_addr = curaddr;
709                         segs[seg].ds_len = sgsize;
710                 }
711         }
712         *segp = seg;
713         return (sgsize);
714 }
715
716 /*
717  * Utility function to load a physical buffer.  segp contains
718  * the starting segment on entrace, and the ending segment on exit.
719  */
720 int
721 _bus_dmamap_load_phys(bus_dma_tag_t dmat,
722                       bus_dmamap_t map,
723                       vm_paddr_t buf, bus_size_t buflen,
724                       int flags,
725                       bus_dma_segment_t *segs,
726                       int *segp)
727 {
728         bus_addr_t curaddr;
729         bus_size_t sgsize;
730         int error;
731
732         if (segs == NULL)
733                 segs = map->segments;
734
735         if ((dmat->flags & BUS_DMA_COULD_BOUNCE) != 0) {
736                 _bus_dmamap_count_phys(dmat, map, buf, buflen, flags);
737                 if (map->pagesneeded != 0) {
738                         error = _bus_dmamap_reserve_pages(dmat, map, flags);
739                         if (error)
740                                 return (error);
741                 }
742         }
743
744         while (buflen > 0) {
745                 curaddr = buf;
746                 sgsize = MIN(buflen, dmat->maxsegsz);
747                 if (map->pagesneeded != 0 && run_filter(dmat, curaddr)) {
748                         sgsize = MIN(sgsize, PAGE_SIZE - (curaddr & PAGE_MASK));
749                         curaddr = add_bounce_page(dmat, map, 0, curaddr,
750                             sgsize);
751                 }
752                 sgsize = _bus_dmamap_addseg(dmat, map, curaddr, sgsize, segs,
753                     segp);
754                 if (sgsize == 0)
755                         break;
756                 buf += sgsize;
757                 buflen -= sgsize;
758         }
759
760         /*
761          * Did we fit?
762          */
763         return (buflen != 0 ? EFBIG : 0); /* XXX better return value here? */
764 }
765
766 int
767 _bus_dmamap_load_ma(bus_dma_tag_t dmat, bus_dmamap_t map,
768     struct vm_page **ma, bus_size_t tlen, int ma_offs, int flags,
769     bus_dma_segment_t *segs, int *segp)
770 {
771
772         return (bus_dmamap_load_ma_triv(dmat, map, ma, tlen, ma_offs, flags,
773             segs, segp));
774 }
775
776 /*
777  * Utility function to load a linear buffer.  segp contains
778  * the starting segment on entrance, and the ending segment on exit.
779  */
780 int
781 _bus_dmamap_load_buffer(bus_dma_tag_t dmat,
782                         bus_dmamap_t map,
783                         void *buf, bus_size_t buflen,
784                         pmap_t pmap,
785                         int flags,
786                         bus_dma_segment_t *segs,
787                         int *segp)
788 {
789         bus_size_t sgsize;
790         bus_addr_t curaddr;
791         vm_offset_t kvaddr, vaddr;
792         int error;
793
794         if (segs == NULL)
795                 segs = map->segments;
796
797         if ((dmat->flags & BUS_DMA_COULD_BOUNCE) != 0) {
798                 _bus_dmamap_count_pages(dmat, map, pmap, buf, buflen, flags);
799                 if (map->pagesneeded != 0) {
800                         error = _bus_dmamap_reserve_pages(dmat, map, flags);
801                         if (error)
802                                 return (error);
803                 }
804         }
805
806         vaddr = (vm_offset_t)buf;
807
808         while (buflen > 0) {
809                 bus_size_t max_sgsize;
810
811                 /*
812                  * Get the physical address for this segment.
813                  */
814                 if (pmap == kernel_pmap) {
815                         curaddr = pmap_kextract(vaddr);
816                         kvaddr = vaddr;
817                 } else {
818                         curaddr = pmap_extract(pmap, vaddr);
819                         kvaddr = 0;
820                 }
821
822                 /*
823                  * Compute the segment size, and adjust counts.
824                  */
825                 max_sgsize = MIN(buflen, dmat->maxsegsz);
826                 sgsize = PAGE_SIZE - (curaddr & PAGE_MASK);
827                 if (map->pagesneeded != 0 && run_filter(dmat, curaddr)) {
828                         sgsize = roundup2(sgsize, dmat->alignment);
829                         sgsize = MIN(sgsize, max_sgsize);
830                         curaddr = add_bounce_page(dmat, map, kvaddr, curaddr,
831                             sgsize);
832                 } else {
833                         sgsize = MIN(sgsize, max_sgsize);
834                 }
835
836                 sgsize = _bus_dmamap_addseg(dmat, map, curaddr, sgsize, segs,
837                     segp);
838                 if (sgsize == 0)
839                         break;
840                 vaddr += sgsize;
841                 buflen -= sgsize;
842         }
843
844         /*
845          * Did we fit?
846          */
847         return (buflen != 0 ? EFBIG : 0); /* XXX better return value here? */
848 }
849
850 void
851 _bus_dmamap_waitok(bus_dma_tag_t dmat, bus_dmamap_t map,
852                     struct memdesc *mem, bus_dmamap_callback_t *callback,
853                     void *callback_arg)
854 {
855
856         if (dmat->flags & BUS_DMA_COULD_BOUNCE) {
857                 map->dmat = dmat;
858                 map->mem = *mem;
859                 map->callback = callback;
860                 map->callback_arg = callback_arg;
861         }
862 }
863
864 bus_dma_segment_t *
865 _bus_dmamap_complete(bus_dma_tag_t dmat, bus_dmamap_t map,
866                      bus_dma_segment_t *segs, int nsegs, int error)
867 {
868
869         map->nsegs = nsegs;
870         if (segs != NULL)
871                 memcpy(map->segments, segs, map->nsegs*sizeof(segs[0]));
872         if (dmat->iommu != NULL)
873                 IOMMU_MAP(dmat->iommu, map->segments, &map->nsegs,
874                     dmat->lowaddr, dmat->highaddr, dmat->alignment,
875                     dmat->boundary, dmat->iommu_cookie);
876
877         if (segs != NULL)
878                 memcpy(segs, map->segments, map->nsegs*sizeof(segs[0]));
879         else
880                 segs = map->segments;
881
882         return (segs);
883 }
884
885 /*
886  * Release the mapping held by map.
887  */
888 void
889 bus_dmamap_unload(bus_dma_tag_t dmat, bus_dmamap_t map)
890 {
891         struct bounce_page *bpage;
892
893         if (dmat->iommu) {
894                 IOMMU_UNMAP(dmat->iommu, map->segments, map->nsegs, dmat->iommu_cookie);
895                 map->nsegs = 0;
896         }
897
898         while ((bpage = STAILQ_FIRST(&map->bpages)) != NULL) {
899                 STAILQ_REMOVE_HEAD(&map->bpages, links);
900                 free_bounce_page(dmat, bpage);
901         }
902 }
903
904 void
905 bus_dmamap_sync(bus_dma_tag_t dmat, bus_dmamap_t map, bus_dmasync_op_t op)
906 {
907         struct bounce_page *bpage;
908         vm_offset_t datavaddr, tempvaddr;
909
910         if ((bpage = STAILQ_FIRST(&map->bpages)) != NULL) {
911
912                 /*
913                  * Handle data bouncing.  We might also
914                  * want to add support for invalidating
915                  * the caches on broken hardware
916                  */
917                 CTR4(KTR_BUSDMA, "%s: tag %p tag flags 0x%x op 0x%x "
918                     "performing bounce", __func__, dmat, dmat->flags, op);
919
920                 if (op & BUS_DMASYNC_PREWRITE) {
921                         while (bpage != NULL) {
922                                 tempvaddr = 0;
923                                 datavaddr = bpage->datavaddr;
924                                 if (datavaddr == 0) {
925                                         tempvaddr = pmap_quick_enter_page(
926                                             bpage->datapage);
927                                         datavaddr = tempvaddr |
928                                             bpage->dataoffs;
929                                 }
930
931                                 bcopy((void *)datavaddr,
932                                     (void *)bpage->vaddr, bpage->datacount);
933
934                                 if (tempvaddr != 0)
935                                         pmap_quick_remove_page(tempvaddr);
936                                 bpage = STAILQ_NEXT(bpage, links);
937                         }
938                         dmat->bounce_zone->total_bounced++;
939                 }
940
941                 if (op & BUS_DMASYNC_POSTREAD) {
942                         while (bpage != NULL) {
943                                 tempvaddr = 0;
944                                 datavaddr = bpage->datavaddr;
945                                 if (datavaddr == 0) {
946                                         tempvaddr = pmap_quick_enter_page(
947                                             bpage->datapage);
948                                         datavaddr = tempvaddr |
949                                             bpage->dataoffs;
950                                 }
951
952                                 bcopy((void *)bpage->vaddr,
953                                     (void *)datavaddr, bpage->datacount);
954
955                                 if (tempvaddr != 0)
956                                         pmap_quick_remove_page(tempvaddr);
957                                 bpage = STAILQ_NEXT(bpage, links);
958                         }
959                         dmat->bounce_zone->total_bounced++;
960                 }
961         }
962
963         powerpc_sync();
964 }
965
966 static void
967 init_bounce_pages(void *dummy __unused)
968 {
969
970         total_bpages = 0;
971         STAILQ_INIT(&bounce_zone_list);
972         STAILQ_INIT(&bounce_map_waitinglist);
973         STAILQ_INIT(&bounce_map_callbacklist);
974         mtx_init(&bounce_lock, "bounce pages lock", NULL, MTX_DEF);
975 }
976 SYSINIT(bpages, SI_SUB_LOCK, SI_ORDER_ANY, init_bounce_pages, NULL);
977
978 static struct sysctl_ctx_list *
979 busdma_sysctl_tree(struct bounce_zone *bz)
980 {
981         return (&bz->sysctl_tree);
982 }
983
984 static struct sysctl_oid *
985 busdma_sysctl_tree_top(struct bounce_zone *bz)
986 {
987         return (bz->sysctl_tree_top);
988 }
989
990 static int
991 alloc_bounce_zone(bus_dma_tag_t dmat)
992 {
993         struct bounce_zone *bz;
994
995         /* Check to see if we already have a suitable zone */
996         STAILQ_FOREACH(bz, &bounce_zone_list, links) {
997                 if ((dmat->alignment <= bz->alignment)
998                  && (dmat->lowaddr >= bz->lowaddr)) {
999                         dmat->bounce_zone = bz;
1000                         return (0);
1001                 }
1002         }
1003
1004         if ((bz = (struct bounce_zone *)malloc(sizeof(*bz), M_DEVBUF,
1005             M_NOWAIT | M_ZERO)) == NULL)
1006                 return (ENOMEM);
1007
1008         STAILQ_INIT(&bz->bounce_page_list);
1009         bz->free_bpages = 0;
1010         bz->reserved_bpages = 0;
1011         bz->active_bpages = 0;
1012         bz->lowaddr = dmat->lowaddr;
1013         bz->alignment = MAX(dmat->alignment, PAGE_SIZE);
1014         bz->map_count = 0;
1015         snprintf(bz->zoneid, 8, "zone%d", busdma_zonecount);
1016         busdma_zonecount++;
1017         snprintf(bz->lowaddrid, 18, "%#jx", (uintmax_t)bz->lowaddr);
1018         STAILQ_INSERT_TAIL(&bounce_zone_list, bz, links);
1019         dmat->bounce_zone = bz;
1020
1021         sysctl_ctx_init(&bz->sysctl_tree);
1022         bz->sysctl_tree_top = SYSCTL_ADD_NODE(&bz->sysctl_tree,
1023             SYSCTL_STATIC_CHILDREN(_hw_busdma), OID_AUTO, bz->zoneid,
1024             CTLFLAG_RD, 0, "");
1025         if (bz->sysctl_tree_top == NULL) {
1026                 sysctl_ctx_free(&bz->sysctl_tree);
1027                 return (0);     /* XXX error code? */
1028         }
1029
1030         SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1031             SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1032             "total_bpages", CTLFLAG_RD, &bz->total_bpages, 0,
1033             "Total bounce pages");
1034         SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1035             SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1036             "free_bpages", CTLFLAG_RD, &bz->free_bpages, 0,
1037             "Free bounce pages");
1038         SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1039             SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1040             "reserved_bpages", CTLFLAG_RD, &bz->reserved_bpages, 0,
1041             "Reserved bounce pages");
1042         SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1043             SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1044             "active_bpages", CTLFLAG_RD, &bz->active_bpages, 0,
1045             "Active bounce pages");
1046         SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1047             SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1048             "total_bounced", CTLFLAG_RD, &bz->total_bounced, 0,
1049             "Total bounce requests");
1050         SYSCTL_ADD_INT(busdma_sysctl_tree(bz),
1051             SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1052             "total_deferred", CTLFLAG_RD, &bz->total_deferred, 0,
1053             "Total bounce requests that were deferred");
1054         SYSCTL_ADD_STRING(busdma_sysctl_tree(bz),
1055             SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1056             "lowaddr", CTLFLAG_RD, bz->lowaddrid, 0, "");
1057         SYSCTL_ADD_UAUTO(busdma_sysctl_tree(bz),
1058             SYSCTL_CHILDREN(busdma_sysctl_tree_top(bz)), OID_AUTO,
1059             "alignment", CTLFLAG_RD, &bz->alignment, "");
1060
1061         return (0);
1062 }
1063
1064 static int
1065 alloc_bounce_pages(bus_dma_tag_t dmat, u_int numpages)
1066 {
1067         struct bounce_zone *bz;
1068         int count;
1069
1070         bz = dmat->bounce_zone;
1071         count = 0;
1072         while (numpages > 0) {
1073                 struct bounce_page *bpage;
1074
1075                 bpage = (struct bounce_page *)malloc(sizeof(*bpage), M_DEVBUF,
1076                                                      M_NOWAIT | M_ZERO);
1077
1078                 if (bpage == NULL)
1079                         break;
1080                 bpage->vaddr = (vm_offset_t)contigmalloc(PAGE_SIZE, M_DEVBUF,
1081                                                          M_NOWAIT, 0ul,
1082                                                          bz->lowaddr,
1083                                                          PAGE_SIZE,
1084                                                          0);
1085                 if (bpage->vaddr == 0) {
1086                         free(bpage, M_DEVBUF);
1087                         break;
1088                 }
1089                 bpage->busaddr = pmap_kextract(bpage->vaddr);
1090                 mtx_lock(&bounce_lock);
1091                 STAILQ_INSERT_TAIL(&bz->bounce_page_list, bpage, links);
1092                 total_bpages++;
1093                 bz->total_bpages++;
1094                 bz->free_bpages++;
1095                 mtx_unlock(&bounce_lock);
1096                 count++;
1097                 numpages--;
1098         }
1099         return (count);
1100 }
1101
1102 static int
1103 reserve_bounce_pages(bus_dma_tag_t dmat, bus_dmamap_t map, int commit)
1104 {
1105         struct bounce_zone *bz;
1106         int pages;
1107
1108         mtx_assert(&bounce_lock, MA_OWNED);
1109         bz = dmat->bounce_zone;
1110         pages = MIN(bz->free_bpages, map->pagesneeded - map->pagesreserved);
1111         if (commit == 0 && map->pagesneeded > (map->pagesreserved + pages))
1112                 return (map->pagesneeded - (map->pagesreserved + pages));
1113         bz->free_bpages -= pages;
1114         bz->reserved_bpages += pages;
1115         map->pagesreserved += pages;
1116         pages = map->pagesneeded - map->pagesreserved;
1117
1118         return (pages);
1119 }
1120
1121 static bus_addr_t
1122 add_bounce_page(bus_dma_tag_t dmat, bus_dmamap_t map, vm_offset_t vaddr,
1123                 bus_addr_t addr, bus_size_t size)
1124 {
1125         struct bounce_zone *bz;
1126         struct bounce_page *bpage;
1127
1128         KASSERT(dmat->bounce_zone != NULL, ("no bounce zone in dma tag"));
1129
1130         bz = dmat->bounce_zone;
1131         if (map->pagesneeded == 0)
1132                 panic("add_bounce_page: map doesn't need any pages");
1133         map->pagesneeded--;
1134
1135         if (map->pagesreserved == 0)
1136                 panic("add_bounce_page: map doesn't need any pages");
1137         map->pagesreserved--;
1138
1139         mtx_lock(&bounce_lock);
1140         bpage = STAILQ_FIRST(&bz->bounce_page_list);
1141         if (bpage == NULL)
1142                 panic("add_bounce_page: free page list is empty");
1143
1144         STAILQ_REMOVE_HEAD(&bz->bounce_page_list, links);
1145         bz->reserved_bpages--;
1146         bz->active_bpages++;
1147         mtx_unlock(&bounce_lock);
1148
1149         if (dmat->flags & BUS_DMA_KEEP_PG_OFFSET) {
1150                 /* Page offset needs to be preserved. */
1151                 bpage->vaddr |= addr & PAGE_MASK;
1152                 bpage->busaddr |= addr & PAGE_MASK;
1153         }
1154         bpage->datavaddr = vaddr;
1155         bpage->datapage = PHYS_TO_VM_PAGE(addr);
1156         bpage->dataoffs = addr & PAGE_MASK;
1157         bpage->datacount = size;
1158         STAILQ_INSERT_TAIL(&(map->bpages), bpage, links);
1159         return (bpage->busaddr);
1160 }
1161
1162 static void
1163 free_bounce_page(bus_dma_tag_t dmat, struct bounce_page *bpage)
1164 {
1165         struct bus_dmamap *map;
1166         struct bounce_zone *bz;
1167
1168         bz = dmat->bounce_zone;
1169         bpage->datavaddr = 0;
1170         bpage->datacount = 0;
1171         if (dmat->flags & BUS_DMA_KEEP_PG_OFFSET) {
1172                 /*
1173                  * Reset the bounce page to start at offset 0.  Other uses
1174                  * of this bounce page may need to store a full page of
1175                  * data and/or assume it starts on a page boundary.
1176                  */
1177                 bpage->vaddr &= ~PAGE_MASK;
1178                 bpage->busaddr &= ~PAGE_MASK;
1179         }
1180
1181         mtx_lock(&bounce_lock);
1182         STAILQ_INSERT_HEAD(&bz->bounce_page_list, bpage, links);
1183         bz->free_bpages++;
1184         bz->active_bpages--;
1185         if ((map = STAILQ_FIRST(&bounce_map_waitinglist)) != NULL) {
1186                 if (reserve_bounce_pages(map->dmat, map, 1) == 0) {
1187                         STAILQ_REMOVE_HEAD(&bounce_map_waitinglist, links);
1188                         STAILQ_INSERT_TAIL(&bounce_map_callbacklist,
1189                                            map, links);
1190                         busdma_swi_pending = 1;
1191                         bz->total_deferred++;
1192                         swi_sched(vm_ih, 0);
1193                 }
1194         }
1195         mtx_unlock(&bounce_lock);
1196 }
1197
1198 void
1199 busdma_swi(void)
1200 {
1201         bus_dma_tag_t dmat;
1202         struct bus_dmamap *map;
1203
1204         mtx_lock(&bounce_lock);
1205         while ((map = STAILQ_FIRST(&bounce_map_callbacklist)) != NULL) {
1206                 STAILQ_REMOVE_HEAD(&bounce_map_callbacklist, links);
1207                 mtx_unlock(&bounce_lock);
1208                 dmat = map->dmat;
1209                 (dmat->lockfunc)(dmat->lockfuncarg, BUS_DMA_LOCK);
1210                 bus_dmamap_load_mem(map->dmat, map, &map->mem,
1211                                     map->callback, map->callback_arg,
1212                                     BUS_DMA_WAITOK);
1213                 (dmat->lockfunc)(dmat->lockfuncarg, BUS_DMA_UNLOCK);
1214                 mtx_lock(&bounce_lock);
1215         }
1216         mtx_unlock(&bounce_lock);
1217 }
1218
1219 int
1220 bus_dma_tag_set_iommu(bus_dma_tag_t tag, device_t iommu, void *cookie)
1221 {
1222         tag->iommu = iommu;
1223         tag->iommu_cookie = cookie;
1224
1225         return (0);
1226 }
1227