Home | History | Annotate | Line # | Download | only in dev
bwai.c revision 1.1
      1  1.1  jmcneill /* $NetBSD: bwai.c,v 1.1 2024/01/22 21:28:15 jmcneill Exp $ */
      2  1.1  jmcneill 
      3  1.1  jmcneill /*-
      4  1.1  jmcneill  * Copyright (c) 2024 Jared McNeill <jmcneill (at) invisible.ca>
      5  1.1  jmcneill  * All rights reserved.
      6  1.1  jmcneill  *
      7  1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8  1.1  jmcneill  * modification, are permitted provided that the following conditions
      9  1.1  jmcneill  * are met:
     10  1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12  1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15  1.1  jmcneill  *
     16  1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  1.1  jmcneill  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  1.1  jmcneill  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  1.1  jmcneill  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  1.1  jmcneill  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21  1.1  jmcneill  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22  1.1  jmcneill  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23  1.1  jmcneill  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24  1.1  jmcneill  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  1.1  jmcneill  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  1.1  jmcneill  * SUCH DAMAGE.
     27  1.1  jmcneill  */
     28  1.1  jmcneill 
     29  1.1  jmcneill #include <sys/cdefs.h>
     30  1.1  jmcneill __KERNEL_RCSID(0, "$NetBSD: bwai.c,v 1.1 2024/01/22 21:28:15 jmcneill Exp $");
     31  1.1  jmcneill 
     32  1.1  jmcneill #include <sys/param.h>
     33  1.1  jmcneill #include <sys/bus.h>
     34  1.1  jmcneill #include <sys/cpu.h>
     35  1.1  jmcneill #include <sys/device.h>
     36  1.1  jmcneill #include <sys/kmem.h>
     37  1.1  jmcneill #include <sys/mutex.h>
     38  1.1  jmcneill #include <sys/bitops.h>
     39  1.1  jmcneill 
     40  1.1  jmcneill #include <dev/audio/audio_dai.h>
     41  1.1  jmcneill 
     42  1.1  jmcneill #include <machine/wii.h>
     43  1.1  jmcneill 
     44  1.1  jmcneill #include "mainbus.h"
     45  1.1  jmcneill #include "bwai.h"
     46  1.1  jmcneill 
     47  1.1  jmcneill #define	AI_CONTROL		0x00
     48  1.1  jmcneill #define	 AI_CONTROL_RATE	__BIT(6)
     49  1.1  jmcneill #define	 AI_CONTROL_SCRESET	__BIT(5)
     50  1.1  jmcneill #define	 AI_CONTROL_AIINTVLD	__BIT(4)
     51  1.1  jmcneill #define	 AI_CONTROL_AIINT	__BIT(3)
     52  1.1  jmcneill #define	 AI_CONTROL_AIINTMSK	__BIT(2)
     53  1.1  jmcneill #define	 AI_CONTROL_AFR		__BIT(1)
     54  1.1  jmcneill #define	 AI_CONTROL_PSTAT	__BIT(0)
     55  1.1  jmcneill #define AI_AIIT			0x0c
     56  1.1  jmcneill 
     57  1.1  jmcneill struct bwai_softc {
     58  1.1  jmcneill 	device_t		sc_dev;
     59  1.1  jmcneill 	bus_space_tag_t		sc_bst;
     60  1.1  jmcneill 	bus_space_handle_t	sc_bsh;
     61  1.1  jmcneill 	int			sc_irq;
     62  1.1  jmcneill 
     63  1.1  jmcneill 	struct audio_dai_device	sc_dai;
     64  1.1  jmcneill 
     65  1.1  jmcneill 	uint8_t			sc_swvol;
     66  1.1  jmcneill 	void			(*sc_intr)(void *);
     67  1.1  jmcneill 	void			*sc_intrarg;
     68  1.1  jmcneill 
     69  1.1  jmcneill 	kmutex_t		*sc_intr_lock;
     70  1.1  jmcneill };
     71  1.1  jmcneill 
     72  1.1  jmcneill enum bwai_mixer_ctrl {
     73  1.1  jmcneill 	BWAI_OUTPUT_CLASS,
     74  1.1  jmcneill 	BWAI_INPUT_CLASS,
     75  1.1  jmcneill 
     76  1.1  jmcneill 	BWAI_OUTPUT_MASTER_VOLUME,
     77  1.1  jmcneill 	BWAI_INPUT_DAC_VOLUME,
     78  1.1  jmcneill 
     79  1.1  jmcneill 	BWAI_MIXER_CTRL_LAST
     80  1.1  jmcneill };
     81  1.1  jmcneill 
     82  1.1  jmcneill #define	RD4(sc, reg)			\
     83  1.1  jmcneill 	bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
     84  1.1  jmcneill #define	WR4(sc, reg, val)		\
     85  1.1  jmcneill 	bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
     86  1.1  jmcneill 
     87  1.1  jmcneill static int
     88  1.1  jmcneill bwai_intr(void *priv)
     89  1.1  jmcneill {
     90  1.1  jmcneill 	struct bwai_softc * const sc = priv;
     91  1.1  jmcneill 	uint32_t val;
     92  1.1  jmcneill 
     93  1.1  jmcneill 	val = RD4(sc, AI_CONTROL);
     94  1.1  jmcneill 	if ((val & AI_CONTROL_AIINT) != 0) {
     95  1.1  jmcneill 		WR4(sc, AI_CONTROL, val | AI_CONTROL_SCRESET);
     96  1.1  jmcneill 
     97  1.1  jmcneill 		mutex_enter(sc->sc_intr_lock);
     98  1.1  jmcneill 		if (sc->sc_intr) {
     99  1.1  jmcneill 			sc->sc_intr(sc->sc_intrarg);
    100  1.1  jmcneill 		}
    101  1.1  jmcneill 		mutex_exit(sc->sc_intr_lock);
    102  1.1  jmcneill 	}
    103  1.1  jmcneill 
    104  1.1  jmcneill 	return 1;
    105  1.1  jmcneill }
    106  1.1  jmcneill 
    107  1.1  jmcneill audio_dai_tag_t
    108  1.1  jmcneill bwai_dsp_init(kmutex_t *intr_lock)
    109  1.1  jmcneill {
    110  1.1  jmcneill 	struct bwai_softc *sc;
    111  1.1  jmcneill 	device_t dev;
    112  1.1  jmcneill 
    113  1.1  jmcneill 	dev = device_find_by_driver_unit("bwai", 0);
    114  1.1  jmcneill 	if (dev == NULL) {
    115  1.1  jmcneill 		return NULL;
    116  1.1  jmcneill 	}
    117  1.1  jmcneill 	sc = device_private(dev);
    118  1.1  jmcneill 
    119  1.1  jmcneill 	sc->sc_intr_lock = intr_lock;
    120  1.1  jmcneill 
    121  1.1  jmcneill 	intr_establish(sc->sc_irq, IST_LEVEL, IPL_AUDIO, bwai_intr, sc);
    122  1.1  jmcneill 
    123  1.1  jmcneill 	return &sc->sc_dai;
    124  1.1  jmcneill }
    125  1.1  jmcneill 
    126  1.1  jmcneill static void
    127  1.1  jmcneill bwai_swvol_codec(audio_filter_arg_t *arg)
    128  1.1  jmcneill {
    129  1.1  jmcneill 	struct bwai_softc * const sc = arg->context;
    130  1.1  jmcneill 	const aint_t *src;
    131  1.1  jmcneill 	int16_t *dst;
    132  1.1  jmcneill 	u_int sample_count;
    133  1.1  jmcneill 	u_int i;
    134  1.1  jmcneill 
    135  1.1  jmcneill 	src = arg->src;
    136  1.1  jmcneill 	dst = arg->dst;
    137  1.1  jmcneill 	sample_count = arg->count * arg->srcfmt->channels;
    138  1.1  jmcneill 	for (i = 0; i < sample_count; i++) {
    139  1.1  jmcneill 		aint2_t v = (aint2_t)(*src++);
    140  1.1  jmcneill 		v = v * sc->sc_swvol / 255;
    141  1.1  jmcneill 		*dst++ = (aint_t)v;
    142  1.1  jmcneill 	}
    143  1.1  jmcneill }
    144  1.1  jmcneill 
    145  1.1  jmcneill static int
    146  1.1  jmcneill bwai_set_port(void *priv, mixer_ctrl_t *mc)
    147  1.1  jmcneill {
    148  1.1  jmcneill 	struct bwai_softc * const sc = priv;
    149  1.1  jmcneill 
    150  1.1  jmcneill 	if (mc->dev != BWAI_OUTPUT_MASTER_VOLUME &&
    151  1.1  jmcneill 	    mc->dev != BWAI_INPUT_DAC_VOLUME) {
    152  1.1  jmcneill 		return ENXIO;
    153  1.1  jmcneill 	}
    154  1.1  jmcneill 
    155  1.1  jmcneill 	sc->sc_swvol = mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
    156  1.1  jmcneill 
    157  1.1  jmcneill 	return 0;
    158  1.1  jmcneill }
    159  1.1  jmcneill 
    160  1.1  jmcneill static int
    161  1.1  jmcneill bwai_get_port(void *priv, mixer_ctrl_t *mc)
    162  1.1  jmcneill {
    163  1.1  jmcneill 	struct bwai_softc * const sc = priv;
    164  1.1  jmcneill 
    165  1.1  jmcneill 	if (mc->dev != BWAI_OUTPUT_MASTER_VOLUME &&
    166  1.1  jmcneill 	    mc->dev != BWAI_INPUT_DAC_VOLUME) {
    167  1.1  jmcneill 		return ENXIO;
    168  1.1  jmcneill 	}
    169  1.1  jmcneill 
    170  1.1  jmcneill 	mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = sc->sc_swvol;
    171  1.1  jmcneill 	mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = sc->sc_swvol;
    172  1.1  jmcneill 
    173  1.1  jmcneill 	return 0;
    174  1.1  jmcneill }
    175  1.1  jmcneill 
    176  1.1  jmcneill static int
    177  1.1  jmcneill bwai_query_devinfo(void *priv, mixer_devinfo_t *di)
    178  1.1  jmcneill {
    179  1.1  jmcneill 	switch (di->index) {
    180  1.1  jmcneill 	case BWAI_OUTPUT_CLASS:
    181  1.1  jmcneill 		di->mixer_class = di->index;
    182  1.1  jmcneill 		strcpy(di->label.name, AudioCoutputs);
    183  1.1  jmcneill 		di->type = AUDIO_MIXER_CLASS;
    184  1.1  jmcneill 		di->next = di->prev = AUDIO_MIXER_LAST;
    185  1.1  jmcneill 		return 0;
    186  1.1  jmcneill 
    187  1.1  jmcneill 	case BWAI_INPUT_CLASS:
    188  1.1  jmcneill 		di->mixer_class = di->index;
    189  1.1  jmcneill 		strcpy(di->label.name, AudioCinputs);
    190  1.1  jmcneill 		di->type = AUDIO_MIXER_CLASS;
    191  1.1  jmcneill 		di->next = di->prev = AUDIO_MIXER_LAST;
    192  1.1  jmcneill 		return 0;
    193  1.1  jmcneill 
    194  1.1  jmcneill 	case BWAI_OUTPUT_MASTER_VOLUME:
    195  1.1  jmcneill 		di->mixer_class = BWAI_OUTPUT_CLASS;
    196  1.1  jmcneill 		strcpy(di->label.name, AudioNmaster);
    197  1.1  jmcneill 		di->un.v.delta = 1;
    198  1.1  jmcneill 		di->type = AUDIO_MIXER_VALUE;
    199  1.1  jmcneill 		di->next = di->prev = AUDIO_MIXER_LAST;
    200  1.1  jmcneill 		di->un.v.num_channels = 2;
    201  1.1  jmcneill 		strcpy(di->un.v.units.name, AudioNvolume);
    202  1.1  jmcneill 		return 0;
    203  1.1  jmcneill 
    204  1.1  jmcneill 	case BWAI_INPUT_DAC_VOLUME:
    205  1.1  jmcneill 		di->mixer_class = BWAI_INPUT_CLASS;
    206  1.1  jmcneill 		strcpy(di->label.name, AudioNdac);
    207  1.1  jmcneill 		di->un.v.delta = 1;
    208  1.1  jmcneill 		di->type = AUDIO_MIXER_VALUE;
    209  1.1  jmcneill 		di->next = di->prev = AUDIO_MIXER_LAST;
    210  1.1  jmcneill 		di->un.v.num_channels = 2;
    211  1.1  jmcneill 		strcpy(di->un.v.units.name, AudioNvolume);
    212  1.1  jmcneill 		return 0;
    213  1.1  jmcneill 	}
    214  1.1  jmcneill 
    215  1.1  jmcneill 	return ENXIO;
    216  1.1  jmcneill }
    217  1.1  jmcneill 
    218  1.1  jmcneill static int
    219  1.1  jmcneill bwai_set_format(void *priv, int setmode,
    220  1.1  jmcneill     const audio_params_t *play, const audio_params_t *rec,
    221  1.1  jmcneill     audio_filter_reg_t *pfil, audio_filter_reg_t *rfil)
    222  1.1  jmcneill {
    223  1.1  jmcneill 	struct bwai_softc * const sc = priv;
    224  1.1  jmcneill 
    225  1.1  jmcneill 	pfil->codec = bwai_swvol_codec;
    226  1.1  jmcneill 	pfil->context = sc;
    227  1.1  jmcneill 
    228  1.1  jmcneill 	return 0;
    229  1.1  jmcneill }
    230  1.1  jmcneill 
    231  1.1  jmcneill static int
    232  1.1  jmcneill bwai_trigger_output(void *priv, void *start, void *end, int blksize,
    233  1.1  jmcneill     void (*intr)(void *), void *intrarg, const audio_params_t *params)
    234  1.1  jmcneill {
    235  1.1  jmcneill 	struct bwai_softc * const sc = priv;
    236  1.1  jmcneill 	uint32_t val;
    237  1.1  jmcneill 
    238  1.1  jmcneill 	sc->sc_intr = intr;
    239  1.1  jmcneill 	sc->sc_intrarg = intrarg;
    240  1.1  jmcneill 
    241  1.1  jmcneill 	val = RD4(sc, AI_CONTROL);
    242  1.1  jmcneill 	if ((val & AI_CONTROL_PSTAT) != 0) {
    243  1.1  jmcneill 		WR4(sc, AI_CONTROL, 0);
    244  1.1  jmcneill 	}
    245  1.1  jmcneill 
    246  1.1  jmcneill 	WR4(sc, AI_AIIT, blksize / 4);
    247  1.1  jmcneill 
    248  1.1  jmcneill 	val = AI_CONTROL_SCRESET |
    249  1.1  jmcneill 	      AI_CONTROL_AIINT |
    250  1.1  jmcneill 	      AI_CONTROL_AIINTMSK |
    251  1.1  jmcneill 	      AI_CONTROL_AFR;
    252  1.1  jmcneill 	WR4(sc, AI_CONTROL, val);
    253  1.1  jmcneill 
    254  1.1  jmcneill 	val |= AI_CONTROL_PSTAT;
    255  1.1  jmcneill 	WR4(sc, AI_CONTROL, val);
    256  1.1  jmcneill 
    257  1.1  jmcneill 	return 0;
    258  1.1  jmcneill }
    259  1.1  jmcneill 
    260  1.1  jmcneill static int
    261  1.1  jmcneill bwai_halt_output(void *priv)
    262  1.1  jmcneill {
    263  1.1  jmcneill 	struct bwai_softc * const sc = priv;
    264  1.1  jmcneill 
    265  1.1  jmcneill 	WR4(sc, AI_CONTROL, 0);
    266  1.1  jmcneill 
    267  1.1  jmcneill 	sc->sc_intr = NULL;
    268  1.1  jmcneill 	sc->sc_intrarg = NULL;
    269  1.1  jmcneill 
    270  1.1  jmcneill 	return 0;
    271  1.1  jmcneill }
    272  1.1  jmcneill 
    273  1.1  jmcneill static const struct audio_hw_if bwai_hw_if = {
    274  1.1  jmcneill 	.set_port = bwai_set_port,
    275  1.1  jmcneill 	.get_port = bwai_get_port,
    276  1.1  jmcneill 	.query_devinfo = bwai_query_devinfo,
    277  1.1  jmcneill 	.set_format = bwai_set_format,
    278  1.1  jmcneill 	.trigger_output = bwai_trigger_output,
    279  1.1  jmcneill 	.halt_output = bwai_halt_output,
    280  1.1  jmcneill };
    281  1.1  jmcneill 
    282  1.1  jmcneill static int
    283  1.1  jmcneill bwai_match(device_t parent, cfdata_t cf, void *aux)
    284  1.1  jmcneill {
    285  1.1  jmcneill 	struct mainbus_attach_args * const maa = aux;
    286  1.1  jmcneill 
    287  1.1  jmcneill 	return strcmp(maa->maa_name, "bwai") == 0;
    288  1.1  jmcneill }
    289  1.1  jmcneill 
    290  1.1  jmcneill static void
    291  1.1  jmcneill bwai_attach(device_t parent, device_t self, void *aux)
    292  1.1  jmcneill {
    293  1.1  jmcneill 	struct bwai_softc * const sc = device_private(self);
    294  1.1  jmcneill 	struct mainbus_attach_args * const maa = aux;
    295  1.1  jmcneill 
    296  1.1  jmcneill 	sc->sc_dev = self;
    297  1.1  jmcneill 	sc->sc_bst = maa->maa_bst;
    298  1.1  jmcneill 	if (bus_space_map(sc->sc_bst, maa->maa_addr, AI_SIZE, 0,
    299  1.1  jmcneill 	    &sc->sc_bsh) != 0) {
    300  1.1  jmcneill 		aprint_error(": couldn't map registers\n");
    301  1.1  jmcneill 		return;
    302  1.1  jmcneill 	}
    303  1.1  jmcneill 	sc->sc_irq = maa->maa_irq;
    304  1.1  jmcneill 
    305  1.1  jmcneill 	aprint_naive("\n");
    306  1.1  jmcneill 	aprint_normal(": Audio Interface\n");
    307  1.1  jmcneill 
    308  1.1  jmcneill 	sc->sc_dai.dai_hw_if = &bwai_hw_if;
    309  1.1  jmcneill 	sc->sc_dai.dai_dev = self;
    310  1.1  jmcneill 	sc->sc_dai.dai_priv = sc;
    311  1.1  jmcneill 	sc->sc_swvol = 255;
    312  1.1  jmcneill }
    313  1.1  jmcneill 
    314  1.1  jmcneill CFATTACH_DECL_NEW(bwai, sizeof(struct bwai_softc),
    315  1.1  jmcneill     bwai_match, bwai_attach, NULL, NULL);
    316