From 4e466a839d131e379f729f7ee0e36ef5dfe2a369 Mon Sep 17 00:00:00 2001 From: leo Date: Fri, 13 Mar 1998 21:05:10 +0000 Subject: [PATCH] Move the bus_* functions from machdep.c to bus.c . --- sys/arch/atari/atari/bus.c | 709 ++++++++++++++++++++++++++++++++ sys/arch/atari/atari/machdep.c | 668 +----------------------------- sys/arch/atari/conf/files.atari | 3 +- 3 files changed, 712 insertions(+), 668 deletions(-) create mode 100644 sys/arch/atari/atari/bus.c diff --git a/sys/arch/atari/atari/bus.c b/sys/arch/atari/atari/bus.c new file mode 100644 index 000000000000..db35fcd34172 --- /dev/null +++ b/sys/arch/atari/atari/bus.c @@ -0,0 +1,709 @@ +/* $NetBSD: bus.c,v 1.1 1998/03/13 21:05:10 leo Exp $ */ + +/*- + * Copyright (c) 1998 The NetBSD Foundation, Inc. + * All rights reserved. + * + * This code is derived from software contributed to The NetBSD Foundation + * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility, + * NASA Ames Research Center and by Chris G. Demetriou. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. All advertising materials mentioning features or use of this software + * must display the following acknowledgement: + * This product includes software developed by the NetBSD + * Foundation, Inc. and its contributors. + * 4. Neither the name of The NetBSD Foundation nor the names of its + * contributors may be used to endorse or promote products derived + * from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS + * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED + * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR + * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS + * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#include +#include +#include +#include + +#include +#include + +#include +#include +#include + +static int _bus_dmamap_load_buffer __P((bus_dma_tag_t tag, bus_dmamap_t, + void *, bus_size_t, struct proc *, int, vm_offset_t *, + int *, int)); +static int _bus_dmamem_alloc_range __P((bus_dma_tag_t tag, bus_size_t size, + bus_size_t alignment, bus_size_t boundary, + bus_dma_segment_t *segs, int nsegs, int *rsegs, int flags, + vm_offset_t low, vm_offset_t high)); + +extern vm_offset_t avail_end; + +int +bus_space_map(t, bpa, size, flags, mhp) +bus_space_tag_t t; +bus_addr_t bpa; +bus_size_t size; +int flags; +bus_space_handle_t *mhp; +{ + vm_offset_t va; + u_long pa, endpa; + + pa = m68k_trunc_page(bpa + t); + endpa = m68k_round_page((bpa + t + size) - 1); + +#ifdef DIAGNOSTIC + if (endpa <= pa) + panic("bus_mem_map: overflow"); +#endif + + va = kmem_alloc_pageable(kernel_map, endpa - pa); + if (va == 0) + return 1; + *mhp = (caddr_t)(va + (bpa & PGOFSET)); + + for(; pa < endpa; pa += NBPG, va += NBPG) { + pmap_enter(pmap_kernel(), (vm_offset_t)va, pa, + VM_PROT_READ|VM_PROT_WRITE, TRUE); + if (!(flags & BUS_SPACE_MAP_CACHEABLE)) + pmap_changebit(pa, PG_CI, TRUE); + } + return (0); +} + +void +bus_space_unmap(t, memh, size) +bus_space_tag_t t; +bus_space_handle_t memh; +bus_size_t size; +{ + vm_offset_t va, endva; + + va = m68k_trunc_page(memh); + endva = m68k_round_page((memh + size) - 1); + +#ifdef DIAGNOSTIC + if (endva < va) + panic("unmap_iospace: overflow"); +#endif + + kmem_free(kernel_map, va, endva - va); +} + +/* + * Get a new handle for a subregion of an already-mapped area of bus space. + */ +int bus_space_subregion(t, memh, off, sz, mhp) +bus_space_tag_t t; +bus_space_handle_t memh; +bus_size_t off, sz; +bus_space_handle_t *mhp; +{ + *mhp = memh + off; + return 0; +} + +/* + * Common function for DMA map creation. May be called by bus-specific + * DMA map creation functions. + */ +int +bus_dmamap_create(t, size, nsegments, maxsegsz, boundary, flags, dmamp) + bus_dma_tag_t t; + bus_size_t size; + int nsegments; + bus_size_t maxsegsz; + bus_size_t boundary; + int flags; + bus_dmamap_t *dmamp; +{ + struct atari_bus_dmamap *map; + void *mapstore; + size_t mapsize; + + /* + * Allocate and initialize the DMA map. The end of the map + * is a variable-sized array of segments, so we allocate enough + * room for them in one shot. + * + * Note we don't preserve the WAITOK or NOWAIT flags. Preservation + * of ALLOCNOW notifies others that we've reserved these resources, + * and they are not to be freed. + * + * The bus_dmamap_t includes one bus_dma_segment_t, hence + * the (nsegments - 1). + */ + mapsize = sizeof(struct atari_bus_dmamap) + + (sizeof(bus_dma_segment_t) * (nsegments - 1)); + if ((mapstore = malloc(mapsize, M_DMAMAP, + (flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK)) == NULL) + return (ENOMEM); + + bzero(mapstore, mapsize); + map = (struct atari_bus_dmamap *)mapstore; + map->_dm_size = size; + map->_dm_segcnt = nsegments; + map->_dm_maxsegsz = maxsegsz; + map->_dm_boundary = boundary; + map->_dm_flags = flags & ~(BUS_DMA_WAITOK|BUS_DMA_NOWAIT); + map->dm_mapsize = 0; /* no valid mappings */ + map->dm_nsegs = 0; + + *dmamp = map; + return (0); +} + +/* + * Common function for DMA map destruction. May be called by bus-specific + * DMA map destruction functions. + */ +void +bus_dmamap_destroy(t, map) + bus_dma_tag_t t; + bus_dmamap_t map; +{ + + free(map, M_DMAMAP); +} + +/* + * Common function for loading a DMA map with a linear buffer. May + * be called by bus-specific DMA map load functions. + */ +int +bus_dmamap_load(t, map, buf, buflen, p, flags) + bus_dma_tag_t t; + bus_dmamap_t map; + void *buf; + bus_size_t buflen; + struct proc *p; + int flags; +{ + vm_offset_t lastaddr; + int seg, error; + + /* + * Make sure that on error condition we return "no valid mappings". + */ + map->dm_mapsize = 0; + map->dm_nsegs = 0; + + if (buflen > map->_dm_size) + return (EINVAL); + + seg = 0; + error = _bus_dmamap_load_buffer(t, map, buf, buflen, p, flags, + &lastaddr, &seg, 1); + if (error == 0) { + map->dm_mapsize = buflen; + map->dm_nsegs = seg + 1; + } + return (error); +} + +/* + * Like _bus_dmamap_load(), but for mbufs. + */ +int +bus_dmamap_load_mbuf(t, map, m0, flags) + bus_dma_tag_t t; + bus_dmamap_t map; + struct mbuf *m0; + int flags; +{ + vm_offset_t lastaddr; + int seg, error, first; + struct mbuf *m; + + /* + * Make sure that on error condition we return "no valid mappings." + */ + map->dm_mapsize = 0; + map->dm_nsegs = 0; + +#ifdef DIAGNOSTIC + if ((m0->m_flags & M_PKTHDR) == 0) + panic("_bus_dmamap_load_mbuf: no packet header"); +#endif + + if (m0->m_pkthdr.len > map->_dm_size) + return (EINVAL); + + first = 1; + seg = 0; + error = 0; + for (m = m0; m != NULL && error == 0; m = m->m_next) { + error = _bus_dmamap_load_buffer(t, map, m->m_data, m->m_len, + NULL, flags, &lastaddr, &seg, first); + first = 0; + } + if (error == 0) { + map->dm_mapsize = m0->m_pkthdr.len; + map->dm_nsegs = seg + 1; + } + return (error); +} + +/* + * Like _bus_dmamap_load(), but for uios. + */ +int +bus_dmamap_load_uio(t, map, uio, flags) + bus_dma_tag_t t; + bus_dmamap_t map; + struct uio *uio; + int flags; +{ + + panic("bus_dmamap_load_uio: not implemented"); +} + +/* + * Like _bus_dmamap_load(), but for raw memory allocated with + * bus_dmamem_alloc(). + */ +int +bus_dmamap_load_raw(t, map, segs, nsegs, size, flags) + bus_dma_tag_t t; + bus_dmamap_t map; + bus_dma_segment_t *segs; + int nsegs; + bus_size_t size; + int flags; +{ + + panic("bus_dmamap_load_raw: not implemented"); +} + +/* + * Common function for unloading a DMA map. May be called by + * bus-specific DMA map unload functions. + */ +void +bus_dmamap_unload(t, map) + bus_dma_tag_t t; + bus_dmamap_t map; +{ + + /* + * No resources to free; just mark the mappings as + * invalid. + */ + map->dm_mapsize = 0; + map->dm_nsegs = 0; +} + +/* + * Common function for DMA map synchronization. May be called + * by bus-specific DMA map synchronization functions. + */ +void +bus_dmamap_sync(t, map, off, len, ops) + bus_dma_tag_t t; + bus_dmamap_t map; + bus_addr_t off; + bus_size_t len; + int ops; +{ + int i, pa_off, inc, seglen; + u_long pa, end_pa; + +#if !defined(M68040) && !defined(M68060) + return; +#endif + + if (t == BUS_PCI_DMA_TAG) + pa_off = 0x80000000; /* XXX */ + else pa_off = 0; + + /* Flush granularity */ + inc = (len > 1024) ? NBPG : 16; + + for (i = 0; i < map->dm_nsegs && len > 0; i++) { + if (map->dm_segs[i].ds_len <= off) { + /* Segment irrelevant - before requested offset */ + off -= map->dm_segs[i].ds_len; + continue; + } + seglen = map->dm_segs[i].ds_len - off; + if (seglen > len) + seglen = len; + len -= seglen; + pa = map->dm_segs[i].ds_addr + off - pa_off; + end_pa = pa + seglen; + + if (inc == 16) { + pa &= ~15; + while (pa < end_pa) { + DCFL(pa); + pa += 16; + } + } else { + pa &= ~PGOFSET; + while (pa < end_pa) { + DCFP(pa); + pa += NBPG; + } + } + } +} + +/* + * Common function for DMA-safe memory allocation. May be called + * by bus-specific DMA memory allocation functions. + */ +int +bus_dmamem_alloc(t, size, alignment, boundary, segs, nsegs, rsegs, flags) + bus_dma_tag_t t; + bus_size_t size, alignment, boundary; + bus_dma_segment_t *segs; + int nsegs; + int *rsegs; + int flags; +{ + + return (_bus_dmamem_alloc_range(t, size, alignment, boundary, + segs, nsegs, rsegs, flags, 0, trunc_page(avail_end))); +} + +/* + * Common function for freeing DMA-safe memory. May be called by + * bus-specific DMA memory free functions. + */ +void +bus_dmamem_free(t, segs, nsegs) + bus_dma_tag_t t; + bus_dma_segment_t *segs; + int nsegs; +{ + vm_page_t m; + bus_addr_t addr, offset; + struct pglist mlist; + int curseg; + + if (t == BUS_PCI_DMA_TAG) + offset = 0x80000000; /* XXX */ + else offset = 0; + + /* + * Build a list of pages to free back to the VM system. + */ + TAILQ_INIT(&mlist); + for (curseg = 0; curseg < nsegs; curseg++) { + for (addr = segs[curseg].ds_addr; + addr < (segs[curseg].ds_addr + segs[curseg].ds_len); + addr += PAGE_SIZE) { + m = PHYS_TO_VM_PAGE(addr - offset); + TAILQ_INSERT_TAIL(&mlist, m, pageq); + } + } + +#if defined(UVM) + uvm_pglistfree(&mlist); +#else + vm_page_free_memory(&mlist); +#endif +} + +/* + * Common function for mapping DMA-safe memory. May be called by + * bus-specific DMA memory map functions. + */ +int +bus_dmamem_map(t, segs, nsegs, size, kvap, flags) + bus_dma_tag_t t; + bus_dma_segment_t *segs; + int nsegs; + size_t size; + caddr_t *kvap; + int flags; +{ + vm_offset_t va; + bus_addr_t addr, offset; + int curseg; + + if (t == BUS_PCI_DMA_TAG) + offset = 0x80000000; /* XXX */ + else offset = 0; + + size = round_page(size); + +#if defined(UVM) + va = uvm_km_valloc(kernel_map, size); +#else + va = kmem_alloc_pageable(kernel_map, size); +#endif + + if (va == 0) + return (ENOMEM); + + *kvap = (caddr_t)va; + + for (curseg = 0; curseg < nsegs; curseg++) { + for (addr = segs[curseg].ds_addr; + addr < (segs[curseg].ds_addr + segs[curseg].ds_len); + addr += NBPG, va += NBPG, size -= NBPG) { + if (size == 0) + panic("_bus_dmamem_map: size botch"); +#if defined(PMAP_NEW) + pmap_kenter_pa(va, addr - offset, + VM_PROT_READ | VM_PROT_WRITE); +#else + pmap_enter(pmap_kernel(), va, addr - offset, + VM_PROT_READ | VM_PROT_WRITE, TRUE); +#endif + } + } + + return (0); +} + +/* + * Common function for unmapping DMA-safe memory. May be called by + * bus-specific DMA memory unmapping functions. + */ +void +bus_dmamem_unmap(t, kva, size) + bus_dma_tag_t t; + caddr_t kva; + size_t size; +{ + +#ifdef DIAGNOSTIC + if ((u_long)kva & PGOFSET) + panic("_bus_dmamem_unmap"); +#endif + + size = round_page(size); + +#if defined(UVM) + uvm_km_free(kernel_map, (vm_offset_t)kva, size); +#else + kmem_free(kernel_map, (vm_offset_t)kva, size); +#endif +} + +/* + * Common functin for mmap(2)'ing DMA-safe memory. May be called by + * bus-specific DMA mmap(2)'ing functions. + */ +int +bus_dmamem_mmap(t, segs, nsegs, off, prot, flags) + bus_dma_tag_t t; + bus_dma_segment_t *segs; + int nsegs, off, prot, flags; +{ + int i, offset; + + if (t == BUS_PCI_DMA_TAG) + offset = 0x80000000; /* XXX */ + else offset = 0; + + for (i = 0; i < nsegs; i++) { +#ifdef DIAGNOSTIC + if (off & PGOFSET) + panic("_bus_dmamem_mmap: offset unaligned"); + if (segs[i].ds_addr & PGOFSET) + panic("_bus_dmamem_mmap: segment unaligned"); + if (segs[i].ds_len & PGOFSET) + panic("_bus_dmamem_mmap: segment size not multiple" + " of page size"); +#endif + if (off >= segs[i].ds_len) { + off -= segs[i].ds_len; + continue; + } + + return (m68k_btop((caddr_t)segs[i].ds_addr - offset + off)); + } + + /* Page not found. */ + return (-1); +} + +/********************************************************************** + * DMA utility functions + **********************************************************************/ + +/* + * Utility function to load a linear buffer. lastaddrp holds state + * between invocations (for multiple-buffer loads). segp contains + * the starting segment on entrace, and the ending segment on exit. + * first indicates if this is the first invocation of this function. + */ +static int +_bus_dmamap_load_buffer(t, map, buf, buflen, p, flags, lastaddrp, segp, first) + bus_dma_tag_t t; + bus_dmamap_t map; + void *buf; + bus_size_t buflen; + struct proc *p; + int flags; + vm_offset_t *lastaddrp; + int *segp; + int first; +{ + bus_size_t sgsize; + bus_addr_t curaddr, lastaddr, offset; + caddr_t vaddr = buf; + int seg; + pmap_t pmap; + + if (t == BUS_PCI_DMA_TAG) + offset = 0x80000000; /* XXX */ + else offset = 0; + + if (p != NULL) + pmap = p->p_vmspace->vm_map.pmap; + else + pmap = pmap_kernel(); + + lastaddr = *lastaddrp; + + for (seg = *segp; buflen > 0 && seg < map->_dm_segcnt; ) { + /* + * Get the physical address for this segment. + */ + curaddr = (bus_addr_t)pmap_extract(pmap, (vm_offset_t)vaddr); + + /* + * Compute the segment size, and adjust counts. + */ + sgsize = NBPG - ((u_long)vaddr & PGOFSET); + if (buflen < sgsize) + sgsize = buflen; + + /* + * Insert chunk into a segment, coalescing with + * previous segment if possible. + */ + if (first) { + map->dm_segs[seg].ds_addr = curaddr + offset; + map->dm_segs[seg].ds_len = sgsize; + first = 0; + } else { + if (curaddr == lastaddr && + (map->dm_segs[seg].ds_len + sgsize) <= + map->_dm_maxsegsz) + map->dm_segs[seg].ds_len += sgsize; + else { + seg++; + map->dm_segs[seg].ds_addr = curaddr + offset; + map->dm_segs[seg].ds_len = sgsize; + } + } + + lastaddr = curaddr + sgsize; + vaddr += sgsize; + buflen -= sgsize; + } + + *segp = seg; + *lastaddrp = lastaddr; + + /* + * Did we fit? + */ + if (buflen != 0) + return (EFBIG); /* XXX better return value here? */ + return (0); +} + +/* + * Allocate physical memory from the given physical address range. + * Called by DMA-safe memory allocation methods. + */ +static int +_bus_dmamem_alloc_range(t, size, alignment, boundary, segs, nsegs, rsegs, + flags, low, high) + bus_dma_tag_t t; + bus_size_t size, alignment, boundary; + bus_dma_segment_t *segs; + int nsegs; + int *rsegs; + int flags; + vm_offset_t low; + vm_offset_t high; +{ + vm_offset_t curaddr, lastaddr; + bus_addr_t offset; + vm_page_t m; + struct pglist mlist; + int curseg, error; + + if (t == BUS_PCI_DMA_TAG) + offset = 0x80000000; /* XXX */ + else offset = 0; + + /* Always round the size. */ + size = round_page(size); + + /* + * Allocate pages from the VM system. + */ + TAILQ_INIT(&mlist); +#if defined(UVM) + error = uvm_pglistalloc(size, low, high, alignment, boundary, + &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0); +#else + error = vm_page_alloc_memory(size, low, high, + alignment, boundary, &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0); +#endif + if (error) + return (error); + + /* + * Compute the location, size, and number of segments actually + * returned by the VM code. + */ + m = mlist.tqh_first; + curseg = 0; + lastaddr = VM_PAGE_TO_PHYS(m); + segs[curseg].ds_addr = lastaddr + offset; + segs[curseg].ds_len = PAGE_SIZE; + m = m->pageq.tqe_next; + + for (; m != NULL; m = m->pageq.tqe_next) { + curaddr = VM_PAGE_TO_PHYS(m); +#ifdef DIAGNOSTIC + if (curaddr < low || curaddr >= high) { + printf("vm_page_alloc_memory returned non-sensical" + " address 0x%lx\n", curaddr); + panic("_bus_dmamem_alloc_range"); + } +#endif + if (curaddr == (lastaddr + PAGE_SIZE)) + segs[curseg].ds_len += PAGE_SIZE; + else { + curseg++; + segs[curseg].ds_addr = curaddr + offset; + segs[curseg].ds_len = PAGE_SIZE; + } + lastaddr = curaddr; + } + + *rsegs = curseg + 1; + + return (0); +} diff --git a/sys/arch/atari/atari/machdep.c b/sys/arch/atari/atari/machdep.c index 4345dc9de07e..adb9085e09a6 100644 --- a/sys/arch/atari/atari/machdep.c +++ b/sys/arch/atari/atari/machdep.c @@ -1,4 +1,4 @@ -/* $NetBSD: machdep.c,v 1.59 1998/03/10 11:42:53 leo Exp $ */ +/* $NetBSD: machdep.c,v 1.60 1998/03/13 21:05:10 leo Exp $ */ /* * Copyright (c) 1988 University of Utah. @@ -75,18 +75,10 @@ #include #define MAXMEM 64*1024*CLSIZE /* XXX - from cmap.h */ #include -#include -#include -#include -#include #include -#include #include -#include -#include - #include #include #include @@ -95,21 +87,11 @@ #include #include #include -#include - -#include #include static void bootsync __P((void)); static void call_sicallbacks __P((void)); -static int _bus_dmamap_load_buffer __P((bus_dma_tag_t tag, bus_dmamap_t, - void *, bus_size_t, struct proc *, int, vm_offset_t *, - int *, int)); -static int _bus_dmamem_alloc_range __P((bus_dma_tag_t tag, bus_size_t size, - bus_size_t alignment, bus_size_t boundary, - bus_dma_segment_t *segs, int nsegs, int *rsegs, int flags, - vm_offset_t low, vm_offset_t high)); static void identifycpu __P((void)); static void netintr __P((void)); void straymfpint __P((int, u_short)); @@ -1084,651 +1066,3 @@ cpu_exec_aout_makecmds(p, epp) return(error); } -int -bus_space_map(t, bpa, size, flags, mhp) -bus_space_tag_t t; -bus_addr_t bpa; -bus_size_t size; -int flags; -bus_space_handle_t *mhp; -{ - vm_offset_t va; - u_long pa, endpa; - - pa = m68k_trunc_page(bpa + t); - endpa = m68k_round_page((bpa + t + size) - 1); - -#ifdef DIAGNOSTIC - if (endpa <= pa) - panic("bus_mem_map: overflow"); -#endif - - va = kmem_alloc_pageable(kernel_map, endpa - pa); - if (va == 0) - return 1; - *mhp = (caddr_t)(va + (bpa & PGOFSET)); - - for(; pa < endpa; pa += NBPG, va += NBPG) { - pmap_enter(pmap_kernel(), (vm_offset_t)va, pa, - VM_PROT_READ|VM_PROT_WRITE, TRUE); - if (!(flags & BUS_SPACE_MAP_CACHEABLE)) - pmap_changebit(pa, PG_CI, TRUE); - } - return (0); -} - -void -bus_space_unmap(t, memh, size) -bus_space_tag_t t; -bus_space_handle_t memh; -bus_size_t size; -{ - vm_offset_t va, endva; - - va = m68k_trunc_page(memh); - endva = m68k_round_page((memh + size) - 1); - -#ifdef DIAGNOSTIC - if (endva < va) - panic("unmap_iospace: overflow"); -#endif - - kmem_free(kernel_map, va, endva - va); -} - -/* - * Get a new handle for a subregion of an already-mapped area of bus space. - */ -int bus_space_subregion(t, memh, off, sz, mhp) -bus_space_tag_t t; -bus_space_handle_t memh; -bus_size_t off, sz; -bus_space_handle_t *mhp; -{ - *mhp = memh + off; - return 0; -} - -/* - * Common function for DMA map creation. May be called by bus-specific - * DMA map creation functions. - */ -int -bus_dmamap_create(t, size, nsegments, maxsegsz, boundary, flags, dmamp) - bus_dma_tag_t t; - bus_size_t size; - int nsegments; - bus_size_t maxsegsz; - bus_size_t boundary; - int flags; - bus_dmamap_t *dmamp; -{ - struct atari_bus_dmamap *map; - void *mapstore; - size_t mapsize; - - /* - * Allocate and initialize the DMA map. The end of the map - * is a variable-sized array of segments, so we allocate enough - * room for them in one shot. - * - * Note we don't preserve the WAITOK or NOWAIT flags. Preservation - * of ALLOCNOW notifies others that we've reserved these resources, - * and they are not to be freed. - * - * The bus_dmamap_t includes one bus_dma_segment_t, hence - * the (nsegments - 1). - */ - mapsize = sizeof(struct atari_bus_dmamap) + - (sizeof(bus_dma_segment_t) * (nsegments - 1)); - if ((mapstore = malloc(mapsize, M_DMAMAP, - (flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK)) == NULL) - return (ENOMEM); - - bzero(mapstore, mapsize); - map = (struct atari_bus_dmamap *)mapstore; - map->_dm_size = size; - map->_dm_segcnt = nsegments; - map->_dm_maxsegsz = maxsegsz; - map->_dm_boundary = boundary; - map->_dm_flags = flags & ~(BUS_DMA_WAITOK|BUS_DMA_NOWAIT); - map->dm_mapsize = 0; /* no valid mappings */ - map->dm_nsegs = 0; - - *dmamp = map; - return (0); -} - -/* - * Common function for DMA map destruction. May be called by bus-specific - * DMA map destruction functions. - */ -void -bus_dmamap_destroy(t, map) - bus_dma_tag_t t; - bus_dmamap_t map; -{ - - free(map, M_DMAMAP); -} - -/* - * Common function for loading a DMA map with a linear buffer. May - * be called by bus-specific DMA map load functions. - */ -int -bus_dmamap_load(t, map, buf, buflen, p, flags) - bus_dma_tag_t t; - bus_dmamap_t map; - void *buf; - bus_size_t buflen; - struct proc *p; - int flags; -{ - vm_offset_t lastaddr; - int seg, error; - - /* - * Make sure that on error condition we return "no valid mappings". - */ - map->dm_mapsize = 0; - map->dm_nsegs = 0; - - if (buflen > map->_dm_size) - return (EINVAL); - - seg = 0; - error = _bus_dmamap_load_buffer(t, map, buf, buflen, p, flags, - &lastaddr, &seg, 1); - if (error == 0) { - map->dm_mapsize = buflen; - map->dm_nsegs = seg + 1; - } - return (error); -} - -/* - * Like _bus_dmamap_load(), but for mbufs. - */ -int -bus_dmamap_load_mbuf(t, map, m0, flags) - bus_dma_tag_t t; - bus_dmamap_t map; - struct mbuf *m0; - int flags; -{ - vm_offset_t lastaddr; - int seg, error, first; - struct mbuf *m; - - /* - * Make sure that on error condition we return "no valid mappings." - */ - map->dm_mapsize = 0; - map->dm_nsegs = 0; - -#ifdef DIAGNOSTIC - if ((m0->m_flags & M_PKTHDR) == 0) - panic("_bus_dmamap_load_mbuf: no packet header"); -#endif - - if (m0->m_pkthdr.len > map->_dm_size) - return (EINVAL); - - first = 1; - seg = 0; - error = 0; - for (m = m0; m != NULL && error == 0; m = m->m_next) { - error = _bus_dmamap_load_buffer(t, map, m->m_data, m->m_len, - NULL, flags, &lastaddr, &seg, first); - first = 0; - } - if (error == 0) { - map->dm_mapsize = m0->m_pkthdr.len; - map->dm_nsegs = seg + 1; - } - return (error); -} - -/* - * Like _bus_dmamap_load(), but for uios. - */ -int -bus_dmamap_load_uio(t, map, uio, flags) - bus_dma_tag_t t; - bus_dmamap_t map; - struct uio *uio; - int flags; -{ - - panic("bus_dmamap_load_uio: not implemented"); -} - -/* - * Like _bus_dmamap_load(), but for raw memory allocated with - * bus_dmamem_alloc(). - */ -int -bus_dmamap_load_raw(t, map, segs, nsegs, size, flags) - bus_dma_tag_t t; - bus_dmamap_t map; - bus_dma_segment_t *segs; - int nsegs; - bus_size_t size; - int flags; -{ - - panic("bus_dmamap_load_raw: not implemented"); -} - -/* - * Common function for unloading a DMA map. May be called by - * bus-specific DMA map unload functions. - */ -void -bus_dmamap_unload(t, map) - bus_dma_tag_t t; - bus_dmamap_t map; -{ - - /* - * No resources to free; just mark the mappings as - * invalid. - */ - map->dm_mapsize = 0; - map->dm_nsegs = 0; -} - -/* - * Common function for DMA map synchronization. May be called - * by bus-specific DMA map synchronization functions. - */ -void -bus_dmamap_sync(t, map, off, len, ops) - bus_dma_tag_t t; - bus_dmamap_t map; - bus_addr_t off; - bus_size_t len; - int ops; -{ - int i, pa_off, inc, seglen; - u_long pa, end_pa; - -#if !defined(M68040) && !defined(M68060) - return; -#endif - - if (t == BUS_PCI_DMA_TAG) - pa_off = 0x80000000; /* XXX */ - else pa_off = 0; - - /* Flush granularity */ - inc = (len > 1024) ? NBPG : 16; - - for (i = 0; i < map->dm_nsegs && len > 0; i++) { - if (map->dm_segs[i].ds_len <= off) { - /* Segment irrelevant - before requested offset */ - off -= map->dm_segs[i].ds_len; - continue; - } - seglen = map->dm_segs[i].ds_len - off; - if (seglen > len) - seglen = len; - len -= seglen; - pa = map->dm_segs[i].ds_addr + off - pa_off; - end_pa = pa + seglen; - - if (inc == 16) { - pa &= ~15; - while (pa < end_pa) { - DCFL(pa); - pa += 16; - } - } else { - pa &= ~PGOFSET; - while (pa < end_pa) { - DCFP(pa); - pa += NBPG; - } - } - } -} - -/* - * Common function for DMA-safe memory allocation. May be called - * by bus-specific DMA memory allocation functions. - */ -int -bus_dmamem_alloc(t, size, alignment, boundary, segs, nsegs, rsegs, flags) - bus_dma_tag_t t; - bus_size_t size, alignment, boundary; - bus_dma_segment_t *segs; - int nsegs; - int *rsegs; - int flags; -{ - - return (_bus_dmamem_alloc_range(t, size, alignment, boundary, - segs, nsegs, rsegs, flags, 0, trunc_page(avail_end))); -} - -/* - * Common function for freeing DMA-safe memory. May be called by - * bus-specific DMA memory free functions. - */ -void -bus_dmamem_free(t, segs, nsegs) - bus_dma_tag_t t; - bus_dma_segment_t *segs; - int nsegs; -{ - vm_page_t m; - bus_addr_t addr, offset; - struct pglist mlist; - int curseg; - - if (t == BUS_PCI_DMA_TAG) - offset = 0x80000000; /* XXX */ - else offset = 0; - - /* - * Build a list of pages to free back to the VM system. - */ - TAILQ_INIT(&mlist); - for (curseg = 0; curseg < nsegs; curseg++) { - for (addr = segs[curseg].ds_addr; - addr < (segs[curseg].ds_addr + segs[curseg].ds_len); - addr += PAGE_SIZE) { - m = PHYS_TO_VM_PAGE(addr - offset); - TAILQ_INSERT_TAIL(&mlist, m, pageq); - } - } - -#if defined(UVM) - uvm_pglistfree(&mlist); -#else - vm_page_free_memory(&mlist); -#endif -} - -/* - * Common function for mapping DMA-safe memory. May be called by - * bus-specific DMA memory map functions. - */ -int -bus_dmamem_map(t, segs, nsegs, size, kvap, flags) - bus_dma_tag_t t; - bus_dma_segment_t *segs; - int nsegs; - size_t size; - caddr_t *kvap; - int flags; -{ - vm_offset_t va; - bus_addr_t addr, offset; - int curseg; - - if (t == BUS_PCI_DMA_TAG) - offset = 0x80000000; /* XXX */ - else offset = 0; - - size = round_page(size); - -#if defined(UVM) - va = uvm_km_valloc(kernel_map, size); -#else - va = kmem_alloc_pageable(kernel_map, size); -#endif - - if (va == 0) - return (ENOMEM); - - *kvap = (caddr_t)va; - - for (curseg = 0; curseg < nsegs; curseg++) { - for (addr = segs[curseg].ds_addr; - addr < (segs[curseg].ds_addr + segs[curseg].ds_len); - addr += NBPG, va += NBPG, size -= NBPG) { - if (size == 0) - panic("_bus_dmamem_map: size botch"); -#if defined(PMAP_NEW) - pmap_kenter_pa(va, addr - offset, - VM_PROT_READ | VM_PROT_WRITE); -#else - pmap_enter(pmap_kernel(), va, addr - offset, - VM_PROT_READ | VM_PROT_WRITE, TRUE); -#endif - } - } - - return (0); -} - -/* - * Common function for unmapping DMA-safe memory. May be called by - * bus-specific DMA memory unmapping functions. - */ -void -bus_dmamem_unmap(t, kva, size) - bus_dma_tag_t t; - caddr_t kva; - size_t size; -{ - -#ifdef DIAGNOSTIC - if ((u_long)kva & PGOFSET) - panic("_bus_dmamem_unmap"); -#endif - - size = round_page(size); - -#if defined(UVM) - uvm_km_free(kernel_map, (vm_offset_t)kva, size); -#else - kmem_free(kernel_map, (vm_offset_t)kva, size); -#endif -} - -/* - * Common functin for mmap(2)'ing DMA-safe memory. May be called by - * bus-specific DMA mmap(2)'ing functions. - */ -int -bus_dmamem_mmap(t, segs, nsegs, off, prot, flags) - bus_dma_tag_t t; - bus_dma_segment_t *segs; - int nsegs, off, prot, flags; -{ - int i, offset; - - if (t == BUS_PCI_DMA_TAG) - offset = 0x80000000; /* XXX */ - else offset = 0; - - for (i = 0; i < nsegs; i++) { -#ifdef DIAGNOSTIC - if (off & PGOFSET) - panic("_bus_dmamem_mmap: offset unaligned"); - if (segs[i].ds_addr & PGOFSET) - panic("_bus_dmamem_mmap: segment unaligned"); - if (segs[i].ds_len & PGOFSET) - panic("_bus_dmamem_mmap: segment size not multiple" - " of page size"); -#endif - if (off >= segs[i].ds_len) { - off -= segs[i].ds_len; - continue; - } - - return (m68k_btop((caddr_t)segs[i].ds_addr - offset + off)); - } - - /* Page not found. */ - return (-1); -} - -/********************************************************************** - * DMA utility functions - **********************************************************************/ - -/* - * Utility function to load a linear buffer. lastaddrp holds state - * between invocations (for multiple-buffer loads). segp contains - * the starting segment on entrace, and the ending segment on exit. - * first indicates if this is the first invocation of this function. - */ -static int -_bus_dmamap_load_buffer(t, map, buf, buflen, p, flags, lastaddrp, segp, first) - bus_dma_tag_t t; - bus_dmamap_t map; - void *buf; - bus_size_t buflen; - struct proc *p; - int flags; - vm_offset_t *lastaddrp; - int *segp; - int first; -{ - bus_size_t sgsize; - bus_addr_t curaddr, lastaddr, offset; - caddr_t vaddr = buf; - int seg; - pmap_t pmap; - - if (t == BUS_PCI_DMA_TAG) - offset = 0x80000000; /* XXX */ - else offset = 0; - - if (p != NULL) - pmap = p->p_vmspace->vm_map.pmap; - else - pmap = pmap_kernel(); - - lastaddr = *lastaddrp; - - for (seg = *segp; buflen > 0 && seg < map->_dm_segcnt; ) { - /* - * Get the physical address for this segment. - */ - curaddr = (bus_addr_t)pmap_extract(pmap, (vm_offset_t)vaddr); - - /* - * Compute the segment size, and adjust counts. - */ - sgsize = NBPG - ((u_long)vaddr & PGOFSET); - if (buflen < sgsize) - sgsize = buflen; - - /* - * Insert chunk into a segment, coalescing with - * previous segment if possible. - */ - if (first) { - map->dm_segs[seg].ds_addr = curaddr + offset; - map->dm_segs[seg].ds_len = sgsize; - first = 0; - } else { - if (curaddr == lastaddr && - (map->dm_segs[seg].ds_len + sgsize) <= - map->_dm_maxsegsz) - map->dm_segs[seg].ds_len += sgsize; - else { - seg++; - map->dm_segs[seg].ds_addr = curaddr + offset; - map->dm_segs[seg].ds_len = sgsize; - } - } - - lastaddr = curaddr + sgsize; - vaddr += sgsize; - buflen -= sgsize; - } - - *segp = seg; - *lastaddrp = lastaddr; - - /* - * Did we fit? - */ - if (buflen != 0) - return (EFBIG); /* XXX better return value here? */ - return (0); -} - -/* - * Allocate physical memory from the given physical address range. - * Called by DMA-safe memory allocation methods. - */ -static int -_bus_dmamem_alloc_range(t, size, alignment, boundary, segs, nsegs, rsegs, - flags, low, high) - bus_dma_tag_t t; - bus_size_t size, alignment, boundary; - bus_dma_segment_t *segs; - int nsegs; - int *rsegs; - int flags; - vm_offset_t low; - vm_offset_t high; -{ - vm_offset_t curaddr, lastaddr; - bus_addr_t offset; - vm_page_t m; - struct pglist mlist; - int curseg, error; - - if (t == BUS_PCI_DMA_TAG) - offset = 0x80000000; /* XXX */ - else offset = 0; - - /* Always round the size. */ - size = round_page(size); - - /* - * Allocate pages from the VM system. - */ - TAILQ_INIT(&mlist); -#if defined(UVM) - error = uvm_pglistalloc(size, low, high, alignment, boundary, - &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0); -#else - error = vm_page_alloc_memory(size, low, high, - alignment, boundary, &mlist, nsegs, (flags & BUS_DMA_NOWAIT) == 0); -#endif - if (error) - return (error); - - /* - * Compute the location, size, and number of segments actually - * returned by the VM code. - */ - m = mlist.tqh_first; - curseg = 0; - lastaddr = VM_PAGE_TO_PHYS(m); - segs[curseg].ds_addr = lastaddr + offset; - segs[curseg].ds_len = PAGE_SIZE; - m = m->pageq.tqe_next; - - for (; m != NULL; m = m->pageq.tqe_next) { - curaddr = VM_PAGE_TO_PHYS(m); -#ifdef DIAGNOSTIC - if (curaddr < low || curaddr >= high) { - printf("vm_page_alloc_memory returned non-sensical" - " address 0x%lx\n", curaddr); - panic("_bus_dmamem_alloc_range"); - } -#endif - if (curaddr == (lastaddr + PAGE_SIZE)) - segs[curseg].ds_len += PAGE_SIZE; - else { - curseg++; - segs[curseg].ds_addr = curaddr + offset; - segs[curseg].ds_len = PAGE_SIZE; - } - lastaddr = curaddr; - } - - *rsegs = curseg + 1; - - return (0); -} diff --git a/sys/arch/atari/conf/files.atari b/sys/arch/atari/conf/files.atari index 7acc3f0b5264..37ad42b2cb66 100644 --- a/sys/arch/atari/conf/files.atari +++ b/sys/arch/atari/conf/files.atari @@ -1,5 +1,5 @@ # -# $NetBSD: files.atari,v 1.47 1998/02/16 22:12:46 thorpej Exp $ +# $NetBSD: files.atari,v 1.48 1998/03/13 21:05:20 leo Exp $ maxpartitions 16 @@ -161,6 +161,7 @@ file dev/cons.c ite file dev/cninit.c ite file arch/atari/atari/atari_init.c file arch/atari/atari/autoconf.c +file arch/atari/atari/bus.c file arch/atari/atari/conf.c file arch/atari/atari/disksubr.c file arch/atari/atari/dkbad.c