root/sys/arch/arm/broadcom/bcm2835_dmac.c
/* $NetBSD: bcm2835_dmac.c,v 1.19 2021/01/29 14:11:14 skrll Exp $ */

/*-
 * Copyright (c) 2014 Jared D. McNeill <jmcneill@invisible.ca>
 * 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.
 */

#include "opt_ddb.h"

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: bcm2835_dmac.c,v 1.19 2021/01/29 14:11:14 skrll Exp $");

#include <sys/param.h>
#include <sys/bus.h>
#include <sys/device.h>
#include <sys/intr.h>
#include <sys/systm.h>
#include <sys/kmem.h>
#include <sys/mutex.h>

#include <arm/broadcom/bcm2835reg.h>
#include <arm/broadcom/bcm2835_intr.h>

#include <arm/broadcom/bcm2835_dmac.h>

#include <dev/fdt/fdtvar.h>

#include <arm/fdt/arm_fdtvar.h>

#define BCM_DMAC_CHANNELMASK    0x00000fff

struct bcm_dmac_softc;

struct bcm_dmac_channel {
        struct bcm_dmac_softc *ch_sc;
        void *ch_ih;
        uint8_t ch_index;
        void (*ch_callback)(uint32_t, uint32_t, void *);
        void *ch_callbackarg;
        uint32_t ch_debug;
};

#define DMAC_CHANNEL_TYPE(ch) \
    (((ch)->ch_debug & DMAC_DEBUG_LITE) ? \
     BCM_DMAC_TYPE_LITE : BCM_DMAC_TYPE_NORMAL)
#define DMAC_CHANNEL_USED(ch) \
    ((ch)->ch_callback != NULL)

struct bcm_dmac_softc {
        device_t sc_dev;
        bus_space_tag_t sc_iot;
        bus_space_handle_t sc_ioh;
        int sc_phandle;

        kmutex_t sc_lock;
        struct bcm_dmac_channel *sc_channels;
        int sc_nchannels;
        uint32_t sc_channelmask;
};

#define DMAC_READ(sc, reg)              \
    bus_space_read_4((sc)->sc_iot, (sc)->sc_ioh, (reg))
#define DMAC_WRITE(sc, reg, val)                \
    bus_space_write_4((sc)->sc_iot, (sc)->sc_ioh, (reg), (val))

static int      bcm_dmac_match(device_t, cfdata_t, void *);
static void     bcm_dmac_attach(device_t, device_t, void *);

static int      bcm_dmac_intr(void *);

#if defined(DDB)
void            bcm_dmac_dump_regs(void);
#endif

CFATTACH_DECL_NEW(bcmdmac_fdt, sizeof(struct bcm_dmac_softc),
        bcm_dmac_match, bcm_dmac_attach, NULL, NULL);

static const struct device_compatible_entry compat_data[] = {
        { .compat = "brcm,bcm2835-dma" },
        DEVICE_COMPAT_EOL
};

static int
bcm_dmac_match(device_t parent, cfdata_t cf, void *aux)
{
        struct fdt_attach_args * const faa = aux;

        return of_compatible_match(faa->faa_phandle, compat_data);
}

static void
bcm_dmac_attach(device_t parent, device_t self, void *aux)
{
        struct bcm_dmac_softc *sc = device_private(self);
        const prop_dictionary_t cfg = device_properties(self);
        struct fdt_attach_args * const faa = aux;
        struct bcm_dmac_channel *ch;
        uint32_t val;
        int index;

        const int phandle = faa->faa_phandle;

        sc->sc_dev = self;
        sc->sc_iot = faa->faa_bst;
        sc->sc_phandle = phandle;

        bus_addr_t addr;
        bus_size_t size;

        if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
                aprint_error(": missing 'reg' property\n");
                return;
        }

        if (bus_space_map(sc->sc_iot, addr, size, 0, &sc->sc_ioh)) {
                aprint_error(": unable to map device\n");
                return;
        }

        prop_dictionary_get_uint32(cfg, "chanmask", &sc->sc_channelmask);
        sc->sc_channelmask &= BCM_DMAC_CHANNELMASK;

        mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SCHED);

        sc->sc_nchannels = 32 - __builtin_clz(sc->sc_channelmask);
        sc->sc_channels = kmem_alloc(
            sizeof(*sc->sc_channels) * sc->sc_nchannels, KM_SLEEP);

        aprint_normal(":");
        for (index = 0; index < sc->sc_nchannels; index++) {
                ch = &sc->sc_channels[index];
                ch->ch_sc = sc;
                ch->ch_index = index;
                ch->ch_callback = NULL;
                ch->ch_callbackarg = NULL;
                ch->ch_ih = NULL;
                if ((__BIT(index) & sc->sc_channelmask) == 0)
                        continue;

                aprint_normal(" DMA%d", index);

                ch->ch_debug = DMAC_READ(sc, DMAC_DEBUG(index));

                val = DMAC_READ(sc, DMAC_CS(index));
                val |= DMAC_CS_RESET;
                DMAC_WRITE(sc, DMAC_CS(index), val);
        }
        aprint_normal("\n");
        aprint_naive("\n");
}

static int
bcm_dmac_intr(void *priv)
{
        struct bcm_dmac_channel *ch = priv;
        struct bcm_dmac_softc *sc = ch->ch_sc;
        uint32_t cs, ce;

        cs = DMAC_READ(sc, DMAC_CS(ch->ch_index));
        DMAC_WRITE(sc, DMAC_CS(ch->ch_index), cs);
        cs &= DMAC_CS_INT | DMAC_CS_END | DMAC_CS_ERROR;

        ce = DMAC_READ(sc, DMAC_DEBUG(ch->ch_index));
        ce &= DMAC_DEBUG_READ_ERROR | DMAC_DEBUG_FIFO_ERROR
            | DMAC_DEBUG_READ_LAST_NOT_SET_ERROR;
        DMAC_WRITE(sc, DMAC_DEBUG(ch->ch_index), ce);

        if (ch->ch_callback)
                ch->ch_callback(cs, ce, ch->ch_callbackarg);

        return 1;
}

