149d70c667
solving a possible panic when snd_ai2s is loaded at boot time. Also change the device setup to indicate to the pcm layer that the device is MPSAFE. Submitted by: Marco Trillo Suggestions by: Ariff Abdullah
385 lines
8.8 KiB
C
385 lines
8.8 KiB
C
/*-
|
|
* Copyright 2008 by Marco Trillo. All rights reserved.
|
|
*
|
|
* 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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.
|
|
*
|
|
* $FreeBSD$
|
|
*/
|
|
|
|
/*
|
|
* Apple Onboard Audio (AOA).
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/lock.h>
|
|
#include <sys/mutex.h>
|
|
#include <machine/dbdma.h>
|
|
#include <machine/resource.h>
|
|
#include <machine/bus.h>
|
|
#include <sys/rman.h>
|
|
#include <dev/ofw/ofw_bus.h>
|
|
#include <dev/sound/pcm/sound.h>
|
|
#include <dev/sound/macio/aoa.h>
|
|
#include "mixer_if.h"
|
|
|
|
struct aoa_dma {
|
|
struct mtx mutex;
|
|
struct resource *reg; /* DBDMA registers */
|
|
dbdma_channel_t *channel; /* DBDMA channel */
|
|
bus_dma_tag_t tag; /* bus_dma tag */
|
|
struct pcm_channel *pcm; /* PCM channel */
|
|
struct snd_dbuf *buf; /* PCM buffer */
|
|
u_int slots; /* # of slots */
|
|
u_int slot; /* current slot */
|
|
u_int bufsz; /* buffer size */
|
|
u_int blksz; /* block size */
|
|
int running;
|
|
};
|
|
|
|
static void
|
|
aoa_dma_set_program(struct aoa_dma *dma)
|
|
{
|
|
u_int32_t addr;
|
|
int i;
|
|
|
|
addr = (u_int32_t) sndbuf_getbufaddr(dma->buf);
|
|
KASSERT(dma->bufsz == sndbuf_getsize(dma->buf), ("bad size"));
|
|
|
|
dma->slots = dma->bufsz / dma->blksz;
|
|
|
|
for (i = 0; i < dma->slots; ++i) {
|
|
dbdma_insert_command(dma->channel,
|
|
i, /* slot */
|
|
DBDMA_OUTPUT_MORE, /* command */
|
|
0, /* stream */
|
|
addr, /* data */
|
|
dma->blksz, /* count */
|
|
DBDMA_ALWAYS, /* interrupt */
|
|
DBDMA_COND_TRUE, /* branch */
|
|
DBDMA_NEVER, /* wait */
|
|
dma->slots + 1 /* branch_slot */
|
|
);
|
|
|
|
addr += dma->blksz;
|
|
}
|
|
|
|
/* Branch back to beginning. */
|
|
dbdma_insert_branch(dma->channel, dma->slots, 0);
|
|
|
|
/* STOP command to branch when S0 is asserted. */
|
|
dbdma_insert_stop(dma->channel, dma->slots + 1);
|
|
|
|
/* Set S0 as the condition to branch to STOP. */
|
|
dbdma_set_branch_selector(dma->channel, 1 << 0, 1 << 0);
|
|
dbdma_set_device_status(dma->channel, 1 << 0, 0);
|
|
|
|
dbdma_sync_commands(dma->channel, BUS_DMASYNC_PREWRITE);
|
|
}
|
|
|
|
#define AOA_BUFFER_SIZE 65536
|
|
|
|
static struct aoa_dma *
|
|
aoa_dma_create(struct aoa_softc *sc)
|
|
{
|
|
struct aoa_dma *dma;
|
|
bus_dma_tag_t tag;
|
|
int err;
|
|
device_t self;
|
|
|
|
self = sc->sc_dev;
|
|
err = bus_dma_tag_create(bus_get_dma_tag(self),
|
|
4, 0, BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR, NULL, NULL,
|
|
AOA_BUFFER_SIZE, 1, AOA_BUFFER_SIZE, 0, NULL, NULL, &tag);
|
|
if (err != 0)
|
|
return (NULL);
|
|
|
|
dma = malloc(sizeof(*dma), M_DEVBUF, M_WAITOK | M_ZERO);
|
|
dma->tag = tag;
|
|
dma->bufsz = AOA_BUFFER_SIZE;
|
|
dma->blksz = PAGE_SIZE; /* initial blocksize */
|
|
|
|
mtx_init(&dma->mutex, "AOA", NULL, MTX_DEF);
|
|
|
|
sc->sc_intrp = dma;
|
|
|
|
return (dma);
|
|
}
|
|
|
|
static void
|
|
aoa_dma_delete(struct aoa_dma *dma)
|
|
{
|
|
bus_dma_tag_destroy(dma->tag);
|
|
mtx_destroy(&dma->mutex);
|
|
free(dma, M_DEVBUF);
|
|
}
|
|
|
|
static int
|
|
aoa_chan_setblocksize(kobj_t obj, void *data, u_int32_t blocksz)
|
|
{
|
|
struct aoa_dma *dma = data;
|
|
int err, lz;
|
|
|
|
DPRINTF(("aoa_chan_setblocksize: blocksz = %u, dma->blksz = %u\n",
|
|
blocksz, dma->blksz));
|
|
KASSERT(!dma->running, ("dma is running"));
|
|
KASSERT(blocksz > 0, ("bad blocksz"));
|
|
|
|
/* Round blocksz down to a power of two... */
|
|
__asm volatile ("cntlzw %0,%1" : "=r"(lz) : "r"(blocksz));
|
|
blocksz = 1 << (31 - lz);
|
|
DPRINTF(("blocksz = %u\n", blocksz));
|
|
|
|
/* ...but no more than the buffer. */
|
|
if (blocksz > dma->bufsz)
|
|
blocksz = dma->bufsz;
|
|
|
|
err = sndbuf_resize(dma->buf, dma->bufsz / blocksz, blocksz);
|
|
if (err != 0) {
|
|
DPRINTF(("sndbuf_resize returned %d\n", err));
|
|
return (0);
|
|
}
|
|
|
|
if (blocksz == dma->blksz)
|
|
return (dma->blksz);
|
|
|
|
/* One slot per block plus branch to 0 plus STOP. */
|
|
err = dbdma_resize_channel(dma->channel, 2 + dma->bufsz / blocksz);
|
|
if (err != 0) {
|
|
DPRINTF(("dbdma_resize_channel returned %d\n", err));
|
|
return (0);
|
|
}
|
|
|
|
/* Set the new blocksize. */
|
|
dma->blksz = blocksz;
|
|
aoa_dma_set_program(dma);
|
|
|
|
return (dma->blksz);
|
|
}
|
|
|
|
static int
|
|
aoa_chan_setformat(kobj_t obj, void *data, u_int32_t format)
|
|
{
|
|
DPRINTF(("aoa_chan_setformat: format = %u\n", format));
|
|
|
|
if (format != (AFMT_STEREO | AFMT_S16_BE))
|
|
return (EINVAL);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
aoa_chan_setspeed(kobj_t obj, void *data, u_int32_t speed)
|
|
{
|
|
DPRINTF(("aoa_chan_setspeed: speed = %u\n", speed));
|
|
|
|
return (44100);
|
|
}
|
|
|
|
static int
|
|
aoa_chan_getptr(kobj_t obj, void *data)
|
|
{
|
|
struct aoa_dma *dma = data;
|
|
|
|
if (!dma->running)
|
|
return (0);
|
|
|
|
return (dma->slot * dma->blksz);
|
|
}
|
|
|
|
static void *
|
|
aoa_chan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b,
|
|
struct pcm_channel *c, int dir)
|
|
{
|
|
struct aoa_softc *sc = devinfo;
|
|
struct aoa_dma *dma;
|
|
int max_slots, err;
|
|
|
|
KASSERT(dir == PCMDIR_PLAY, ("bad dir"));
|
|
|
|
dma = aoa_dma_create(sc);
|
|
if (!dma)
|
|
return (NULL);
|
|
dma->pcm = c;
|
|
dma->buf = b;
|
|
dma->reg = sc->sc_odma;
|
|
|
|
/* One slot per block, plus branch to 0 plus STOP. */
|
|
max_slots = 2 + dma->bufsz / dma->blksz;
|
|
err = dbdma_allocate_channel(dma->reg, 0, bus_get_dma_tag(sc->sc_dev),
|
|
max_slots, &dma->channel );
|
|
if (err != 0) {
|
|
aoa_dma_delete(dma);
|
|
return (NULL);
|
|
}
|
|
|
|
if (sndbuf_alloc(dma->buf, dma->tag, 0, dma->bufsz) != 0) {
|
|
dbdma_free_channel(dma->channel);
|
|
aoa_dma_delete(dma);
|
|
return (NULL);
|
|
}
|
|
|
|
aoa_dma_set_program(dma);
|
|
|
|
return (dma);
|
|
}
|
|
|
|
static int
|
|
aoa_chan_trigger(kobj_t obj, void *data, int go)
|
|
{
|
|
struct aoa_dma *dma = data;
|
|
int i;
|
|
|
|
switch (go) {
|
|
case PCMTRIG_START:
|
|
|
|
/* Start the DMA. */
|
|
dma->running = 1;
|
|
|
|
dma->slot = 0;
|
|
dbdma_set_current_cmd(dma->channel, dma->slot);
|
|
|
|
dbdma_run(dma->channel);
|
|
|
|
return (0);
|
|
|
|
case PCMTRIG_STOP:
|
|
case PCMTRIG_ABORT:
|
|
|
|
mtx_lock(&dma->mutex);
|
|
|
|
dma->running = 0;
|
|
|
|
/* Make it branch to the STOP command. */
|
|
dbdma_set_device_status(dma->channel, 1 << 0, 1 << 0);
|
|
|
|
/* XXX should wait for DBDMA_ACTIVE to clear. */
|
|
DELAY(40000);
|
|
|
|
/* Reset the DMA. */
|
|
dbdma_stop(dma->channel);
|
|
dbdma_set_device_status(dma->channel, 1 << 0, 0);
|
|
|
|
for (i = 0; i < dma->slots; ++i)
|
|
dbdma_clear_cmd_status(dma->channel, i);
|
|
|
|
mtx_unlock(&dma->mutex);
|
|
|
|
return (0);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
aoa_chan_free(kobj_t obj, void *data)
|
|
{
|
|
struct aoa_dma *dma = data;
|
|
|
|
sndbuf_free(dma->buf);
|
|
dbdma_free_channel(dma->channel);
|
|
aoa_dma_delete(dma);
|
|
|
|
return (0);
|
|
}
|
|
|
|
void
|
|
aoa_interrupt(void *xsc)
|
|
{
|
|
struct aoa_softc *sc = xsc;
|
|
struct aoa_dma *dma;
|
|
|
|
if (!(dma = sc->sc_intrp) || !dma->running)
|
|
return;
|
|
|
|
mtx_lock(&dma->mutex);
|
|
|
|
while (dbdma_get_cmd_status(dma->channel, dma->slot)) {
|
|
|
|
dbdma_clear_cmd_status(dma->channel, dma->slot);
|
|
dma->slot = (dma->slot + 1) % dma->slots;
|
|
|
|
mtx_unlock(&dma->mutex);
|
|
chn_intr(dma->pcm);
|
|
mtx_lock(&dma->mutex);
|
|
}
|
|
|
|
mtx_unlock(&dma->mutex);
|
|
}
|
|
|
|
static u_int32_t sc_fmt[] = {
|
|
AFMT_S16_BE | AFMT_STEREO,
|
|
0
|
|
};
|
|
static struct pcmchan_caps aoa_caps = {44100, 44100, sc_fmt, 0};
|
|
|
|
static struct pcmchan_caps *
|
|
aoa_chan_getcaps(kobj_t obj, void *data)
|
|
{
|
|
return (&aoa_caps);
|
|
}
|
|
|
|
static kobj_method_t aoa_chan_methods[] = {
|
|
KOBJMETHOD(channel_init, aoa_chan_init),
|
|
KOBJMETHOD(channel_free, aoa_chan_free),
|
|
KOBJMETHOD(channel_setformat, aoa_chan_setformat),
|
|
KOBJMETHOD(channel_setspeed, aoa_chan_setspeed),
|
|
KOBJMETHOD(channel_setblocksize,aoa_chan_setblocksize),
|
|
KOBJMETHOD(channel_trigger, aoa_chan_trigger),
|
|
KOBJMETHOD(channel_getptr, aoa_chan_getptr),
|
|
KOBJMETHOD(channel_getcaps, aoa_chan_getcaps),
|
|
{ 0, 0 }
|
|
};
|
|
CHANNEL_DECLARE(aoa_chan);
|
|
|
|
int
|
|
aoa_attach(void *xsc)
|
|
{
|
|
char status[SND_STATUSLEN];
|
|
struct aoa_softc *sc;
|
|
device_t self;
|
|
int err;
|
|
|
|
sc = xsc;
|
|
self = sc->sc_dev;
|
|
|
|
if (pcm_register(self, sc, 1, 0))
|
|
return (ENXIO);
|
|
|
|
err = pcm_getbuffersize(self, AOA_BUFFER_SIZE, AOA_BUFFER_SIZE,
|
|
AOA_BUFFER_SIZE);
|
|
DPRINTF(("pcm_getbuffersize returned %d\n", err));
|
|
|
|
pcm_addchan(self, PCMDIR_PLAY, &aoa_chan_class, sc);
|
|
|
|
snprintf(status, sizeof(status), "at %s", ofw_bus_get_name(self));
|
|
pcm_setstatus(self, status);
|
|
|
|
return (0);
|
|
}
|
|
|