aoa.c

Go to the documentation of this file.

/*-
 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
 *
 * 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>
 
#ifdef HAVE_KERNEL_OPTION_HEADERS
#include "opt_snd.h"
#endif
 
#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 u_int32_t
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 != SND_FORMAT(AFMT_S16_BE, 2, 0))
                return (EINVAL);
 
        return (0);
}
 
static u_int32_t
aoa_chan_setspeed(kobj_t obj, void *data, u_int32_t speed)
{
        DPRINTF(("aoa_chan_setspeed: speed = %u\n", speed));
 
        return (44100);
}
 
static u_int32_t
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[] = {
        SND_FORMAT(AFMT_S16_BE, 2, 0),
        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),
        KOBJMETHOD_END
};
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);
}