#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: isadma_bounce.c,v 1.17 2022/01/22 15:10:30 skrll Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/syslog.h>
#include <sys/device.h>
#include <sys/kmem.h>
#include <sys/proc.h>
#include <sys/mbuf.h>
#define _ALPHA_BUS_DMA_PRIVATE
#include <sys/bus.h>
#include <dev/isa/isareg.h>
#include <dev/isa/isavar.h>
extern paddr_t avail_end;
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
static int isadma_bounce_alloc_bouncebuf(bus_dma_tag_t, bus_dmamap_t,
bus_size_t, int);
static void isadma_bounce_free_bouncebuf(bus_dma_tag_t, bus_dmamap_t);
static bool
isadma_bounce_check_range(bus_dma_tag_t const t)
{
return avail_end > (t->_wbase + t->_wsize);
}
static int
isadma_bounce_cookieflags(bus_dma_tag_t const t, bus_dmamap_t const map)
{
int cookieflags = 0;
if (isadma_bounce_check_range(t) ||
((map->_dm_size / PAGE_SIZE) + 1) > map->_dm_segcnt) {
cookieflags |= ID_MIGHT_NEED_BOUNCE;
}
return cookieflags;
}
static size_t
isadma_bounce_cookiesize(bus_dmamap_t const map, int cookieflags)
{
size_t cookiesize = sizeof(struct isadma_bounce_cookie);
if (cookieflags & ID_MIGHT_NEED_BOUNCE) {
cookiesize += (sizeof(bus_dma_segment_t) *
(map->_dm_segcnt - 1));
}
return cookiesize;
}
static int
isadma_bounce_cookie_alloc(bus_dma_tag_t const t, bus_dmamap_t const map,
int const flags)
{
struct isadma_bounce_cookie *cookie;
int cookieflags = isadma_bounce_cookieflags(t, map);
if ((cookie = kmem_zalloc(isadma_bounce_cookiesize(map, cookieflags),
(flags & BUS_DMA_NOWAIT) ? KM_NOSLEEP : KM_SLEEP)) == NULL) {
return ENOMEM;
}
cookie->id_flags = cookieflags;
map->_dm_cookie = cookie;
return 0;
}
static void
isadma_bounce_cookie_free(bus_dmamap_t const map)
{
struct isadma_bounce_cookie *cookie = map->_dm_cookie;
if (cookie != NULL) {
kmem_free(map->_dm_cookie,
isadma_bounce_cookiesize(map, cookie->id_flags));
map->_dm_cookie = NULL;
}
}
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;
error = _bus_dmamap_create(t, size, nsegments, maxsegsz, boundary,
flags, dmamp);
if (error)
return (error);
map = *dmamp;
map->_dm_cookie = NULL;
if ((error = isadma_bounce_cookie_alloc(t, map, flags)) != 0) {
goto out;
}
cookie = map->_dm_cookie;
if (cookie->id_flags & ID_MIGHT_NEED_BOUNCE) {
if (flags & BUS_DMA_ALLOCNOW) {
error = isadma_bounce_alloc_bouncebuf(t, map, size,
flags);
}
}
out:
if (error) {
isadma_bounce_cookie_free(map);
_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);
isadma_bounce_cookie_free(map);
_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 || (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 || (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, char *) + 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:
printf("unknown buffer type %d\n", cookie->id_buftype);
panic("isadma_bounce_dmamap_sync");
}
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)
{
paddr_t high;
if (avail_end > ISA_DMA_BOUNCE_THRESHOLD)
high = ISA_DMA_BOUNCE_THRESHOLD - 1;
else
high = avail_end - 1;
return (_bus_dmamem_alloc_range(t, size, alignment, boundary,
segs, nsegs, rsegs, flags, 0, high));
}
static 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 = isadma_bounce_dmamem_alloc(t, cookie->id_bouncebuflen,
PAGE_SIZE, map->_dm_boundary, cookie->id_bouncesegs,
map->_dm_segcnt, &cookie->id_nbouncesegs, flags);
if (error)
goto out;
error = _bus_dmamem_map(t, cookie->id_bouncesegs,
cookie->id_nbouncesegs, cookie->id_bouncebuflen,
(void **)&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);
}
static 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;
}