1355 lines
34 KiB
C
1355 lines
34 KiB
C
/* $NetBSD: harmony.c,v 1.5 2005/12/11 12:17:24 christos Exp $ */
|
|
|
|
/* $OpenBSD: harmony.c,v 1.23 2004/02/13 21:28:19 mickey Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 2003 Jason L. Wright (jason@thought.net)
|
|
* 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.
|
|
*/
|
|
|
|
/*
|
|
* Harmony (CS4215/AD1849 LASI) audio interface.
|
|
*/
|
|
|
|
#include "rnd.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/device.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/malloc.h>
|
|
#include <uvm/uvm_extern.h>
|
|
|
|
#if NRND > 0
|
|
#include <sys/rnd.h>
|
|
#endif
|
|
|
|
#include <sys/audioio.h>
|
|
#include <dev/audio_if.h>
|
|
#include <dev/auconv.h>
|
|
|
|
#include <machine/cpu.h>
|
|
#include <machine/intr.h>
|
|
#include <machine/iomod.h>
|
|
#include <machine/autoconf.h>
|
|
#include <machine/bus.h>
|
|
|
|
#include <hp700/dev/cpudevs.h>
|
|
#include <hp700/gsc/gscbusvar.h>
|
|
#include <hp700/gsc/harmonyreg.h>
|
|
#include <hp700/gsc/harmonyvar.h>
|
|
|
|
int harmony_open(void *, int);
|
|
void harmony_close(void *);
|
|
int harmony_query_encoding(void *, struct audio_encoding *);
|
|
int harmony_set_params(void *, int, int, audio_params_t *,
|
|
audio_params_t *, stream_filter_list_t *, stream_filter_list_t *);
|
|
int harmony_round_blocksize(void *, int, int, const audio_params_t *);
|
|
int harmony_commit_settings(void *);
|
|
int harmony_halt_output(void *);
|
|
int harmony_halt_input(void *);
|
|
int harmony_getdev(void *, struct audio_device *);
|
|
int harmony_set_port(void *, mixer_ctrl_t *);
|
|
int harmony_get_port(void *, mixer_ctrl_t *);
|
|
int harmony_query_devinfo(void *, mixer_devinfo_t *);
|
|
void * harmony_allocm(void *, int, size_t, struct malloc_type *, int);
|
|
void harmony_freem(void *, void *, struct malloc_type *);
|
|
size_t harmony_round_buffersize(void *, int, size_t);
|
|
int harmony_get_props(void *);
|
|
int harmony_trigger_output(void *, void *, void *, int,
|
|
void (*)(void *), void *, const audio_params_t *);
|
|
int harmony_trigger_input(void *, void *, void *, int,
|
|
void (*)(void *), void *, const audio_params_t *);
|
|
|
|
const struct audio_hw_if harmony_sa_hw_if = {
|
|
harmony_open,
|
|
harmony_close,
|
|
NULL,
|
|
harmony_query_encoding,
|
|
harmony_set_params,
|
|
harmony_round_blocksize,
|
|
harmony_commit_settings,
|
|
NULL,
|
|
NULL,
|
|
NULL,
|
|
NULL,
|
|
harmony_halt_output,
|
|
harmony_halt_input,
|
|
NULL,
|
|
harmony_getdev,
|
|
NULL,
|
|
harmony_set_port,
|
|
harmony_get_port,
|
|
harmony_query_devinfo,
|
|
harmony_allocm,
|
|
harmony_freem,
|
|
harmony_round_buffersize,
|
|
NULL,
|
|
harmony_get_props,
|
|
harmony_trigger_output,
|
|
harmony_trigger_input,
|
|
};
|
|
|
|
int harmony_match(struct device *, struct cfdata *, void *);
|
|
void harmony_attach(struct device *, struct device *, void *);
|
|
|
|
|
|
CFATTACH_DECL(harmony, sizeof(struct harmony_softc),
|
|
harmony_match, harmony_attach, NULL, NULL);
|
|
|
|
int harmony_intr(void *);
|
|
void harmony_intr_enable(struct harmony_softc *);
|
|
void harmony_intr_disable(struct harmony_softc *);
|
|
uint32_t harmony_speed_bits(struct harmony_softc *, u_int *);
|
|
int harmony_set_gainctl(struct harmony_softc *);
|
|
void harmony_reset_codec(struct harmony_softc *);
|
|
void harmony_start_cp(struct harmony_softc *);
|
|
void harmony_tick_pb(void *);
|
|
void harmony_tick_cp(void *);
|
|
void harmony_try_more(struct harmony_softc *);
|
|
|
|
#if NRND > 0
|
|
void harmony_acc_tmo(void *);
|
|
#define ADD_CLKALLICA(sc) do { \
|
|
(sc)->sc_acc <<= 1; \
|
|
(sc)->sc_acc |= READ_REG((sc), HARMONY_DIAG) & DIAG_CO; \
|
|
if ((sc)->sc_acc_cnt++ && !((sc)->sc_acc_cnt % 32)) \
|
|
rnd_add_uint32(&(sc)->sc_rnd_source, \
|
|
(sc)->sc_acc_num ^= (sc)->sc_acc); \
|
|
} while(0)
|
|
#endif
|
|
|
|
int
|
|
harmony_match(struct device *parent, struct cfdata *match, void *aux)
|
|
{
|
|
struct gsc_attach_args *ga;
|
|
|
|
ga = aux;
|
|
if (ga->ga_type.iodc_type == HPPA_TYPE_FIO) {
|
|
if (ga->ga_type.iodc_sv_model == HPPA_FIO_A1 ||
|
|
ga->ga_type.iodc_sv_model == HPPA_FIO_A2NB ||
|
|
ga->ga_type.iodc_sv_model == HPPA_FIO_A1NB ||
|
|
ga->ga_type.iodc_sv_model == HPPA_FIO_A2)
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
harmony_attach(struct device *parent, struct device *self, void *aux)
|
|
{
|
|
struct harmony_softc *sc;
|
|
struct gsc_attach_args *ga;
|
|
uint8_t rev;
|
|
uint32_t cntl;
|
|
int i;
|
|
|
|
sc = (struct harmony_softc *)self;
|
|
ga = aux;
|
|
sc->sc_bt = ga->ga_iot;
|
|
sc->sc_dmat = ga->ga_dmatag;
|
|
|
|
if (bus_space_map(sc->sc_bt, ga->ga_hpa, HARMONY_NREGS, 0,
|
|
&sc->sc_bh) != 0) {
|
|
printf(": couldn't map registers\n");
|
|
return;
|
|
}
|
|
|
|
cntl = READ_REG(sc, HARMONY_ID);
|
|
switch ((cntl & ID_REV_MASK)) {
|
|
case ID_REV_TS:
|
|
sc->sc_teleshare = 1;
|
|
case ID_REV_NOTS:
|
|
break;
|
|
default:
|
|
printf(": unknown id == 0x%02x\n",
|
|
(cntl & ID_REV_MASK) >> ID_REV_SHIFT);
|
|
bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
|
|
return;
|
|
}
|
|
|
|
if (bus_dmamem_alloc(sc->sc_dmat, sizeof(struct harmony_empty),
|
|
PAGE_SIZE, 0, &sc->sc_empty_seg, 1, &sc->sc_empty_rseg,
|
|
BUS_DMA_NOWAIT) != 0) {
|
|
printf(": couldn't alloc DMA memory\n");
|
|
bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
|
|
return;
|
|
}
|
|
if (bus_dmamem_map(sc->sc_dmat, &sc->sc_empty_seg, 1,
|
|
sizeof(struct harmony_empty), (caddr_t *)&sc->sc_empty_kva,
|
|
BUS_DMA_NOWAIT) != 0) {
|
|
printf(": couldn't map DMA memory\n");
|
|
bus_dmamem_free(sc->sc_dmat, &sc->sc_empty_seg,
|
|
sc->sc_empty_rseg);
|
|
bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
|
|
return;
|
|
}
|
|
if (bus_dmamap_create(sc->sc_dmat, sizeof(struct harmony_empty), 1,
|
|
sizeof(struct harmony_empty), 0, BUS_DMA_NOWAIT,
|
|
&sc->sc_empty_map) != 0) {
|
|
printf(": can't create DMA map\n");
|
|
bus_dmamem_unmap(sc->sc_dmat, (caddr_t)sc->sc_empty_kva,
|
|
sizeof(struct harmony_empty));
|
|
bus_dmamem_free(sc->sc_dmat, &sc->sc_empty_seg,
|
|
sc->sc_empty_rseg);
|
|
bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
|
|
return;
|
|
}
|
|
if (bus_dmamap_load(sc->sc_dmat, sc->sc_empty_map, sc->sc_empty_kva,
|
|
sizeof(struct harmony_empty), NULL, BUS_DMA_NOWAIT) != 0) {
|
|
printf(": can't load DMA map\n");
|
|
bus_dmamap_destroy(sc->sc_dmat, sc->sc_empty_map);
|
|
bus_dmamem_unmap(sc->sc_dmat, (caddr_t)sc->sc_empty_kva,
|
|
sizeof(struct harmony_empty));
|
|
bus_dmamem_free(sc->sc_dmat, &sc->sc_empty_seg,
|
|
sc->sc_empty_rseg);
|
|
bus_space_unmap(sc->sc_bt, sc->sc_bh, HARMONY_NREGS);
|
|
return;
|
|
}
|
|
|
|
sc->sc_playback_empty = 0;
|
|
for (i = 0; i < PLAYBACK_EMPTYS; i++)
|
|
sc->sc_playback_paddrs[i] =
|
|
sc->sc_empty_map->dm_segs[0].ds_addr +
|
|
offsetof(struct harmony_empty, playback[i][0]);
|
|
|
|
sc->sc_capture_empty = 0;
|
|
for (i = 0; i < CAPTURE_EMPTYS; i++)
|
|
sc->sc_capture_paddrs[i] =
|
|
sc->sc_empty_map->dm_segs[0].ds_addr +
|
|
offsetof(struct harmony_empty, playback[i][0]);
|
|
|
|
bus_dmamap_sync(sc->sc_dmat, sc->sc_empty_map,
|
|
offsetof(struct harmony_empty, playback[0][0]),
|
|
PLAYBACK_EMPTYS * HARMONY_BUFSIZE, BUS_DMASYNC_PREWRITE);
|
|
|
|
(void) hp700_intr_establish(&sc->sc_dv, IPL_AUDIO,
|
|
harmony_intr, sc, ga->ga_int_reg, ga->ga_irq);
|
|
|
|
/* set defaults */
|
|
sc->sc_in_port = HARMONY_IN_LINE;
|
|
sc->sc_out_port = HARMONY_OUT_SPEAKER;
|
|
sc->sc_input_lvl.left = sc->sc_input_lvl.right = 240;
|
|
sc->sc_output_lvl.left = sc->sc_output_lvl.right = 244;
|
|
sc->sc_monitor_lvl.left = sc->sc_monitor_lvl.right = 208;
|
|
sc->sc_outputgain = 0;
|
|
|
|
/* reset chip, and push default gain controls */
|
|
harmony_reset_codec(sc);
|
|
|
|
cntl = READ_REG(sc, HARMONY_CNTL);
|
|
rev = (cntl & CNTL_CODEC_REV_MASK) >> CNTL_CODEC_REV_SHIFT;
|
|
printf(": rev %u", rev);
|
|
|
|
if (sc->sc_teleshare)
|
|
printf(", teleshare");
|
|
printf("\n");
|
|
|
|
if ((rev & CS4215_REV_VER) >= CS4215_REV_VER_E)
|
|
sc->sc_hasulinear8 = 1;
|
|
|
|
strlcpy(sc->sc_audev.name, ga->ga_name, sizeof(sc->sc_audev.name));
|
|
snprintf(sc->sc_audev.version, sizeof sc->sc_audev.version,
|
|
"%u.%u;%u", ga->ga_type.iodc_sv_rev,
|
|
ga->ga_type.iodc_model, ga->ga_type.iodc_revision);
|
|
strlcpy(sc->sc_audev.config, sc->sc_dv.dv_xname,
|
|
sizeof(sc->sc_audev.config));
|
|
|
|
audio_attach_mi(&harmony_sa_hw_if, sc, &sc->sc_dv);
|
|
|
|
#if NRND > 0
|
|
rnd_attach_source(&sc->sc_rnd_source, sc->sc_dv.dv_xname,
|
|
RND_TYPE_UNKNOWN, 0);
|
|
|
|
callout_setfunc(&sc->sc_acc_tmo, harmony_acc_tmo, sc);
|
|
sc->sc_acc_num = 0xa5a5a5a5;
|
|
#endif
|
|
}
|
|
|
|
void
|
|
harmony_reset_codec(struct harmony_softc *sc)
|
|
{
|
|
|
|
/* silence */
|
|
WRITE_REG(sc, HARMONY_GAINCTL, GAINCTL_OUTPUT_LEFT_M |
|
|
GAINCTL_OUTPUT_RIGHT_M | GAINCTL_MONITOR_M);
|
|
|
|
/* start reset */
|
|
WRITE_REG(sc, HARMONY_RESET, RESET_RST);
|
|
|
|
DELAY(100000); /* wait at least 0.05 sec */
|
|
|
|
harmony_set_gainctl(sc);
|
|
WRITE_REG(sc, HARMONY_RESET, 0);
|
|
}
|
|
|
|
#if NRND > 0
|
|
void
|
|
harmony_acc_tmo(void *v)
|
|
{
|
|
struct harmony_softc *sc;
|
|
|
|
sc = v;
|
|
ADD_CLKALLICA(sc);
|
|
callout_schedule(&sc->sc_acc_tmo, 1);
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* interrupt handler
|
|
*/
|
|
int
|
|
harmony_intr(void *vsc)
|
|
{
|
|
struct harmony_softc *sc;
|
|
struct harmony_channel *c;
|
|
uint32_t dstatus;
|
|
int r;
|
|
|
|
sc = vsc;
|
|
r = 0;
|
|
#if NRND > 0
|
|
ADD_CLKALLICA(sc);
|
|
#endif
|
|
|
|
harmony_intr_disable(sc);
|
|
|
|
dstatus = READ_REG(sc, HARMONY_DSTATUS);
|
|
|
|
if (dstatus & DSTATUS_PN) {
|
|
struct harmony_dma *d;
|
|
bus_addr_t nextaddr;
|
|
bus_size_t togo;
|
|
|
|
r = 1;
|
|
c = &sc->sc_playback;
|
|
d = c->c_current;
|
|
togo = c->c_segsz - c->c_cnt;
|
|
if (togo == 0) {
|
|
nextaddr = d->d_map->dm_segs[0].ds_addr;
|
|
c->c_cnt = togo = c->c_blksz;
|
|
} else {
|
|
nextaddr = c->c_lastaddr;
|
|
if (togo > c->c_blksz)
|
|
togo = c->c_blksz;
|
|
c->c_cnt += togo;
|
|
}
|
|
|
|
bus_dmamap_sync(sc->sc_dmat, d->d_map,
|
|
nextaddr - d->d_map->dm_segs[0].ds_addr,
|
|
c->c_blksz, BUS_DMASYNC_PREWRITE);
|
|
|
|
WRITE_REG(sc, HARMONY_PNXTADD, nextaddr);
|
|
SYNC_REG(sc, HARMONY_PNXTADD, BUS_SPACE_BARRIER_WRITE);
|
|
c->c_lastaddr = nextaddr + togo;
|
|
harmony_try_more(sc);
|
|
}
|
|
|
|
dstatus = READ_REG(sc, HARMONY_DSTATUS);
|
|
|
|
if (dstatus & DSTATUS_RN) {
|
|
c = &sc->sc_capture;
|
|
r = 1;
|
|
harmony_start_cp(sc);
|
|
if (sc->sc_capturing && c->c_intr != NULL)
|
|
(*c->c_intr)(c->c_intrarg);
|
|
}
|
|
|
|
if (READ_REG(sc, HARMONY_OV) & OV_OV) {
|
|
sc->sc_ov = 1;
|
|
WRITE_REG(sc, HARMONY_OV, 0);
|
|
} else
|
|
sc->sc_ov = 0;
|
|
|
|
harmony_intr_enable(sc);
|
|
|
|
return r;
|
|
}
|
|
|
|
void
|
|
harmony_intr_enable(struct harmony_softc *sc)
|
|
{
|
|
|
|
WRITE_REG(sc, HARMONY_DSTATUS, DSTATUS_IE);
|
|
SYNC_REG(sc, HARMONY_DSTATUS, BUS_SPACE_BARRIER_WRITE);
|
|
}
|
|
|
|
void
|
|
harmony_intr_disable(struct harmony_softc *sc)
|
|
{
|
|
|
|
WRITE_REG(sc, HARMONY_DSTATUS, 0);
|
|
SYNC_REG(sc, HARMONY_DSTATUS, BUS_SPACE_BARRIER_WRITE);
|
|
}
|
|
|
|
int
|
|
harmony_open(void *vsc, int flags)
|
|
{
|
|
struct harmony_softc *sc;
|
|
|
|
sc = vsc;
|
|
if (sc->sc_open)
|
|
return EBUSY;
|
|
sc->sc_open = 1;
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
harmony_close(void *vsc)
|
|
{
|
|
struct harmony_softc *sc;
|
|
|
|
sc = vsc;
|
|
harmony_halt_input(sc);
|
|
harmony_halt_output(sc);
|
|
harmony_intr_disable(sc);
|
|
sc->sc_open = 0;
|
|
}
|
|
|
|
int
|
|
harmony_query_encoding(void *vsc, struct audio_encoding *fp)
|
|
{
|
|
struct harmony_softc *sc;
|
|
int err;
|
|
|
|
sc = vsc;
|
|
err = 0;
|
|
switch (fp->index) {
|
|
case 0:
|
|
strlcpy(fp->name, AudioEmulaw, sizeof fp->name);
|
|
fp->encoding = AUDIO_ENCODING_ULAW;
|
|
fp->precision = 8;
|
|
fp->flags = 0;
|
|
break;
|
|
case 1:
|
|
strlcpy(fp->name, AudioEalaw, sizeof fp->name);
|
|
fp->encoding = AUDIO_ENCODING_ALAW;
|
|
fp->precision = 8;
|
|
fp->flags = 0;
|
|
break;
|
|
case 2:
|
|
strlcpy(fp->name, AudioEslinear_be, sizeof fp->name);
|
|
fp->encoding = AUDIO_ENCODING_SLINEAR_BE;
|
|
fp->precision = 16;
|
|
fp->flags = 0;
|
|
break;
|
|
case 3:
|
|
strlcpy(fp->name, AudioEslinear_le, sizeof fp->name);
|
|
fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
|
|
fp->precision = 16;
|
|
fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
|
|
break;
|
|
case 4:
|
|
strlcpy(fp->name, AudioEulinear_be, sizeof fp->name);
|
|
fp->encoding = AUDIO_ENCODING_ULINEAR_BE;
|
|
fp->precision = 16;
|
|
fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
|
|
break;
|
|
case 5:
|
|
strlcpy(fp->name, AudioEulinear_le, sizeof fp->name);
|
|
fp->encoding = AUDIO_ENCODING_ULINEAR_LE;
|
|
fp->precision = 16;
|
|
fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
|
|
break;
|
|
case 6:
|
|
if (sc->sc_hasulinear8) {
|
|
strlcpy(fp->name, AudioEulinear, sizeof fp->name);
|
|
fp->encoding = AUDIO_ENCODING_ULINEAR;
|
|
fp->precision = 8;
|
|
fp->flags = 0;
|
|
break;
|
|
}
|
|
/*FALLTHROUGH*/
|
|
case 7:
|
|
if (sc->sc_hasulinear8) {
|
|
strlcpy(fp->name, AudioEslinear, sizeof fp->name);
|
|
fp->encoding = AUDIO_ENCODING_SLINEAR;
|
|
fp->precision = 8;
|
|
fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
|
|
break;
|
|
}
|
|
/*FALLTHROUGH*/
|
|
default:
|
|
err = EINVAL;
|
|
}
|
|
return err;
|
|
}
|
|
|
|
int
|
|
harmony_set_params(void *vsc, int setmode, int usemode,
|
|
audio_params_t *p, audio_params_t *r,
|
|
stream_filter_list_t *pfil, stream_filter_list_t *rfil)
|
|
{
|
|
audio_params_t hw;
|
|
struct harmony_softc *sc;
|
|
uint32_t bits;
|
|
stream_filter_factory_t *pswcode = NULL;
|
|
stream_filter_factory_t *rswcode = NULL;
|
|
|
|
sc = vsc;
|
|
/* assume p.equals(r) */
|
|
hw = *p;
|
|
switch (p->encoding) {
|
|
case AUDIO_ENCODING_ULAW:
|
|
if (p->precision != 8)
|
|
return EINVAL;
|
|
bits = CNTL_FORMAT_ULAW;
|
|
break;
|
|
case AUDIO_ENCODING_ALAW:
|
|
if (p->precision != 8)
|
|
return EINVAL;
|
|
bits = CNTL_FORMAT_ALAW;
|
|
break;
|
|
case AUDIO_ENCODING_SLINEAR_BE:
|
|
if (p->precision == 8) {
|
|
bits = CNTL_FORMAT_ULINEAR8;
|
|
hw.encoding = AUDIO_ENCODING_ULINEAR_LE;
|
|
rswcode = pswcode = change_sign8;
|
|
break;
|
|
}
|
|
if (p->precision == 16) {
|
|
bits = CNTL_FORMAT_SLINEAR16BE;
|
|
break;
|
|
}
|
|
return EINVAL;
|
|
case AUDIO_ENCODING_ULINEAR:
|
|
if (p->precision != 8)
|
|
return EINVAL;
|
|
bits = CNTL_FORMAT_ULINEAR8;
|
|
break;
|
|
case AUDIO_ENCODING_SLINEAR:
|
|
if (p->precision != 8)
|
|
return EINVAL;
|
|
bits = CNTL_FORMAT_ULINEAR8;
|
|
hw.encoding = AUDIO_ENCODING_ULINEAR_LE;
|
|
rswcode = pswcode = change_sign8;
|
|
break;
|
|
case AUDIO_ENCODING_SLINEAR_LE:
|
|
if (p->precision == 8) {
|
|
bits = CNTL_FORMAT_ULINEAR8;
|
|
hw.encoding = AUDIO_ENCODING_ULINEAR_LE;
|
|
rswcode = pswcode = change_sign8;
|
|
break;
|
|
}
|
|
if (p->precision == 16) {
|
|
bits = CNTL_FORMAT_SLINEAR16BE;
|
|
hw.encoding = AUDIO_ENCODING_SLINEAR_BE;
|
|
rswcode = pswcode = swap_bytes;
|
|
break;
|
|
}
|
|
return EINVAL;
|
|
case AUDIO_ENCODING_ULINEAR_BE:
|
|
if (p->precision == 8) {
|
|
bits = CNTL_FORMAT_ULINEAR8;
|
|
break;
|
|
}
|
|
if (p->precision == 16) {
|
|
bits = CNTL_FORMAT_SLINEAR16BE;
|
|
rswcode = pswcode = change_sign16;
|
|
break;
|
|
}
|
|
return EINVAL;
|
|
case AUDIO_ENCODING_ULINEAR_LE:
|
|
if (p->precision == 8) {
|
|
bits = CNTL_FORMAT_ULINEAR8;
|
|
break;
|
|
}
|
|
if (p->precision == 16) {
|
|
bits = CNTL_FORMAT_SLINEAR16BE;
|
|
hw.encoding = AUDIO_ENCODING_SLINEAR_BE;
|
|
rswcode = pswcode = swap_bytes_change_sign16;
|
|
break;
|
|
}
|
|
return EINVAL;
|
|
default:
|
|
return EINVAL;
|
|
}
|
|
|
|
if (sc->sc_outputgain)
|
|
bits |= CNTL_OLB;
|
|
|
|
if (p->channels == 1)
|
|
bits |= CNTL_CHANS_MONO;
|
|
else if (p->channels == 2)
|
|
bits |= CNTL_CHANS_STEREO;
|
|
else
|
|
return EINVAL;
|
|
|
|
bits |= harmony_speed_bits(sc, &p->sample_rate);
|
|
if (pswcode != NULL)
|
|
pfil->append(pfil, pswcode, &hw);
|
|
if (rswcode != NULL)
|
|
rfil->append(rfil, rswcode, &hw);
|
|
sc->sc_cntlbits = bits;
|
|
sc->sc_need_commit = 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
harmony_round_blocksize(void *vsc, int blk,
|
|
int mode, const audio_params_t *param)
|
|
{
|
|
|
|
return HARMONY_BUFSIZE;
|
|
}
|
|
|
|
int
|
|
harmony_commit_settings(void *vsc)
|
|
{
|
|
struct harmony_softc *sc;
|
|
uint32_t reg;
|
|
uint8_t quietchar;
|
|
int i;
|
|
|
|
sc = vsc;
|
|
if (sc->sc_need_commit == 0)
|
|
return 0;
|
|
|
|
harmony_intr_disable(sc);
|
|
|
|
for (;;) {
|
|
reg = READ_REG(sc, HARMONY_DSTATUS);
|
|
if ((reg & (DSTATUS_PC | DSTATUS_RC)) == 0)
|
|
break;
|
|
}
|
|
|
|
/* Setting some bits in gainctl requires a reset */
|
|
harmony_reset_codec(sc);
|
|
|
|
/* set the silence character based on the encoding type */
|
|
bus_dmamap_sync(sc->sc_dmat, sc->sc_empty_map,
|
|
offsetof(struct harmony_empty, playback[0][0]),
|
|
PLAYBACK_EMPTYS * HARMONY_BUFSIZE, BUS_DMASYNC_POSTWRITE);
|
|
switch (sc->sc_cntlbits & CNTL_FORMAT_MASK) {
|
|
case CNTL_FORMAT_ULAW:
|
|
quietchar = 0x7f;
|
|
break;
|
|
case CNTL_FORMAT_ALAW:
|
|
quietchar = 0x55;
|
|
break;
|
|
case CNTL_FORMAT_SLINEAR16BE:
|
|
case CNTL_FORMAT_ULINEAR8:
|
|
default:
|
|
quietchar = 0;
|
|
break;
|
|
}
|
|
for (i = 0; i < PLAYBACK_EMPTYS; i++)
|
|
memset(&sc->sc_empty_kva->playback[i][0],
|
|
quietchar, HARMONY_BUFSIZE);
|
|
bus_dmamap_sync(sc->sc_dmat, sc->sc_empty_map,
|
|
offsetof(struct harmony_empty, playback[0][0]),
|
|
PLAYBACK_EMPTYS * HARMONY_BUFSIZE, BUS_DMASYNC_PREWRITE);
|
|
|
|
for (;;) {
|
|
/* Wait for it to come out of control mode */
|
|
reg = READ_REG(sc, HARMONY_CNTL);
|
|
if ((reg & CNTL_C) == 0)
|
|
break;
|
|
}
|
|
|
|
bus_space_write_4(sc->sc_bt, sc->sc_bh, HARMONY_CNTL,
|
|
sc->sc_cntlbits | CNTL_C);
|
|
|
|
for (;;) {
|
|
/* Wait for it to come out of control mode */
|
|
reg = READ_REG(sc, HARMONY_CNTL);
|
|
if ((reg & CNTL_C) == 0)
|
|
break;
|
|
}
|
|
|
|
sc->sc_need_commit = 0;
|
|
|
|
if (sc->sc_playing || sc->sc_capturing)
|
|
harmony_intr_enable(sc);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
harmony_halt_output(void *vsc)
|
|
{
|
|
struct harmony_softc *sc;
|
|
|
|
sc = vsc;
|
|
sc->sc_playing = 0;
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
harmony_halt_input(void *vsc)
|
|
{
|
|
struct harmony_softc *sc;
|
|
|
|
sc = vsc;
|
|
sc->sc_capturing = 0;
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
harmony_getdev(void *vsc, struct audio_device *retp)
|
|
{
|
|
struct harmony_softc *sc;
|
|
|
|
sc = vsc;
|
|
*retp = sc->sc_audev;
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
harmony_set_port(void *vsc, mixer_ctrl_t *cp)
|
|
{
|
|
struct harmony_softc *sc;
|
|
int err;
|
|
|
|
sc = vsc;
|
|
err = EINVAL;
|
|
switch (cp->dev) {
|
|
case HARMONY_PORT_INPUT_LVL:
|
|
if (cp->type != AUDIO_MIXER_VALUE)
|
|
break;
|
|
if (cp->un.value.num_channels == 1)
|
|
sc->sc_input_lvl.left = sc->sc_input_lvl.right =
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_MONO];
|
|
else if (cp->un.value.num_channels == 2) {
|
|
sc->sc_input_lvl.left =
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
|
|
sc->sc_input_lvl.right =
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT];
|
|
} else
|
|
break;
|
|
sc->sc_need_commit = 1;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_LVL:
|
|
if (cp->type != AUDIO_MIXER_VALUE)
|
|
break;
|
|
if (cp->un.value.num_channels == 1)
|
|
sc->sc_output_lvl.left = sc->sc_output_lvl.right =
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_MONO];
|
|
else if (cp->un.value.num_channels == 2) {
|
|
sc->sc_output_lvl.left =
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
|
|
sc->sc_output_lvl.right =
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT];
|
|
} else
|
|
break;
|
|
sc->sc_need_commit = 1;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_GAIN:
|
|
if (cp->type != AUDIO_MIXER_ENUM)
|
|
break;
|
|
sc->sc_outputgain = cp->un.ord ? 1 : 0;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_MONITOR_LVL:
|
|
if (cp->type != AUDIO_MIXER_VALUE)
|
|
break;
|
|
if (cp->un.value.num_channels != 1)
|
|
break;
|
|
sc->sc_monitor_lvl.left = sc->sc_input_lvl.right =
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_MONO];
|
|
sc->sc_need_commit = 1;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_RECORD_SOURCE:
|
|
if (cp->type != AUDIO_MIXER_ENUM)
|
|
break;
|
|
if (cp->un.ord != HARMONY_IN_LINE &&
|
|
cp->un.ord != HARMONY_IN_MIC)
|
|
break;
|
|
sc->sc_in_port = cp->un.ord;
|
|
err = 0;
|
|
sc->sc_need_commit = 1;
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_SOURCE:
|
|
if (cp->type != AUDIO_MIXER_ENUM)
|
|
break;
|
|
if (cp->un.ord != HARMONY_OUT_LINE &&
|
|
cp->un.ord != HARMONY_OUT_SPEAKER &&
|
|
cp->un.ord != HARMONY_OUT_HEADPHONE)
|
|
break;
|
|
sc->sc_out_port = cp->un.ord;
|
|
err = 0;
|
|
sc->sc_need_commit = 1;
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
int
|
|
harmony_get_port(void *vsc, mixer_ctrl_t *cp)
|
|
{
|
|
struct harmony_softc *sc;
|
|
int err;
|
|
|
|
sc = vsc;
|
|
err = EINVAL;
|
|
switch (cp->dev) {
|
|
case HARMONY_PORT_INPUT_LVL:
|
|
if (cp->type != AUDIO_MIXER_VALUE)
|
|
break;
|
|
if (cp->un.value.num_channels == 1) {
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] =
|
|
sc->sc_input_lvl.left;
|
|
} else if (cp->un.value.num_channels == 2) {
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
|
|
sc->sc_input_lvl.left;
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
|
|
sc->sc_input_lvl.right;
|
|
} else
|
|
break;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_INPUT_OV:
|
|
if (cp->type != AUDIO_MIXER_ENUM)
|
|
break;
|
|
cp->un.ord = sc->sc_ov ? 1 : 0;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_LVL:
|
|
if (cp->type != AUDIO_MIXER_VALUE)
|
|
break;
|
|
if (cp->un.value.num_channels == 1) {
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] =
|
|
sc->sc_output_lvl.left;
|
|
} else if (cp->un.value.num_channels == 2) {
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
|
|
sc->sc_output_lvl.left;
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
|
|
sc->sc_output_lvl.right;
|
|
} else
|
|
break;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_GAIN:
|
|
if (cp->type != AUDIO_MIXER_ENUM)
|
|
break;
|
|
cp->un.ord = sc->sc_outputgain ? 1 : 0;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_MONITOR_LVL:
|
|
if (cp->type != AUDIO_MIXER_VALUE)
|
|
break;
|
|
if (cp->un.value.num_channels != 1)
|
|
break;
|
|
cp->un.value.level[AUDIO_MIXER_LEVEL_MONO] =
|
|
sc->sc_monitor_lvl.left;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_RECORD_SOURCE:
|
|
if (cp->type != AUDIO_MIXER_ENUM)
|
|
break;
|
|
cp->un.ord = sc->sc_in_port;
|
|
err = 0;
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_SOURCE:
|
|
if (cp->type != AUDIO_MIXER_ENUM)
|
|
break;
|
|
cp->un.ord = sc->sc_out_port;
|
|
err = 0;
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
harmony_query_devinfo(void *vsc, mixer_devinfo_t *dip)
|
|
{
|
|
int err;
|
|
|
|
err = 0;
|
|
switch (dip->index) {
|
|
case HARMONY_PORT_INPUT_LVL:
|
|
dip->type = AUDIO_MIXER_VALUE;
|
|
dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioNinput, sizeof dip->label.name);
|
|
dip->un.v.num_channels = 2;
|
|
strlcpy(dip->un.v.units.name, AudioNvolume,
|
|
sizeof dip->un.v.units.name);
|
|
break;
|
|
case HARMONY_PORT_INPUT_OV:
|
|
dip->type = AUDIO_MIXER_ENUM;
|
|
dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, "overrange", sizeof dip->label.name);
|
|
dip->un.e.num_mem = 2;
|
|
strlcpy(dip->un.e.member[0].label.name, AudioNoff,
|
|
sizeof dip->un.e.member[0].label.name);
|
|
dip->un.e.member[0].ord = 0;
|
|
strlcpy(dip->un.e.member[1].label.name, AudioNon,
|
|
sizeof dip->un.e.member[1].label.name);
|
|
dip->un.e.member[1].ord = 1;
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_LVL:
|
|
dip->type = AUDIO_MIXER_VALUE;
|
|
dip->mixer_class = HARMONY_PORT_OUTPUT_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioNoutput, sizeof dip->label.name);
|
|
dip->un.v.num_channels = 2;
|
|
strlcpy(dip->un.v.units.name, AudioNvolume,
|
|
sizeof dip->un.v.units.name);
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_GAIN:
|
|
dip->type = AUDIO_MIXER_ENUM;
|
|
dip->mixer_class = HARMONY_PORT_OUTPUT_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, "gain", sizeof dip->label.name);
|
|
dip->un.e.num_mem = 2;
|
|
strlcpy(dip->un.e.member[0].label.name, AudioNoff,
|
|
sizeof dip->un.e.member[0].label.name);
|
|
dip->un.e.member[0].ord = 0;
|
|
strlcpy(dip->un.e.member[1].label.name, AudioNon,
|
|
sizeof dip->un.e.member[1].label.name);
|
|
dip->un.e.member[1].ord = 1;
|
|
break;
|
|
case HARMONY_PORT_MONITOR_LVL:
|
|
dip->type = AUDIO_MIXER_VALUE;
|
|
dip->mixer_class = HARMONY_PORT_MONITOR_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioNmonitor, sizeof dip->label.name);
|
|
dip->un.v.num_channels = 1;
|
|
strlcpy(dip->un.v.units.name, AudioNvolume,
|
|
sizeof dip->un.v.units.name);
|
|
break;
|
|
case HARMONY_PORT_RECORD_SOURCE:
|
|
dip->type = AUDIO_MIXER_ENUM;
|
|
dip->mixer_class = HARMONY_PORT_RECORD_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioNsource, sizeof dip->label.name);
|
|
dip->un.e.num_mem = 2;
|
|
strlcpy(dip->un.e.member[0].label.name, AudioNmicrophone,
|
|
sizeof dip->un.e.member[0].label.name);
|
|
dip->un.e.member[0].ord = HARMONY_IN_MIC;
|
|
strlcpy(dip->un.e.member[1].label.name, AudioNline,
|
|
sizeof dip->un.e.member[1].label.name);
|
|
dip->un.e.member[1].ord = HARMONY_IN_LINE;
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_SOURCE:
|
|
dip->type = AUDIO_MIXER_ENUM;
|
|
dip->mixer_class = HARMONY_PORT_MONITOR_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioNoutput, sizeof dip->label.name);
|
|
dip->un.e.num_mem = 3;
|
|
strlcpy(dip->un.e.member[0].label.name, AudioNline,
|
|
sizeof dip->un.e.member[0].label.name);
|
|
dip->un.e.member[0].ord = HARMONY_OUT_LINE;
|
|
strlcpy(dip->un.e.member[1].label.name, AudioNspeaker,
|
|
sizeof dip->un.e.member[1].label.name);
|
|
dip->un.e.member[1].ord = HARMONY_OUT_SPEAKER;
|
|
strlcpy(dip->un.e.member[2].label.name, AudioNheadphone,
|
|
sizeof dip->un.e.member[2].label.name);
|
|
dip->un.e.member[2].ord = HARMONY_OUT_HEADPHONE;
|
|
break;
|
|
case HARMONY_PORT_INPUT_CLASS:
|
|
dip->type = AUDIO_MIXER_CLASS;
|
|
dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioCinputs, sizeof dip->label.name);
|
|
break;
|
|
case HARMONY_PORT_OUTPUT_CLASS:
|
|
dip->type = AUDIO_MIXER_CLASS;
|
|
dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioCoutputs, sizeof dip->label.name);
|
|
break;
|
|
case HARMONY_PORT_MONITOR_CLASS:
|
|
dip->type = AUDIO_MIXER_CLASS;
|
|
dip->mixer_class = HARMONY_PORT_INPUT_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioCmonitor, sizeof dip->label.name);
|
|
break;
|
|
case HARMONY_PORT_RECORD_CLASS:
|
|
dip->type = AUDIO_MIXER_CLASS;
|
|
dip->mixer_class = HARMONY_PORT_RECORD_CLASS;
|
|
dip->prev = dip->next = AUDIO_MIXER_LAST;
|
|
strlcpy(dip->label.name, AudioCrecord, sizeof dip->label.name);
|
|
break;
|
|
default:
|
|
err = ENXIO;
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
void *
|
|
harmony_allocm(void *vsc, int dir, size_t size, struct malloc_type *pool,
|
|
int flags)
|
|
{
|
|
struct harmony_softc *sc;
|
|
struct harmony_dma *d;
|
|
int rseg;
|
|
|
|
sc = vsc;
|
|
d = malloc(sizeof(struct harmony_dma), pool, flags);
|
|
if (d == NULL)
|
|
goto fail;
|
|
|
|
if (bus_dmamap_create(sc->sc_dmat, size, 1, size, 0, BUS_DMA_NOWAIT,
|
|
&d->d_map) != 0)
|
|
goto fail1;
|
|
|
|
if (bus_dmamem_alloc(sc->sc_dmat, size, PAGE_SIZE, 0, &d->d_seg, 1,
|
|
&rseg, BUS_DMA_NOWAIT) != 0)
|
|
goto fail2;
|
|
|
|
if (bus_dmamem_map(sc->sc_dmat, &d->d_seg, 1, size, &d->d_kva,
|
|
BUS_DMA_NOWAIT) != 0)
|
|
goto fail3;
|
|
|
|
if (bus_dmamap_load(sc->sc_dmat, d->d_map, d->d_kva, size, NULL,
|
|
BUS_DMA_NOWAIT) != 0)
|
|
goto fail4;
|
|
|
|
d->d_next = sc->sc_dmas;
|
|
sc->sc_dmas = d;
|
|
d->d_size = size;
|
|
return (d->d_kva);
|
|
|
|
fail4:
|
|
bus_dmamem_unmap(sc->sc_dmat, d->d_kva, size);
|
|
fail3:
|
|
bus_dmamem_free(sc->sc_dmat, &d->d_seg, 1);
|
|
fail2:
|
|
bus_dmamap_destroy(sc->sc_dmat, d->d_map);
|
|
fail1:
|
|
free(d, pool);
|
|
fail:
|
|
return (NULL);
|
|
}
|
|
|
|
void
|
|
harmony_freem(void *vsc, void *ptr, struct malloc_type *pool)
|
|
{
|
|
struct harmony_softc *sc;
|
|
struct harmony_dma *d, **dd;
|
|
|
|
sc = vsc;
|
|
for (dd = &sc->sc_dmas; (d = *dd) != NULL; dd = &(*dd)->d_next) {
|
|
if (d->d_kva != ptr)
|
|
continue;
|
|
bus_dmamap_unload(sc->sc_dmat, d->d_map);
|
|
bus_dmamem_unmap(sc->sc_dmat, d->d_kva, d->d_size);
|
|
bus_dmamem_free(sc->sc_dmat, &d->d_seg, 1);
|
|
bus_dmamap_destroy(sc->sc_dmat, d->d_map);
|
|
free(d, pool);
|
|
return;
|
|
}
|
|
printf("%s: free rogue pointer\n", sc->sc_dv.dv_xname);
|
|
}
|
|
|
|
size_t
|
|
harmony_round_buffersize(void *vsc, int direction, size_t size)
|
|
{
|
|
|
|
return (size & (size_t)(-HARMONY_BUFSIZE));
|
|
}
|
|
|
|
int
|
|
harmony_get_props(void *vsc)
|
|
{
|
|
|
|
return AUDIO_PROP_FULLDUPLEX;
|
|
}
|
|
|
|
int
|
|
harmony_trigger_output(void *vsc, void *start, void *end, int blksize,
|
|
void (*intr)(void *), void *intrarg, const audio_params_t *param)
|
|
{
|
|
struct harmony_softc *sc;
|
|
struct harmony_channel *c;
|
|
struct harmony_dma *d;
|
|
bus_addr_t nextaddr;
|
|
bus_size_t togo;
|
|
|
|
sc = vsc;
|
|
c = &sc->sc_playback;
|
|
for (d = sc->sc_dmas; d->d_kva != start; d = d->d_next)
|
|
continue;
|
|
if (d == NULL) {
|
|
printf("%s: trigger_output: bad addr: %p\n",
|
|
sc->sc_dv.dv_xname, start);
|
|
return EINVAL;
|
|
}
|
|
|
|
c->c_intr = intr;
|
|
c->c_intrarg = intrarg;
|
|
c->c_blksz = blksize;
|
|
c->c_current = d;
|
|
c->c_segsz = (caddr_t)end - (caddr_t)start;
|
|
c->c_cnt = 0;
|
|
c->c_lastaddr = d->d_map->dm_segs[0].ds_addr;
|
|
|
|
sc->sc_playing = 1;
|
|
|
|
togo = c->c_segsz - c->c_cnt;
|
|
if (togo == 0) {
|
|
nextaddr = d->d_map->dm_segs[0].ds_addr;
|
|
c->c_cnt = togo = c->c_blksz;
|
|
} else {
|
|
nextaddr = c->c_lastaddr;
|
|
if (togo > c->c_blksz)
|
|
togo = c->c_blksz;
|
|
c->c_cnt += togo;
|
|
}
|
|
|
|
bus_dmamap_sync(sc->sc_dmat, d->d_map,
|
|
nextaddr - d->d_map->dm_segs[0].ds_addr,
|
|
c->c_blksz, BUS_DMASYNC_PREWRITE);
|
|
|
|
WRITE_REG(sc, HARMONY_PNXTADD, nextaddr);
|
|
c->c_theaddr = nextaddr;
|
|
SYNC_REG(sc, HARMONY_PNXTADD, BUS_SPACE_BARRIER_WRITE);
|
|
c->c_lastaddr = nextaddr + togo;
|
|
|
|
harmony_start_cp(sc);
|
|
harmony_intr_enable(sc);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
harmony_start_cp(struct harmony_softc *sc)
|
|
{
|
|
struct harmony_channel *c;
|
|
struct harmony_dma *d;
|
|
bus_addr_t nextaddr;
|
|
bus_size_t togo;
|
|
|
|
c = &sc->sc_capture;
|
|
if (sc->sc_capturing == 0) {
|
|
WRITE_REG(sc, HARMONY_RNXTADD,
|
|
sc->sc_capture_paddrs[sc->sc_capture_empty]);
|
|
if (++sc->sc_capture_empty == CAPTURE_EMPTYS)
|
|
sc->sc_capture_empty = 0;
|
|
} else {
|
|
d = c->c_current;
|
|
togo = c->c_segsz - c->c_cnt;
|
|
if (togo == 0) {
|
|
nextaddr = d->d_map->dm_segs[0].ds_addr;
|
|
c->c_cnt = togo = c->c_blksz;
|
|
} else {
|
|
nextaddr = c->c_lastaddr;
|
|
if (togo > c->c_blksz)
|
|
togo = c->c_blksz;
|
|
c->c_cnt += togo;
|
|
}
|
|
|
|
bus_dmamap_sync(sc->sc_dmat, d->d_map,
|
|
nextaddr - d->d_map->dm_segs[0].ds_addr,
|
|
c->c_blksz, BUS_DMASYNC_PREWRITE);
|
|
|
|
WRITE_REG(sc, HARMONY_RNXTADD, nextaddr);
|
|
SYNC_REG(sc, HARMONY_RNXTADD, BUS_SPACE_BARRIER_WRITE);
|
|
c->c_lastaddr = nextaddr + togo;
|
|
}
|
|
|
|
#if NRND > 0
|
|
callout_schedule(&sc->sc_acc_tmo, 1);
|
|
#endif
|
|
}
|
|
|
|
int
|
|
harmony_trigger_input(void *vsc, void *start, void *end, int blksize,
|
|
void (*intr)(void *), void *intrarg, const audio_params_t *param)
|
|
{
|
|
struct harmony_softc *sc;
|
|
struct harmony_channel *c;
|
|
struct harmony_dma *d;
|
|
|
|
sc = vsc;
|
|
c = &sc->sc_capture;
|
|
for (d = sc->sc_dmas; d->d_kva != start; d = d->d_next)
|
|
continue;
|
|
if (d == NULL) {
|
|
printf("%s: trigger_input: bad addr: %p\n",
|
|
sc->sc_dv.dv_xname, start);
|
|
return EINVAL;
|
|
}
|
|
|
|
c->c_intr = intr;
|
|
c->c_intrarg = intrarg;
|
|
c->c_blksz = blksize;
|
|
c->c_current = d;
|
|
c->c_segsz = (caddr_t)end - (caddr_t)start;
|
|
c->c_cnt = 0;
|
|
c->c_lastaddr = d->d_map->dm_segs[0].ds_addr;
|
|
|
|
sc->sc_capturing = 1;
|
|
harmony_start_cp(sc);
|
|
harmony_intr_enable(sc);
|
|
return 0;
|
|
}
|
|
|
|
static const struct speed_struct {
|
|
uint32_t speed;
|
|
uint32_t bits;
|
|
} harmony_speeds[] = {
|
|
{ 5125, CNTL_RATE_5125 },
|
|
{ 6615, CNTL_RATE_6615 },
|
|
{ 8000, CNTL_RATE_8000 },
|
|
{ 9600, CNTL_RATE_9600 },
|
|
{ 11025, CNTL_RATE_11025 },
|
|
{ 16000, CNTL_RATE_16000 },
|
|
{ 18900, CNTL_RATE_18900 },
|
|
{ 22050, CNTL_RATE_22050 },
|
|
{ 27428, CNTL_RATE_27428 },
|
|
{ 32000, CNTL_RATE_32000 },
|
|
{ 33075, CNTL_RATE_33075 },
|
|
{ 37800, CNTL_RATE_37800 },
|
|
{ 44100, CNTL_RATE_44100 },
|
|
{ 48000, CNTL_RATE_48000 },
|
|
};
|
|
|
|
uint32_t
|
|
harmony_speed_bits(struct harmony_softc *sc, u_int *speedp)
|
|
{
|
|
int i, n, selected;
|
|
|
|
selected = -1;
|
|
n = sizeof(harmony_speeds) / sizeof(harmony_speeds[0]);
|
|
|
|
if ((*speedp) <= harmony_speeds[0].speed)
|
|
selected = 0;
|
|
else if ((*speedp) >= harmony_speeds[n - 1].speed)
|
|
selected = n - 1;
|
|
else {
|
|
for (i = 1; selected == -1 && i < n; i++) {
|
|
if ((*speedp) == harmony_speeds[i].speed)
|
|
selected = i;
|
|
else if ((*speedp) < harmony_speeds[i].speed) {
|
|
int diff1, diff2;
|
|
|
|
diff1 = (*speedp) - harmony_speeds[i - 1].speed;
|
|
diff2 = harmony_speeds[i].speed - (*speedp);
|
|
if (diff1 < diff2)
|
|
selected = i - 1;
|
|
else
|
|
selected = i;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (selected == -1)
|
|
selected = 2;
|
|
|
|
*speedp = harmony_speeds[selected].speed;
|
|
return harmony_speeds[selected].bits;
|
|
}
|
|
|
|
int
|
|
harmony_set_gainctl(struct harmony_softc *sc)
|
|
{
|
|
uint32_t bits, mask, val, old;
|
|
|
|
/* XXX leave these bits alone or the chip will not come out of CNTL */
|
|
bits = GAINCTL_LE | GAINCTL_HE | GAINCTL_SE | GAINCTL_IS_MASK;
|
|
|
|
/* input level */
|
|
bits |= ((sc->sc_input_lvl.left >> (8 - GAINCTL_INPUT_BITS)) <<
|
|
GAINCTL_INPUT_LEFT_S) & GAINCTL_INPUT_LEFT_M;
|
|
bits |= ((sc->sc_input_lvl.right >> (8 - GAINCTL_INPUT_BITS)) <<
|
|
GAINCTL_INPUT_RIGHT_S) & GAINCTL_INPUT_RIGHT_M;
|
|
|
|
/* output level (inverted) */
|
|
mask = (1 << GAINCTL_OUTPUT_BITS) - 1;
|
|
val = mask - (sc->sc_output_lvl.left >> (8 - GAINCTL_OUTPUT_BITS));
|
|
bits |= (val << GAINCTL_OUTPUT_LEFT_S) & GAINCTL_OUTPUT_LEFT_M;
|
|
val = mask - (sc->sc_output_lvl.right >> (8 - GAINCTL_OUTPUT_BITS));
|
|
bits |= (val << GAINCTL_OUTPUT_RIGHT_S) & GAINCTL_OUTPUT_RIGHT_M;
|
|
|
|
/* monitor level (inverted) */
|
|
mask = (1 << GAINCTL_MONITOR_BITS) - 1;
|
|
val = mask - (sc->sc_monitor_lvl.left >> (8 - GAINCTL_MONITOR_BITS));
|
|
bits |= (val << GAINCTL_MONITOR_S) & GAINCTL_MONITOR_M;
|
|
|
|
/* XXX messing with these causes CNTL_C to get stuck... grr. */
|
|
bits &= ~GAINCTL_IS_MASK;
|
|
if (sc->sc_in_port == HARMONY_IN_MIC)
|
|
bits |= GAINCTL_IS_LINE;
|
|
else
|
|
bits |= GAINCTL_IS_MICROPHONE;
|
|
|
|
/* XXX messing with these causes CNTL_C to get stuck... grr. */
|
|
bits &= ~(GAINCTL_LE | GAINCTL_HE | GAINCTL_SE);
|
|
if (sc->sc_out_port == HARMONY_OUT_LINE)
|
|
bits |= GAINCTL_LE;
|
|
else if (sc->sc_out_port == HARMONY_OUT_SPEAKER)
|
|
bits |= GAINCTL_SE;
|
|
else
|
|
bits |= GAINCTL_HE;
|
|
|
|
mask = GAINCTL_LE | GAINCTL_HE | GAINCTL_SE | GAINCTL_IS_MASK;
|
|
old = bus_space_read_4(sc->sc_bt, sc->sc_bh, HARMONY_GAINCTL);
|
|
bus_space_write_4(sc->sc_bt, sc->sc_bh, HARMONY_GAINCTL, bits);
|
|
if ((old & mask) != (bits & mask))
|
|
return 1;
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
harmony_try_more(struct harmony_softc *sc)
|
|
{
|
|
struct harmony_channel *c;
|
|
struct harmony_dma *d;
|
|
uint32_t cur;
|
|
int i, nsegs;
|
|
|
|
c = &sc->sc_playback;
|
|
d = c->c_current;
|
|
cur = bus_space_read_4(sc->sc_bt, sc->sc_bh, HARMONY_PCURADD);
|
|
cur &= PCURADD_BUFMASK;
|
|
nsegs = 0;
|
|
|
|
#ifdef DIAGNOSTIC
|
|
if (cur < d->d_map->dm_segs[0].ds_addr ||
|
|
cur >= (d->d_map->dm_segs[0].ds_addr + c->c_segsz))
|
|
panic("%s: bad current %x < %lx || %x > %lx",
|
|
sc->sc_dv.dv_xname, cur, d->d_map->dm_segs[0].ds_addr, cur,
|
|
d->d_map->dm_segs[0].ds_addr + c->c_segsz);
|
|
#endif /* DIAGNOSTIC */
|
|
|
|
if (cur > c->c_theaddr) {
|
|
nsegs = (cur - c->c_theaddr) / HARMONY_BUFSIZE;
|
|
} else if (cur < c->c_theaddr) {
|
|
nsegs = (d->d_map->dm_segs[0].ds_addr + c->c_segsz -
|
|
c->c_theaddr) / HARMONY_BUFSIZE;
|
|
nsegs += (cur - d->d_map->dm_segs[0].ds_addr) /
|
|
HARMONY_BUFSIZE;
|
|
}
|
|
|
|
if (nsegs != 0 && c->c_intr != NULL) {
|
|
for (i = 0; i < nsegs; i++)
|
|
(*c->c_intr)(c->c_intrarg);
|
|
c->c_theaddr = cur;
|
|
}
|
|
}
|