struct bcm_dmac_channel *
bcm_dmac_alloc(enum bcm_dmac_type type, int ipl,
    void (*cb)(uint32_t, uint32_t, void *), void *cbarg)
{
        struct bcm_dmac_softc *sc;
        struct bcm_dmac_channel *ch = NULL;
        device_t dev;
        int index;

        dev = device_find_by_driver_unit("bcmdmac", 0);
        if (dev == NULL)
                return NULL;
        sc = device_private(dev);

        mutex_enter(&sc->sc_lock);
        for (index = 0; index < sc->sc_nchannels; index++) {
                if ((sc->sc_channelmask & __BIT(index)) == 0)
                        continue;
                if (DMAC_CHANNEL_TYPE(&sc->sc_channels[index]) != type)
                        continue;
                if (DMAC_CHANNEL_USED(&sc->sc_channels[index]))
                        continue;

                ch = &sc->sc_channels[index];
                ch->ch_callback = cb;
                ch->ch_callbackarg = cbarg;
                break;
        }
        mutex_exit(&sc->sc_lock);

        if (ch == NULL)
                return NULL;

        KASSERT(ch->ch_ih == NULL);

        const int phandle = sc->sc_phandle;
        char intrstr[128];

        if (!fdtbus_intr_str(phandle, ch->ch_index, intrstr, sizeof(intrstr))) {
                aprint_error(": failed to decode interrupt\n");
                return NULL;
        }

        char xname[16];
        snprintf(xname, sizeof(xname), "%s #%u", device_xname(sc->sc_dev),
            ch->ch_index);
        ch->ch_ih = fdtbus_intr_establish_xname(phandle, ch->ch_index, ipl, 0,
            bcm_dmac_intr, ch, xname);
        if (ch->ch_ih == NULL) {
                aprint_error_dev(sc->sc_dev,
                    "failed to establish interrupt for DMA%d and %s\n", ch->ch_index,
                    intrstr);
                ch->ch_callback = NULL;
                ch->ch_callbackarg = NULL;
                ch = NULL;
        }

        return ch;
}

void
bcm_dmac_free(struct bcm_dmac_channel *ch)
{
        struct bcm_dmac_softc *sc = ch->ch_sc;
        uint32_t val;

        bcm_dmac_halt(ch);

        /* reset chip */
        val = DMAC_READ(sc, DMAC_CS(ch->ch_index));
        val |= DMAC_CS_RESET;
        val &= ~DMAC_CS_ACTIVE;
        DMAC_WRITE(sc, DMAC_CS(ch->ch_index), val);

        mutex_enter(&sc->sc_lock);
        fdtbus_intr_disestablish(sc->sc_phandle, ch->ch_ih);
        ch->ch_ih = NULL;
        ch->ch_callback = NULL;
        ch->ch_callbackarg = NULL;
        mutex_exit(&sc->sc_lock);
}

void
bcm_dmac_set_conblk_addr(struct bcm_dmac_channel *ch, bus_addr_t addr)
{
        struct bcm_dmac_softc *sc = ch->ch_sc;

        DMAC_WRITE(sc, DMAC_CONBLK_AD(ch->ch_index), addr);
}

int
bcm_dmac_transfer(struct bcm_dmac_channel *ch)
{
        struct bcm_dmac_softc *sc = ch->ch_sc;
        uint32_t val;

        val = DMAC_READ(sc, DMAC_CS(ch->ch_index));
        if (val & DMAC_CS_ACTIVE)
                return EBUSY;

        val |= DMAC_CS_ACTIVE;
        DMAC_WRITE(sc, DMAC_CS(ch->ch_index), val);

        return 0;
}

void
bcm_dmac_halt(struct bcm_dmac_channel *ch)
{
        struct bcm_dmac_softc *sc = ch->ch_sc;
        uint32_t val;

        /* pause DMA */
        val = DMAC_READ(sc, DMAC_CS(ch->ch_index));
        val &= ~DMAC_CS_ACTIVE;
        DMAC_WRITE(sc, DMAC_CS(ch->ch_index), val);

        /* wait for paused state ? */

        /* end descriptor chain */
        DMAC_WRITE(sc, DMAC_NEXTCONBK(ch->ch_index), 0);

        /* resume DMA that then stops */
        val |= DMAC_CS_ACTIVE | DMAC_CS_ABORT;
        DMAC_WRITE(sc, DMAC_CS(ch->ch_index), val);
}

#if defined(DDB)
void
bcm_dmac_dump_regs(void)
{
        struct bcm_dmac_softc *sc;
        device_t dev;
        int index;

        dev = device_find_by_driver_unit("bcmdmac", 0);
        if (dev == NULL)
                return;
        sc = device_private(dev);

        for (index = 0; index < sc->sc_nchannels; index++) {
                if ((sc->sc_channelmask & __BIT(index)) == 0)
                        continue;
                printf("%d_CS:        %08X\n", index,
                    DMAC_READ(sc, DMAC_CS(index)));
                printf("%d_CONBLK_AD: %08X\n", index,
                    DMAC_READ(sc, DMAC_CONBLK_AD(index)));
                printf("%d_DEBUG:     %08X\n", index,
                    DMAC_READ(sc, DMAC_DEBUG(index)));
        }
}
#endif