NetBSD/sys/dev/pci/gcscaudio.c

1340 lines
36 KiB
C

/* $NetBSD: gcscaudio.c,v 1.5 2010/02/24 22:38:00 dyoung Exp $ */
/*-
* Copyright (c) 2008 SHIMIZU Ryo <ryo@nerv.org>
* 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 NETBSD FOUNDATION, INC. AND CONTRIBUTORS
* ``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 FOUNDATION OR CONTRIBUTORS
* 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 <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: gcscaudio.c,v 1.5 2010/02/24 22:38:00 dyoung Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/malloc.h>
#include <sys/device.h>
#include <sys/queue.h>
#include <uvm/uvm_extern.h>
#include <dev/pci/pcidevs.h>
#include <dev/pci/pcivar.h>
#include <sys/audioio.h>
#include <dev/audio_if.h>
#include <dev/mulaw.h>
#include <dev/auconv.h>
#include <dev/ic/ac97reg.h>
#include <dev/ic/ac97var.h>
#include <dev/pci/gcscaudioreg.h>
#define GCSCAUDIO_NPRDTABLE 256 /* including a JMP-PRD for loop */
#define GCSCAUDIO_PRD_SIZE_MAX 65532 /* limited by CS5536 Controller */
#define GCSCAUDIO_BUFSIZE_MAX (GCSCAUDIO_PRD_SIZE_MAX * (GCSCAUDIO_NPRDTABLE - 1))
struct gcscaudio_prd {
/* PRD table for play/rec */
struct gcscaudio_prdtables {
#define PRD_TABLE_FRONT 0
#define PRD_TABLE_SURR 1
#define PRD_TABLE_CENTER 2
#define PRD_TABLE_LFE 3
#define PRD_TABLE_REC 4
#define PRD_TABLE_MAX 5
struct acc_prd prdtbl[PRD_TABLE_MAX][GCSCAUDIO_NPRDTABLE];
} *p_prdtables;
bus_dmamap_t p_prdmap;
bus_dma_segment_t p_prdsegs[1];
int p_prdnseg;
};
struct gcscaudio_dma {
LIST_ENTRY(gcscaudio_dma) list;
bus_dmamap_t map;
void *addr;
size_t size;
bus_dma_segment_t segs[1];
int nseg;
};
struct gcscaudio_softc_ch {
void (*ch_intr)(void *);
void *ch_intr_arg;
struct audio_params ch_params;
};
struct gcscaudio_softc {
struct device sc_dev;
pci_chipset_tag_t sc_pc;
pcitag_t sc_pt;
void *sc_ih;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
bus_size_t sc_ios;
bus_dma_tag_t sc_dmat;
/* allocated DMA buffer list */
LIST_HEAD(, gcscaudio_dma) sc_dmalist;
#define GCSCAUDIO_MAXFORMATS 4
struct audio_format sc_formats[GCSCAUDIO_MAXFORMATS];
int sc_nformats;
struct audio_encoding_set *sc_encodings;
/* AC97 codec */
struct ac97_host_if host_if;
struct ac97_codec_if *codec_if;
/* input, output channels */
struct gcscaudio_softc_ch sc_play;
struct gcscaudio_softc_ch sc_rec;
struct gcscaudio_prd sc_prd;
/* multi channel splitter work; {4,6}ch stream to {2,4} DMA buffers */
void *sc_mch_split_buf;
void *sc_mch_split_start;
int sc_mch_split_off;
int sc_mch_split_size;
int sc_mch_split_blksize;
void (*sc_mch_splitter)(void *, void *, int, int);
bool sc_spdif;
};
/* for cfattach */
static int gcscaudio_match(device_t, cfdata_t, void *);
static void gcscaudio_attach(device_t, device_t, void *);
/* for audio_hw_if */
static int gcscaudio_open(void *, int);
static void gcscaudio_close(void *);
static int gcscaudio_query_encoding(void *, struct audio_encoding *);
static int gcscaudio_set_params(void *, int, int, audio_params_t *,
audio_params_t *, stream_filter_list_t *,
stream_filter_list_t *);
static int gcscaudio_round_blocksize(void *, int, int, const audio_params_t *);
static int gcscaudio_halt_output(void *);
static int gcscaudio_halt_input(void *);
static int gcscaudio_getdev(void *, struct audio_device *);
static int gcscaudio_set_port(void *, mixer_ctrl_t *);
static int gcscaudio_get_port(void *, mixer_ctrl_t *);
static int gcscaudio_query_devinfo(void *, mixer_devinfo_t *);
static void *gcscaudio_malloc(void *, int, size_t, struct malloc_type *, int);
static void gcscaudio_free(void *, void *, struct malloc_type *);
static size_t gcscaudio_round_buffersize(void *, int, size_t);
static paddr_t gcscaudio_mappage(void *, void *, off_t, int);
static int gcscaudio_get_props(void *);
static int gcscaudio_trigger_output(void *, void *, void *, int,
void (*)(void *), void *,
const audio_params_t *);
static int gcscaudio_trigger_input(void *, void *, void *, int,
void (*)(void *), void *,
const audio_params_t *);
static bool gcscaudio_resume(device_t, const pmf_qual_t *);
static int gcscaudio_intr(void *);
/* for codec_if */
static int gcscaudio_attach_codec(void *, struct ac97_codec_if *);
static int gcscaudio_write_codec(void *, uint8_t, uint16_t);
static int gcscaudio_read_codec(void *, uint8_t, uint16_t *);
static int gcscaudio_reset_codec(void *);
static void gcscaudio_spdif_event_codec(void *, bool);
/* misc */
static int gcscaudio_append_formats(struct gcscaudio_softc *,
const struct audio_format *);
static int gcscaudio_wait_ready_codec(struct gcscaudio_softc *sc, const char *);
static int gcscaudio_set_params_ch(struct gcscaudio_softc *,
struct gcscaudio_softc_ch *, int,
audio_params_t *, stream_filter_list_t *);
static int gcscaudio_allocate_dma(struct gcscaudio_softc *, size_t, void **,
bus_dma_segment_t *, int, int *,
int, bus_dmamap_t *);
CFATTACH_DECL(gcscaudio, sizeof (struct gcscaudio_softc),
gcscaudio_match, gcscaudio_attach, NULL, NULL);
static struct audio_device gcscaudio_device = {
"AMD Geode CS5536",
"",
"gcscaudio"
};
static const struct audio_hw_if gcscaudio_hw_if = {
.open = gcscaudio_open,
.close = gcscaudio_close,
.drain = NULL,
.query_encoding = gcscaudio_query_encoding,
.set_params = gcscaudio_set_params,
.round_blocksize = gcscaudio_round_blocksize,
.commit_settings = NULL,
.init_output = NULL,
.init_input = NULL,
.start_output = NULL,
.start_input = NULL,
.halt_output = gcscaudio_halt_output,
.halt_input = gcscaudio_halt_input,
.speaker_ctl = NULL,
.getdev = gcscaudio_getdev,
.setfd = NULL,
.set_port = gcscaudio_set_port,
.get_port = gcscaudio_get_port,
.query_devinfo = gcscaudio_query_devinfo,
.allocm = gcscaudio_malloc,
.freem = gcscaudio_free,
.round_buffersize = gcscaudio_round_buffersize,
.mappage = gcscaudio_mappage,
.get_props = gcscaudio_get_props,
.trigger_output = gcscaudio_trigger_output,
.trigger_input = gcscaudio_trigger_input,
.dev_ioctl = NULL,
.powerstate = NULL
};
static const struct audio_format gcscaudio_formats_2ch = {
NULL, AUMODE_PLAY | AUMODE_RECORD, AUDIO_ENCODING_SLINEAR_LE, 16, 16,
2, AUFMT_STEREO, 0, {8000, 48000}
};
static const struct audio_format gcscaudio_formats_4ch = {
NULL, AUMODE_PLAY, AUDIO_ENCODING_SLINEAR_LE, 16, 16,
4, AUFMT_SURROUND4, 0, {8000, 48000}
};
static const struct audio_format gcscaudio_formats_6ch = {
NULL, AUMODE_PLAY, AUDIO_ENCODING_SLINEAR_LE, 16, 16,
6, AUFMT_DOLBY_5_1, 0, {8000, 48000}
};
static int
gcscaudio_match(device_t parent, cfdata_t match, void *aux)
{
struct pci_attach_args *pa;
pa = (struct pci_attach_args *)aux;
if ((PCI_VENDOR(pa->pa_id) == PCI_VENDOR_AMD) &&
(PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_AMD_CS5536_AUDIO))
return 1;
return 0;
}
static int
gcscaudio_append_formats(struct gcscaudio_softc *sc,
const struct audio_format *format)
{
if (sc->sc_nformats >= GCSCAUDIO_MAXFORMATS) {
aprint_error_dev(&sc->sc_dev, "too many formats\n");
return EINVAL;
}
sc->sc_formats[sc->sc_nformats++] = *format;
return 0;
}
static void
gcscaudio_attach(device_t parent, device_t self, void *aux)
{
struct gcscaudio_softc *sc;
struct pci_attach_args *pa;
const char *intrstr;
pci_intr_handle_t ih;
int rc, i;
sc = device_private(self);
aprint_naive(": Audio controller\n");
pa = aux;
sc->sc_pc = pa->pa_pc;
sc->sc_pt = pa->pa_tag;
sc->sc_dmat = pa->pa_dmat;
LIST_INIT(&sc->sc_dmalist);
sc->sc_mch_split_buf = NULL;
aprint_normal(": AMD Geode CS5536 Audio\n");
if (pci_mapreg_map(pa, PCI_MAPREG_START, PCI_MAPREG_TYPE_IO, 0,
&sc->sc_iot, &sc->sc_ioh, NULL, &sc->sc_ios)) {
aprint_error_dev(&sc->sc_dev, "can't map i/o space\n");
return;
}
if (pci_intr_map(pa, &ih)) {
aprint_error_dev(&sc->sc_dev, "couldn't map interrupt\n");
goto attach_failure_unmap;
}
intrstr = pci_intr_string(sc->sc_pc, ih);
sc->sc_ih = pci_intr_establish(sc->sc_pc, ih, IPL_AUDIO,
gcscaudio_intr, sc);
if (sc->sc_ih == NULL) {
aprint_error_dev(&sc->sc_dev, "couldn't establish interrupt");
if (intrstr != NULL)
aprint_error(" at %s", intrstr);
aprint_error("\n");
goto attach_failure_unmap;
}
aprint_normal_dev(&sc->sc_dev, "interrupting at %s\n", intrstr);
if (gcscaudio_allocate_dma(sc, sizeof(*sc->sc_prd.p_prdtables),
(void **)&(sc->sc_prd.p_prdtables), sc->sc_prd.p_prdsegs, 1,
&(sc->sc_prd.p_prdnseg), M_WAITOK, &(sc->sc_prd.p_prdmap)) != 0)
goto attach_failure_intr;
sc->host_if.arg = sc;
sc->host_if.attach = gcscaudio_attach_codec;
sc->host_if.read = gcscaudio_read_codec;
sc->host_if.write = gcscaudio_write_codec;
sc->host_if.reset = gcscaudio_reset_codec;
sc->host_if.spdif_event = gcscaudio_spdif_event_codec;
if ((rc = ac97_attach(&sc->host_if, self)) != 0) {
aprint_error_dev(&sc->sc_dev,
"can't attach codec (error=%d)\n", rc);
goto attach_failure_intr;
}
if (!pmf_device_register(self, NULL, gcscaudio_resume))
aprint_error_dev(self, "couldn't establish power handler\n");
sc->sc_nformats = 0;
gcscaudio_append_formats(sc, &gcscaudio_formats_2ch);
if (AC97_IS_4CH(sc->codec_if))
gcscaudio_append_formats(sc, &gcscaudio_formats_4ch);
if (AC97_IS_6CH(sc->codec_if))
gcscaudio_append_formats(sc, &gcscaudio_formats_6ch);
if (AC97_IS_FIXED_RATE(sc->codec_if)) {
for (i = 0; i < sc->sc_nformats; i++) {
sc->sc_formats[i].frequency_type = 1;
sc->sc_formats[i].frequency[0] = 48000;
}
}
if ((rc = auconv_create_encodings(sc->sc_formats, sc->sc_nformats,
&sc->sc_encodings)) != 0) {
aprint_error_dev(self,
"auconv_create_encoding: error=%d\n", rc);
goto attach_failure_codec;
}
audio_attach_mi(&gcscaudio_hw_if, sc, &sc->sc_dev);
sc->codec_if->vtbl->unlock(sc->codec_if);
return;
attach_failure_codec:
sc->codec_if->vtbl->detach(sc->codec_if);
attach_failure_intr:
pci_intr_disestablish(sc->sc_pc, sc->sc_ih);
attach_failure_unmap:
bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_ios);
return;
}
static int
gcscaudio_attach_codec(void *arg, struct ac97_codec_if *codec_if)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
sc->codec_if = codec_if;
return 0;
}
static int
gcscaudio_reset_codec(void *arg)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_CODEC_CNTL,
ACC_CODEC_CNTL_LNK_WRM_RST |
ACC_CODEC_CNTL_CMD_NEW);
if (gcscaudio_wait_ready_codec(sc, "reset timeout\n"))
return 1;
return 0;
}
static void
gcscaudio_spdif_event_codec(void *arg, bool flag)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
sc->sc_spdif = flag;
}
static int
gcscaudio_wait_ready_codec(struct gcscaudio_softc *sc, const char *timeout_msg)
{
int i;
#define GCSCAUDIO_WAIT_READY_CODEC_TIMEOUT 500
for (i = GCSCAUDIO_WAIT_READY_CODEC_TIMEOUT; (i >= 0) &&
(bus_space_read_4(sc->sc_iot, sc->sc_ioh, ACC_CODEC_CNTL) &
ACC_CODEC_CNTL_CMD_NEW); i--)
delay(1);
if (i < 0) {
aprint_error_dev(&sc->sc_dev, timeout_msg);
return 1;
}
return 0;
}
static int
gcscaudio_write_codec(void *arg, uint8_t reg, uint16_t val)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_CODEC_CNTL,
ACC_CODEC_CNTL_WRITE_CMD |
ACC_CODEC_CNTL_CMD_NEW |
ACC_CODEC_REG2ADDR(reg) |
(val & ACC_CODEC_CNTL_CMD_DATA_MASK));
if (gcscaudio_wait_ready_codec(sc, "codec write timeout\n"))
return 1;
#ifdef GCSCAUDIO_CODEC_DEBUG
aprint_error_dev(&sc->sc_dev, "codec write: reg=0x%02x, val=0x%04x\n",
reg, val);
#endif
return 0;
}
static int
gcscaudio_read_codec(void *arg, uint8_t reg, uint16_t *val)
{
struct gcscaudio_softc *sc;
uint32_t v;
int i;
sc = (struct gcscaudio_softc *)arg;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_CODEC_CNTL,
ACC_CODEC_CNTL_READ_CMD | ACC_CODEC_CNTL_CMD_NEW |
ACC_CODEC_REG2ADDR(reg));
if (gcscaudio_wait_ready_codec(sc, "codec write timeout for reading"))
return 1;
#define GCSCAUDIO_READ_CODEC_TIMEOUT 50
for (i = GCSCAUDIO_READ_CODEC_TIMEOUT; i >= 0; i--) {
v = bus_space_read_4(sc->sc_iot, sc->sc_ioh, ACC_CODEC_STATUS);
if ((v & ACC_CODEC_STATUS_STS_NEW) &&
(ACC_CODEC_ADDR2REG(v) == reg))
break;
delay(10);
}
if (i < 0) {
aprint_error_dev(&sc->sc_dev, "codec read timeout\n");
return 1;
}
#ifdef GCSCAUDIO_CODEC_DEBUG
aprint_error_dev(&sc->sc_dev, "codec read: reg=0x%02x, val=0x%04x\n",
reg, v & ACC_CODEC_STATUS_STS_DATA_MASK);
#endif
*val = v;
return 0;
}
static int
gcscaudio_open(void *arg, int flags)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
sc->codec_if->vtbl->lock(sc->codec_if);
return 0;
}
static void
gcscaudio_close(void *arg)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
sc->codec_if->vtbl->unlock(sc->codec_if);
}
static int
gcscaudio_query_encoding(void *arg, struct audio_encoding *fp)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
return auconv_query_encoding(sc->sc_encodings, fp);
}
static int
gcscaudio_set_params_ch(struct gcscaudio_softc *sc,
struct gcscaudio_softc_ch *ch, int mode,
audio_params_t *p, stream_filter_list_t *fil)
{
int error, idx;
if ((p->sample_rate < 8000) || (p->sample_rate > 48000))
return EINVAL;
if (p->precision != 8 && p->precision != 16)
return EINVAL;
if ((idx = auconv_set_converter(sc->sc_formats, sc->sc_nformats,
mode, p, TRUE, fil)) < 0)
return EINVAL;
if (fil->req_size > 0)
p = &fil->filters[0].param;
if (mode == AUMODE_PLAY) {
if (!AC97_IS_FIXED_RATE(sc->codec_if)) {
/* setup rate of DAC/ADC */
if ((error = sc->codec_if->vtbl->set_rate(sc->codec_if,
AC97_REG_PCM_LR_ADC_RATE, &p->sample_rate)) != 0)
return error;
/* additional rate of DAC for Surround */
if ((p->channels >= 4) &&
(error = sc->codec_if->vtbl->set_rate(sc->codec_if,
AC97_REG_PCM_SURR_DAC_RATE, &p->sample_rate)) != 0)
return error;
/* additional rate of DAC for LowFrequencyEffect */
if ((p->channels == 6) &&
(error = sc->codec_if->vtbl->set_rate(sc->codec_if,
AC97_REG_PCM_LFE_DAC_RATE, &p->sample_rate)) != 0)
return error;
}
}
if (mode == AUMODE_RECORD) {
if (!AC97_IS_FIXED_RATE(sc->codec_if)) {
/* setup rate of DAC/ADC */
if ((error = sc->codec_if->vtbl->set_rate(sc->codec_if,
AC97_REG_PCM_FRONT_DAC_RATE, &p->sample_rate)) != 0)
return error;
}
}
ch->ch_params = *p;
return 0;
}
static int
gcscaudio_set_params(void *arg, int setmode, int usemode,
audio_params_t *play, audio_params_t *rec,
stream_filter_list_t *pfil, stream_filter_list_t *rfil)
{
struct gcscaudio_softc *sc;
int error;
sc = (struct gcscaudio_softc *)arg;
if (setmode & AUMODE_PLAY) {
if ((error = gcscaudio_set_params_ch(sc, &sc->sc_play,
AUMODE_PLAY, play, pfil)) != 0)
return error;
}
if (setmode & AUMODE_RECORD) {
if ((error = gcscaudio_set_params_ch(sc, &sc->sc_rec,
AUMODE_RECORD, rec, rfil)) != 0)
return error;
}
return 0;
}
static int
gcscaudio_round_blocksize(void *arg, int blk, int mode,
const audio_params_t *param)
{
blk &= -4;
if (blk > GCSCAUDIO_PRD_SIZE_MAX)
blk = GCSCAUDIO_PRD_SIZE_MAX;
return blk;
}
static int
gcscaudio_halt_output(void *arg)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM0_CMD,
ACC_BMx_CMD_BM_CTL_DISABLE);
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM4_CMD,
ACC_BMx_CMD_BM_CTL_DISABLE);
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM6_CMD,
ACC_BMx_CMD_BM_CTL_DISABLE);
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM7_CMD,
ACC_BMx_CMD_BM_CTL_DISABLE);
sc->sc_play.ch_intr = NULL;
/* channel splitter */
sc->sc_mch_splitter = NULL;
if (sc->sc_mch_split_buf)
gcscaudio_free(sc, sc->sc_mch_split_buf, M_DEVBUF);
sc->sc_mch_split_buf = NULL;
return 0;
}
static int
gcscaudio_halt_input(void *arg)
{
struct gcscaudio_softc *sc;
sc = (struct gcscaudio_softc *)arg;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM1_CMD,
ACC_BMx_CMD_BM_CTL_DISABLE);
sc->sc_rec.ch_intr = NULL;
return 0;
}
static int
gcscaudio_getdev(void *addr, struct audio_device *retp)
{
*retp = gcscaudio_device;
return 0;
}
static int
gcscaudio_set_port(void *addr, mixer_ctrl_t *cp)
{
struct gcscaudio_softc *sc;
sc = addr;
return sc->codec_if->vtbl->mixer_set_port(sc->codec_if, cp);
}
static int
gcscaudio_get_port(void *addr, mixer_ctrl_t *cp)
{
struct gcscaudio_softc *sc;
sc = addr;
return sc->codec_if->vtbl->mixer_get_port(sc->codec_if, cp);
}
static int
gcscaudio_query_devinfo(void *addr, mixer_devinfo_t *dip)
{
struct gcscaudio_softc *sc;
sc = addr;
return sc->codec_if->vtbl->query_devinfo(sc->codec_if, dip);
}
static void *
gcscaudio_malloc(void *arg, int direction, size_t size,
struct malloc_type *pool, int flags)
{
struct gcscaudio_softc *sc;
struct gcscaudio_dma *p;
int error;
sc = (struct gcscaudio_softc *)arg;
p = malloc(sizeof(*p), pool, flags);
if (p == NULL)
return NULL;
p->size = size;
error = gcscaudio_allocate_dma(sc, size, &p->addr,
p->segs, sizeof(p->segs)/sizeof(p->segs[0]), &p->nseg,
BUS_DMA_NOWAIT, &p->map);
if (error) {
free(p, pool);
return NULL;
}
LIST_INSERT_HEAD(&sc->sc_dmalist, p, list);
return p->addr;
}
static void
gcscaudio_free(void *arg, void *ptr, struct malloc_type *pool)
{
struct gcscaudio_softc *sc;
struct gcscaudio_dma *p;
sc = (struct gcscaudio_softc *)arg;
LIST_FOREACH(p, &sc->sc_dmalist, list) {
if (p->addr == ptr) {
bus_dmamap_unload(sc->sc_dmat, p->map);
bus_dmamap_destroy(sc->sc_dmat, p->map);
bus_dmamem_unmap(sc->sc_dmat, p->addr, p->size);
bus_dmamem_free(sc->sc_dmat, p->segs, p->nseg);
LIST_REMOVE(p, list);
free(p, pool);
break;
}
}
}
static paddr_t
gcscaudio_mappage(void *arg, void *mem, off_t off, int prot)
{
struct gcscaudio_softc *sc;
struct gcscaudio_dma *p;
if (off < 0)
return -1;
sc = (struct gcscaudio_softc *)arg;
LIST_FOREACH(p, &sc->sc_dmalist, list) {
if (p->addr == mem) {
return bus_dmamem_mmap(sc->sc_dmat, p->segs, p->nseg,
off, prot, BUS_DMA_WAITOK);
}
}
return -1;
}
static size_t
gcscaudio_round_buffersize(void *addr, int direction, size_t size)
{
if (size > GCSCAUDIO_BUFSIZE_MAX)
size = GCSCAUDIO_BUFSIZE_MAX;
return size;
}
static int
gcscaudio_get_props(void *addr)
{
struct gcscaudio_softc *sc;
int props;
sc = (struct gcscaudio_softc *)addr;
props = AUDIO_PROP_INDEPENDENT | AUDIO_PROP_FULLDUPLEX;
/*
* Even if the codec is fixed-rate, set_param() succeeds for any sample
* rate because of aurateconv. Applications can't know what rate the
* device can process in the case of mmap().
*/
if (!AC97_IS_FIXED_RATE(sc->codec_if))
props |= AUDIO_PROP_MMAP;
return props;
}
static int
build_prdtables(struct gcscaudio_softc *sc, int prdidx,
void *addr, size_t size, int blksize, int blklen, int blkoff)
{
struct gcscaudio_dma *p;
struct acc_prd *prdp;
bus_addr_t paddr;
int i;
/* get physical address of start */
paddr = (bus_addr_t)0;
LIST_FOREACH(p, &sc->sc_dmalist, list) {
if (p->addr == addr) {
paddr = p->map->dm_segs[0].ds_addr;
break;
}
}
if (!paddr) {
aprint_error_dev(&sc->sc_dev,
"bad addr %p\n", addr);
return EINVAL;
}
#define PRDADDR(prdidx,idx) \
(sc->sc_prd.p_prdmap->dm_segs[0].ds_addr) + sizeof(struct acc_prd) * \
(((prdidx) * GCSCAUDIO_NPRDTABLE) + (idx))
/*
* build PRD table
* prdtbl[] = <PRD0>, <PRD1>, <PRD2>, ..., <PRDn>, <jmp to PRD0>
*/
prdp = sc->sc_prd.p_prdtables->prdtbl[prdidx];
for (i = 0; size > 0; size -= blksize, i++) {
prdp[i].address = paddr + blksize * i + blkoff;
prdp[i].ctrlsize =
(size < blklen ? size : blklen) | ACC_BMx_PRD_CTRL_EOP;
}
prdp[i].address = PRDADDR(prdidx, 0);
prdp[i].ctrlsize = ACC_BMx_PRD_CTRL_JMP;
bus_dmamap_sync(sc->sc_dmat, sc->sc_prd.p_prdmap, 0,
sizeof(struct acc_prd) * i, BUS_DMASYNC_PREWRITE);
return 0;
}
static void
split_buffer_4ch(void *dst, void *src, int size, int blksize)
{
int left, i;
uint16_t *s, *d;
/*
* src[blk0]: L,R,SL,SR,L,R,SL,SR,L,R,SL,SR,....
* src[blk1]: L,R,SL,SR,L,R,SL,SR,L,R,SL,SR,....
* src[blk2]: L,R,SL,SR,L,R,SL,SR,L,R,SL,SR,....
* :
*
* rearrange to
*
* src[blk0]: L,R,L,R,L,R,L,R,..
* src[blk1]: L,R,L,R,L,R,L,R,..
* src[blk2]: L,R,L,R,L,R,L,R,..
* :
* dst[blk0]: SL,SR,SL,SR,SL,SR,SL,SR,..
* dst[blk1]: SL,SR,SL,SR,SL,SR,SL,SR,..
* dst[blk2]: SL,SR,SL,SR,SL,SR,SL,SR,..
* :
*/
for (left = size; left > 0; left -= blksize) {
s = (uint16_t *)src;
d = (uint16_t *)dst;
for (i = 0; i < blksize / sizeof(uint16_t) / 4; i++) {
/* L,R,SL,SR -> SL,SR */
s++;
s++;
*d++ = *s++;
*d++ = *s++;
}
s = (uint16_t *)src;
d = (uint16_t *)src;
for (i = 0; i < blksize / sizeof(uint16_t) / 2 / 2; i++) {
/* L,R,SL,SR -> L,R */
*d++ = *s++;
*d++ = *s++;
s++;
s++;
}
src = (char *)src + blksize;
dst = (char *)dst + blksize;
}
}
static void
split_buffer_6ch(void *dst, void *src, int size, int blksize)
{
int left, i;
uint16_t *s, *d, *dc, *dl;
/*
* by default, treat as WAV style 5.1ch order
* 5.1ch(WAV): L R C LFE SL SR
* 5.1ch(AAC): C L R SL SR LFE
* :
*/
/*
* src[blk0]: L,R,C,LFE,SL,SR,L,R,C,LFE,SL,SR,...
* src[blk1]: L,R,C,LFE,SL,SR,L,R,C,LFE,SL,SR,...
* src[blk2]: L,R,C,LFE,SL,SR,L,R,C,LFE,SL,SR,...
* :
* src[N-1] : L,R,C,LFE,SL,SR,L,R,C,LFE,SL,SR,...
*
* rearrange to
*
* src[blk0]: L,R,L,R,..
* src[blk1]: L,R,L,R,..
* src[blk2]: L,R,L,R,..
* :
*
* dst[blk0]: SL,SR,SL,SR,..
* dst[blk1]: SL,SR,SL,SR,..
* dst[blk2]: SL,SR,SL,SR,..
* :
*
* dst[N/2+0]: C,C,C,..
* dst[N/2+1]: C,C,C,..
* :
*
* dst[N/2+N/4+0]: LFE,LFE,LFE,..
* dst[N/2+N/4+1]: LFE,LFE,LFE,..
* :
*/
for (left = size; left > 0; left -= blksize) {
s = (uint16_t *)src;
d = (uint16_t *)dst;
dc = (uint16_t *)((char *)dst + blksize / 2);
dl = (uint16_t *)((char *)dst + blksize / 2 + blksize / 4);
for (i = 0; i < blksize / sizeof(uint16_t) / 6; i++) {
#ifdef GCSCAUDIO_5_1CH_AAC_ORDER
/*
* AAC: [C,L,R,SL,SR,LFE]
* => [SL,SR]
* => [C]
* => [LFE]
*/
*dc++ = s[0]; /* C */
*dl++ = s[5]; /* LFE */
*d++ = s[3]; /* SL */
*d++ = s[4]; /* SR */
#else
/*
* WAV: [L,R,C,LFE,SL,SR]
* => [SL,SR]
* => [C]
* => [LFE]
*/
*dc++ = s[2]; /* C */
*dl++ = s[3]; /* LFE */
*d++ = s[4]; /* SL */
*d++ = s[5]; /* SR */
#endif
s += 6;
}
s = (uint16_t *)src;
d = (uint16_t *)src;
for (i = 0; i < blksize / sizeof(uint16_t) / 2 / 2; i++) {
#ifdef GCSCAUDIO_5_1CH_AAC_ORDER
/* AAC: [C,L,R,SL,SR,LFE] => [L,R] */
*d++ = s[1];
*d++ = s[2];
#else
/* WAV: [L,R,C,LFE,SL,SR] => [L,R] */
*d++ = s[0];
*d++ = s[1];
#endif
s += 6;
}
src = (char *)src + blksize;
dst = (char *)dst + blksize;
}
}
static void
channel_splitter(struct gcscaudio_softc *sc)
{
int splitsize, left;
void *src, *dst;
if (sc->sc_mch_splitter == NULL)
return;
left = sc->sc_mch_split_size - sc->sc_mch_split_off;
splitsize = sc->sc_mch_split_blksize;
if (left < splitsize)
splitsize = left;
src = (char *)sc->sc_mch_split_start + sc->sc_mch_split_off;
dst = (char *)sc->sc_mch_split_buf + sc->sc_mch_split_off;
sc->sc_mch_splitter(dst, src, splitsize, sc->sc_mch_split_blksize);
sc->sc_mch_split_off += sc->sc_mch_split_blksize;
if (sc->sc_mch_split_off >= sc->sc_mch_split_size)
sc->sc_mch_split_off = 0;
}
static int
gcscaudio_trigger_output(void *addr, void *start, void *end, int blksize,
void (*intr)(void *), void *arg,
const audio_params_t *param)
{
struct gcscaudio_softc *sc;
size_t size;
sc = (struct gcscaudio_softc *)addr;
sc->sc_play.ch_intr = intr;
sc->sc_play.ch_intr_arg = arg;
size = (char *)end - (char *)start;
switch (sc->sc_play.ch_params.channels) {
case 2:
if (build_prdtables(sc, PRD_TABLE_FRONT, start, size, blksize,
blksize, 0))
return EINVAL;
if (!AC97_IS_4CH(sc->codec_if)) {
/*
* output 2ch PCM to FRONT.LR(BM0)
*
* 2ch: L,R,L,R,L,R,L,R,... => BM0: L,R,L,R,L,R,L,R,...
*
*/
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM0_PRD,
PRDADDR(PRD_TABLE_FRONT, 0));
/* start DMA transfer */
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM0_CMD,
ACC_BMx_CMD_WRITE |
ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
} else {
/*
* output same PCM to FRONT.LR(BM0) and SURROUND.LR(BM6).
* CENTER(BM4) and LFE(BM7) doesn't sound.
*
* 2ch: L,R,L,R,L,R,L,R,... => BM0: L,R,L,R,L,R,L,R,...
* BM6: (same of BM0)
* BM4: none
* BM7: none
*/
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM0_PRD,
PRDADDR(PRD_TABLE_FRONT, 0));
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM6_PRD,
PRDADDR(PRD_TABLE_FRONT, 0));
/* start DMA transfer */
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM0_CMD,
ACC_BMx_CMD_WRITE |
ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM6_CMD,
ACC_BMx_CMD_WRITE |
ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
}
break;
case 4:
/*
* output 4ch PCM split to FRONT.LR(BM0) and SURROUND.LR(BM6).
* CENTER(BM4) and LFE(BM7) doesn't sound.
*
* rearrange ordered channel to continuous per channel
*
* 4ch: L,R,SL,SR,L,R,SL,SR,... => BM0: L,R,L,R,...
* BM6: SL,SR,SL,SR,...
* BM4: none
* BM7: none
*/
if (sc->sc_mch_split_buf)
gcscaudio_free(sc, sc->sc_mch_split_buf, M_DEVBUF);
if ((sc->sc_mch_split_buf = gcscaudio_malloc(sc, AUMODE_PLAY,
size, M_DEVBUF, M_WAITOK)) == NULL)
return ENOMEM;
/*
* 1st and 2nd blocks are split immediately.
* Other blocks will be split synchronous with intr.
*/
split_buffer_4ch(sc->sc_mch_split_buf, start, blksize * 2,
blksize);
sc->sc_mch_split_start = start;
sc->sc_mch_split_size = size;
sc->sc_mch_split_blksize = blksize;
sc->sc_mch_split_off = (blksize * 2) % size;
sc->sc_mch_splitter = split_buffer_4ch; /* split function */
if (build_prdtables(sc, PRD_TABLE_FRONT, start, size, blksize,
blksize / 2, 0))
return EINVAL;
if (build_prdtables(sc, PRD_TABLE_SURR, sc->sc_mch_split_buf,
size, blksize, blksize / 2, 0))
return EINVAL;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM0_PRD,
PRDADDR(PRD_TABLE_FRONT, 0));
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM6_PRD,
PRDADDR(PRD_TABLE_SURR, 0));
/* start DMA transfer */
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM0_CMD,
ACC_BMx_CMD_WRITE |
ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM6_CMD,
ACC_BMx_CMD_WRITE |
ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
break;
case 6:
/*
* output 6ch PCM split to
* FRONT.LR(BM0), SURROUND.LR(BM6), CENTER(BM4) and LFE(BM7)
*
* rearrange ordered channel to continuous per channel
*
* 5.1ch: L,R,C,LFE,SL,SR,... => BM0: L,R,...
* BM4: C,...
* BM6: SL,SR,...
* BM7: LFE,...
*
*/
if (sc->sc_mch_split_buf)
gcscaudio_free(sc, sc->sc_mch_split_buf, M_DEVBUF);
if ((sc->sc_mch_split_buf = gcscaudio_malloc(sc, AUMODE_PLAY,
size, M_DEVBUF, M_WAITOK)) == NULL)
return ENOMEM;
/*
* 1st and 2nd blocks are split immediately.
* Other block will be split synchronous with intr.
*/
split_buffer_6ch(sc->sc_mch_split_buf, start, blksize * 2,
blksize);
sc->sc_mch_split_start = start;
sc->sc_mch_split_size = size;
sc->sc_mch_split_blksize = blksize;
sc->sc_mch_split_off = (blksize * 2) % size;
sc->sc_mch_splitter = split_buffer_6ch; /* split function */
if (build_prdtables(sc, PRD_TABLE_FRONT, start, size, blksize,
blksize / 3, 0))
return EINVAL;
if (build_prdtables(sc, PRD_TABLE_CENTER, sc->sc_mch_split_buf,
size, blksize, blksize / 3, blksize / 2))
return EINVAL;
if (build_prdtables(sc, PRD_TABLE_SURR, sc->sc_mch_split_buf,
size, blksize, blksize / 3, 0))
return EINVAL;
if (build_prdtables(sc, PRD_TABLE_LFE, sc->sc_mch_split_buf,
size, blksize, blksize / 3, blksize / 2 + blksize / 4))
return EINVAL;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM0_PRD,
PRDADDR(PRD_TABLE_FRONT, 0));
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM4_PRD,
PRDADDR(PRD_TABLE_CENTER, 0));
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM6_PRD,
PRDADDR(PRD_TABLE_SURR, 0));
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM7_PRD,
PRDADDR(PRD_TABLE_LFE, 0));
/* start DMA transfer */
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM0_CMD,
ACC_BMx_CMD_WRITE | ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM4_CMD,
ACC_BMx_CMD_WRITE | ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM6_CMD,
ACC_BMx_CMD_WRITE | ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM7_CMD,
ACC_BMx_CMD_WRITE | ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
break;
}
return 0;
}
static int
gcscaudio_trigger_input(void *addr, void *start, void *end, int blksize,
void (*intr)(void *), void *arg,
const audio_params_t *param)
{
struct gcscaudio_softc *sc;
size_t size;
sc = (struct gcscaudio_softc *)addr;
sc->sc_rec.ch_intr = intr;
sc->sc_rec.ch_intr_arg = arg;
size = (char *)end - (char *)start;
if (build_prdtables(sc, PRD_TABLE_REC, start, size, blksize, blksize, 0))
return EINVAL;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, ACC_BM1_PRD,
PRDADDR(PRD_TABLE_REC, 0));
/* start transfer */
bus_space_write_1(sc->sc_iot, sc->sc_ioh, ACC_BM1_CMD,
ACC_BMx_CMD_READ |
ACC_BMx_CMD_BYTE_ORD_EL |
ACC_BMx_CMD_BM_CTL_ENABLE);
return 0;
}
static int
gcscaudio_intr(void *arg)
{
struct gcscaudio_softc *sc;
uint16_t intr;
uint8_t bmstat;
int nintr;
nintr = 0;
sc = (struct gcscaudio_softc *)arg;
intr = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ACC_IRQ_STATUS);
if (intr == 0)
return 0;
/* Front output */
if (intr & ACC_IRQ_STATUS_BM0_IRQ_STS) {
bmstat = bus_space_read_1(sc->sc_iot, sc->sc_ioh, ACC_BM0_STATUS);
if (bmstat & ACC_BMx_STATUS_BM_EOP_ERR)
aprint_normal_dev(&sc->sc_dev, "BM0: Bus Master Error\n");
if (!(bmstat & ACC_BMx_STATUS_EOP))
aprint_normal_dev(&sc->sc_dev, "BM0: NO End of Page?\n");
if (sc->sc_play.ch_intr) {
sc->sc_play.ch_intr(sc->sc_play.ch_intr_arg);
channel_splitter(sc);
}
nintr++;
}
/* Center output */
if (intr & ACC_IRQ_STATUS_BM4_IRQ_STS) {
bmstat = bus_space_read_1(sc->sc_iot, sc->sc_ioh, ACC_BM4_STATUS);
if (bmstat & ACC_BMx_STATUS_BM_EOP_ERR)
aprint_normal_dev(&sc->sc_dev, "BM4: Bus Master Error\n");
if (!(bmstat & ACC_BMx_STATUS_EOP))
aprint_normal_dev(&sc->sc_dev, "BM4: NO End of Page?\n");
nintr++;
}
/* Surround output */
if (intr & ACC_IRQ_STATUS_BM6_IRQ_STS) {
bmstat = bus_space_read_1(sc->sc_iot, sc->sc_ioh, ACC_BM6_STATUS);
if (bmstat & ACC_BMx_STATUS_BM_EOP_ERR)
aprint_normal_dev(&sc->sc_dev, "BM6: Bus Master Error\n");
if (!(bmstat & ACC_BMx_STATUS_EOP))
aprint_normal_dev(&sc->sc_dev, "BM6: NO End of Page?\n");
nintr++;
}
/* LowFrequencyEffect output */
if (intr & ACC_IRQ_STATUS_BM7_IRQ_STS) {
bmstat = bus_space_read_1(sc->sc_iot, sc->sc_ioh, ACC_BM7_STATUS);
if (bmstat & ACC_BMx_STATUS_BM_EOP_ERR)
aprint_normal_dev(&sc->sc_dev, "BM7: Bus Master Error\n");
if (!(bmstat & ACC_BMx_STATUS_EOP))
aprint_normal_dev(&sc->sc_dev, "BM7: NO End of Page?\n");
nintr++;
}
/* record */
if (intr & ACC_IRQ_STATUS_BM1_IRQ_STS) {
bmstat = bus_space_read_1(sc->sc_iot, sc->sc_ioh, ACC_BM1_STATUS);
if (bmstat & ACC_BMx_STATUS_BM_EOP_ERR)
aprint_normal_dev(&sc->sc_dev, "BM1: Bus Master Error\n");
if (!(bmstat & ACC_BMx_STATUS_EOP))
aprint_normal_dev(&sc->sc_dev, "BM1: NO End of Page?\n");
if (sc->sc_rec.ch_intr) {
sc->sc_rec.ch_intr(sc->sc_rec.ch_intr_arg);
}
nintr++;
}
#ifdef GCSCAUDIO_DEBUG
if (intr & ACC_IRQ_STATUS_IRQ_STS)
aprint_normal_dev(&sc->sc_dev, "Codec GPIO IRQ Status\n");
if (intr & ACC_IRQ_STATUS_WU_IRQ_STS)
aprint_normal_dev(&sc->sc_dev, "Codec GPIO Wakeup IRQ Status\n");
if (intr & ACC_IRQ_STATUS_BM2_IRQ_STS)
aprint_normal_dev(&sc->sc_dev, "Audio Bus Master 2 IRQ Status\n");
if (intr & ACC_IRQ_STATUS_BM3_IRQ_STS)
aprint_normal_dev(&sc->sc_dev, "Audio Bus Master 3 IRQ Status\n");
if (intr & ACC_IRQ_STATUS_BM5_IRQ_STS)
aprint_normal_dev(&sc->sc_dev, "Audio Bus Master 5 IRQ Status\n");
#endif
return nintr ? 1 : 0;
}
static bool
gcscaudio_resume(device_t dv, const pmf_qual_t *qual)
{
struct gcscaudio_softc *sc = device_private(dv);
gcscaudio_reset_codec(sc);
DELAY(1000);
(sc->codec_if->vtbl->restore_ports)(sc->codec_if);
return true;
}
static int
gcscaudio_allocate_dma(struct gcscaudio_softc *sc, size_t size, void **addrp,
bus_dma_segment_t *seglist, int nseg, int *rsegp,
int flags, bus_dmamap_t *mapp)
{
int error;
if ((error = bus_dmamem_alloc(sc->sc_dmat, size, PAGE_SIZE, 0, seglist,
nseg, rsegp, flags)) != 0) {
aprint_error_dev(&sc->sc_dev,
"unable to allocate DMA buffer, error=%d\n", error);
goto fail_alloc;
}
if ((error = bus_dmamem_map(sc->sc_dmat, seglist, nseg, size, addrp,
BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
aprint_error_dev(&sc->sc_dev,
"unable to map DMA buffer, error=%d\n",
error);
goto fail_map;
}
if ((error = bus_dmamap_create(sc->sc_dmat, size, nseg, size, 0,
BUS_DMA_NOWAIT, mapp)) != 0) {
aprint_error_dev(&sc->sc_dev,
"unable to create DMA map, error=%d\n", error);
goto fail_create;
}
if ((error = bus_dmamap_load(sc->sc_dmat, *mapp, *addrp, size, NULL,
BUS_DMA_NOWAIT)) != 0) {
aprint_error_dev(&sc->sc_dev,
"unable to load DMA map, error=%d\n", error);
goto fail_load;
}
return 0;
fail_load:
bus_dmamap_destroy(sc->sc_dmat, *mapp);
fail_create:
bus_dmamem_unmap(sc->sc_dmat, *addrp, size);
fail_map:
bus_dmamem_free(sc->sc_dmat, seglist, nseg);
fail_alloc:
return error;
}