#define _ALPHA_BUS_DMA_PRIVATE
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/syslog.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <sys/proc.h>
#include <sys/mbuf.h>
#include <machine/bus.h>
#include <dev/isa/isareg.h>
#include <dev/isa/isavar.h>
#include <uvm/uvm_extern.h>
extern paddr_t avail_end;
#define ISA_DMA_BOUNCE_THRESHOLD (16 * 1024 * 1024)
struct isadma_bounce_cookie {
int id_flags;
void *id_origbuf;
bus_size_t id_origbuflen;
int id_buftype;
void *id_bouncebuf;
bus_size_t id_bouncebuflen;
int id_nbouncesegs;
bus_dma_segment_t id_bouncesegs[1];
};
#define ID_MIGHT_NEED_BOUNCE 0x01
#define ID_HAS_BOUNCE 0x02
#define ID_IS_BOUNCING 0x04
#define ID_BUFTYPE_INVALID 0
#define ID_BUFTYPE_LINEAR 1
#define ID_BUFTYPE_MBUF 2
#define ID_BUFTYPE_UIO 3
#define ID_BUFTYPE_RAW 4
int isadma_bounce_alloc_bouncebuf(bus_dma_tag_t, bus_dmamap_t,
bus_size_t, int);
void isadma_bounce_free_bouncebuf(bus_dma_tag_t, bus_dmamap_t);
int
isadma_bounce_dmamap_create(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 isadma_bounce_cookie *cookie;
bus_dmamap_t map;
int error, cookieflags;
void *cookiestore;
size_t cookiesize;
error = _bus_dmamap_create(t, size, nsegments, maxsegsz, boundary,
flags, dmamp);
if (error)
return (error);
map = *dmamp;
map->_dm_cookie = NULL;
map->_dm_cookiesize = 0;
cookiesize = sizeof(*cookie);
cookieflags = 0;
if (avail_end > (t->_wbase + t->_wsize) ||
((map->_dm_size / PAGE_SIZE) + 1) > map->_dm_segcnt) {
cookieflags |= ID_MIGHT_NEED_BOUNCE;
cookiesize += (sizeof(bus_dma_segment_t) *
(map->_dm_segcnt - 1));
}
if ((cookiestore = malloc(cookiesize, M_DEVBUF, (flags & BUS_DMA_NOWAIT)
? (M_NOWAIT | M_ZERO) : (M_WAITOK | M_ZERO))) == NULL) {
error = ENOMEM;
goto out;
}
cookie = (struct isadma_bounce_cookie *)cookiestore;
cookie->id_flags = cookieflags;
map->_dm_cookie = cookie;
map->_dm_cookiesize = cookiesize;
if (cookieflags & ID_MIGHT_NEED_BOUNCE) {
if ((flags & BUS_DMA_ALLOCNOW) == 0)
goto out;
error = isadma_bounce_alloc_bouncebuf(t, map, size, flags);
}
out:
if (error) {
free(map->_dm_cookie, M_DEVBUF, cookiesize);
_bus_dmamap_destroy(t, map);
}
return (error);
}
void
isadma_bounce_dmamap_destroy(bus_dma_tag_t t, bus_dmamap_t map)
{
struct isadma_bounce_cookie *cookie = map->_dm_cookie;
if (cookie->id_flags & ID_HAS_BOUNCE)
isadma_bounce_free_bouncebuf(t, map);
free(cookie, M_DEVBUF, map->_dm_cookiesize);
_bus_dmamap_destroy(t, map);
}
int
isadma_bounce_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf,
size_t buflen, struct proc *p, int flags)
{
struct isadma_bounce_cookie *cookie = map->_dm_cookie;
int error;
map->dm_mapsize = 0;
map->dm_nsegs = 0;
error = _bus_dmamap_load_direct(t, map, buf, buflen, p, flags);
if (error == 0 ||
(error != 0 && (cookie->id_flags & ID_MIGHT_NEED_BOUNCE) == 0))
return (error);
if ((cookie->id_flags & ID_HAS_BOUNCE) == 0) {
error = isadma_bounce_alloc_bouncebuf(t, map, buflen, flags);
if (error)
return (error);
}
cookie->id_origbuf = buf;
cookie->id_origbuflen = buflen;
cookie->id_buftype = ID_BUFTYPE_LINEAR;
error = _bus_dmamap_load_direct(t, map, cookie->id_bouncebuf, buflen,
p, flags);
if (error) {
if ((map->_dm_flags & BUS_DMA_ALLOCNOW) == 0)
isadma_bounce_free_bouncebuf(t, map);
return (error);
}
cookie->id_flags |= ID_IS_BOUNCING;
map->_dm_window = t;
return (0);
}
int
isadma_bounce_dmamap_load_mbuf(bus_dma_tag_t t, bus_dmamap_t map,
struct mbuf *m0, int flags)
{
struct isadma_bounce_cookie *cookie = map->_dm_cookie;
int error;
map->dm_mapsize = 0;
map->dm_nsegs = 0;
#ifdef DIAGNOSTIC
if ((m0->m_flags & M_PKTHDR) == 0)
panic("isadma_bounce_dmamap_load_mbuf: no packet header");
#endif
if (m0->m_pkthdr.len > map->_dm_size)
return (EINVAL);
error = _bus_dmamap_load_mbuf_direct(t, map, m0, flags);
if (error == 0 ||
(error != 0 && (cookie->id_flags & ID_MIGHT_NEED_BOUNCE) == 0))
return (error);
if ((cookie->id_flags & ID_HAS_BOUNCE) == 0) {
error = isadma_bounce_alloc_bouncebuf(t, map, m0->m_pkthdr.len,
flags);
if (error)
return (error);
}
cookie->id_origbuf = m0;
cookie->id_origbuflen = m0->m_pkthdr.len;
cookie->id_buftype = ID_BUFTYPE_MBUF;
error = _bus_dmamap_load_direct(t, map, cookie->id_bouncebuf,
m0->m_pkthdr.len, NULL, flags);
if (error) {
if ((map->_dm_flags & BUS_DMA_ALLOCNOW) == 0)
isadma_bounce_free_bouncebuf(t, map);
return (error);
}
cookie->id_flags |= ID_IS_BOUNCING;
map->_dm_window = t;
return (0);
}
int
isadma_bounce_dmamap_load_uio(bus_dma_tag_t t, bus_dmamap_t map,
struct uio *uio, int flags)
{
panic("isadma_bounce_dmamap_load_uio: not implemented");
}
int
isadma_bounce_dmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map,
bus_dma_segment_t *segs, int nsegs, bus_size_t size, int flags)
{
panic("isadma_bounce_dmamap_load_raw: not implemented");
}
void
isadma_bounce_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map)
{
struct isadma_bounce_cookie *cookie = map->_dm_cookie;
if ((cookie->id_flags & ID_HAS_BOUNCE) &&
(map->_dm_flags & BUS_DMA_ALLOCNOW) == 0)
isadma_bounce_free_bouncebuf(t, map);
cookie->id_flags &= ~ID_IS_BOUNCING;
cookie->id_buftype = ID_BUFTYPE_INVALID;
_bus_dmamap_unload(t, map);
}
void
isadma_bounce_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
bus_size_t len, int ops)
{
struct isadma_bounce_cookie *cookie = map->_dm_cookie;
if ((ops & (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE)) != 0 &&
(ops & (BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE)) != 0)
panic("isadma_bounce_dmamap_sync: mix PRE and POST");
#ifdef DIAGNOSTIC
if ((ops & (BUS_DMASYNC_PREWRITE|BUS_DMASYNC_POSTREAD)) != 0) {
if (offset >= map->dm_mapsize)
panic("isadma_bounce_dmamap_sync: bad offset");
if (len == 0 || (offset + len) > map->dm_mapsize)
panic("isadma_bounce_dmamap_sync: bad length");
}
#endif
if ((cookie->id_flags & ID_IS_BOUNCING) == 0) {
alpha_mb();
return;
}
switch (cookie->id_buftype) {
case ID_BUFTYPE_LINEAR:
if (ops & BUS_DMASYNC_PREWRITE) {
memcpy((char *)cookie->id_bouncebuf + offset,
(char *)cookie->id_origbuf + offset, len);
}
if (ops & BUS_DMASYNC_POSTREAD) {
memcpy((char *)cookie->id_origbuf + offset,
(char *)cookie->id_bouncebuf + offset, len);
}
break;
case ID_BUFTYPE_MBUF:
{
struct mbuf *m, *m0 = cookie->id_origbuf;
bus_size_t minlen, moff;
if (ops & BUS_DMASYNC_PREWRITE) {
m_copydata(m0, offset, len,
(char *)cookie->id_bouncebuf + offset);
}
if (ops & BUS_DMASYNC_POSTREAD) {
for (moff = offset, m = m0; m != NULL && len != 0;
m = m->m_next) {
if (moff >= m->m_len) {
moff -= m->m_len;
continue;
}
minlen = len < m->m_len - moff ?
len : m->m_len - moff;
memcpy(mtod(m, caddr_t) + moff,
(char *)cookie->id_bouncebuf + offset,
minlen);
moff = 0;
len -= minlen;
offset += minlen;
}
}
break;
}
case ID_BUFTYPE_UIO:
panic("isadma_bounce_dmamap_sync: ID_BUFTYPE_UIO");
break;
case ID_BUFTYPE_RAW:
panic("isadma_bounce_dmamap_sync: ID_BUFTYPE_RAW");
break;
case ID_BUFTYPE_INVALID:
panic("isadma_bounce_dmamap_sync: ID_BUFTYPE_INVALID");
break;
default:
panic("isadma_bounce_dmamap_sync: unknown buffer type %d",
cookie->id_buftype);
}
alpha_mb();
}
int
isadma_bounce_dmamem_alloc(bus_dma_tag_t t, bus_size_t size,
bus_size_t alignment, bus_size_t boundary, bus_dma_segment_t *segs,
int nsegs, int *rsegs, int flags)
{
int error;
error = _bus_dmamem_alloc_range(t, size, alignment, boundary,
segs, nsegs, rsegs, flags, 0, ISA_DMA_BOUNCE_THRESHOLD);
if (!error)
return (error);
error = _bus_dmamem_alloc_range(t, size, alignment, boundary,
segs, nsegs, rsegs, flags, (paddr_t)0, (paddr_t)-1);
return (error);
}
int
isadma_bounce_alloc_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map,
bus_size_t size, int flags)
{
struct isadma_bounce_cookie *cookie = map->_dm_cookie;
int error = 0;
cookie->id_bouncebuflen = round_page(size);
error = _bus_dmamem_alloc_range(t, cookie->id_bouncebuflen,
PAGE_SIZE, map->_dm_boundary, cookie->id_bouncesegs,
map->_dm_segcnt, &cookie->id_nbouncesegs, flags,
0, ISA_DMA_BOUNCE_THRESHOLD);
if (error)
goto out;
error = _bus_dmamem_map(t, cookie->id_bouncesegs,
cookie->id_nbouncesegs, cookie->id_bouncebuflen,
(caddr_t *)&cookie->id_bouncebuf, flags);
out:
if (error) {
_bus_dmamem_free(t, cookie->id_bouncesegs,
cookie->id_nbouncesegs);
cookie->id_bouncebuflen = 0;
cookie->id_nbouncesegs = 0;
} else
cookie->id_flags |= ID_HAS_BOUNCE;
return (error);
}
void
isadma_bounce_free_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map)
{
struct isadma_bounce_cookie *cookie = map->_dm_cookie;
_bus_dmamem_unmap(t, cookie->id_bouncebuf,
cookie->id_bouncebuflen);
_bus_dmamem_free(t, cookie->id_bouncesegs,
cookie->id_nbouncesegs);
cookie->id_bouncebuflen = 0;
cookie->id_nbouncesegs = 0;
cookie->id_flags &= ~ID_HAS_BOUNCE;
}