#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: esm.c,v 1.67 2025/09/01 17:44:29 mlelstv Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/kmem.h>
#include <sys/device.h>
#include <sys/bus.h>
#include <sys/audioio.h>
#include <dev/audio/audio_if.h>
#include <dev/ic/ac97var.h>
#include <dev/ic/ac97reg.h>
#include <dev/pci/pcidevs.h>
#include <dev/pci/pcivar.h>
#include <dev/pci/esmreg.h>
#include <dev/pci/esmvar.h>
#define PCI_CBIO 0x10
#ifdef AUDIO_DEBUG
#define DPRINTF(l,x) do { if (esm_debug & (l)) printf x; } while(0)
#define DUMPREG(x) do { if (esm_debug & ESM_DEBUG_REG) \
esm_dump_regs(x); } while(0)
int esm_debug = 0xfffc;
#define ESM_DEBUG_CODECIO 0x0001
#define ESM_DEBUG_IRQ 0x0002
#define ESM_DEBUG_DMA 0x0004
#define ESM_DEBUG_TIMER 0x0008
#define ESM_DEBUG_REG 0x0010
#define ESM_DEBUG_PARAM 0x0020
#define ESM_DEBUG_APU 0x0040
#define ESM_DEBUG_CODEC 0x0080
#define ESM_DEBUG_PCI 0x0100
#define ESM_DEBUG_RESUME 0x0200
#else
#define DPRINTF(x,y)
#define DUMPREG(x)
#endif
#ifdef DIAGNOSTIC
#define RANGE(n, l, h) if ((n) < (l) || (n) >= (h)) \
printf (#n "=%d out of range (%d, %d) in " \
__FILE__ ", line %d\n", (n), (l), (h), __LINE__)
#else
#define RANGE(x,y,z)
#endif
#define inline inline
static inline void ringbus_setdest(struct esm_softc *, int, int);
static inline uint16_t wp_rdreg(struct esm_softc *, uint16_t);
static inline void wp_wrreg(struct esm_softc *, uint16_t, uint16_t);
static inline uint16_t wp_rdapu(struct esm_softc *, int, uint16_t);
static inline void wp_wrapu(struct esm_softc *, int, uint16_t,
uint16_t);
static inline void wp_settimer(struct esm_softc *, u_int);
static inline void wp_starttimer(struct esm_softc *);
static inline void wp_stoptimer(struct esm_softc *);
static inline void wc_wrreg(struct esm_softc *, uint16_t, uint16_t);
static inline void wc_wrchctl(struct esm_softc *, int, uint16_t);
static inline u_int calc_timer_freq(struct esm_chinfo*);
static void set_timer(struct esm_softc *);
static void esmch_set_format(struct esm_chinfo *,
const audio_params_t *);
static void esmch_combine_input(struct esm_softc *,
struct esm_chinfo *);
static bool esm_suspend(device_t, const pmf_qual_t *);
static bool esm_resume(device_t, const pmf_qual_t *);
static void esm_childdet(device_t, device_t);
static int esm_match(device_t, cfdata_t, void *);
static void esm_attach(device_t, device_t, void *);
static int esm_detach(device_t, int);
static int esm_intr(void *);
static void esm_freemem(struct esm_softc *, struct esm_dma *);
static int esm_allocmem(struct esm_softc *, size_t, size_t,
struct esm_dma *);
CFATTACH_DECL2_NEW(esm, sizeof(struct esm_softc),
esm_match, esm_attach, esm_detach, NULL, NULL, esm_childdet);
const struct audio_hw_if esm_hw_if = {
.query_format = esm_query_format,
.set_format = esm_set_format,
.round_blocksize = esm_round_blocksize,
.init_output = esm_init_output,
.init_input = esm_init_input,
.halt_output = esm_halt_output,
.halt_input = esm_halt_input,
.getdev = esm_getdev,
.set_port = esm_set_port,
.get_port = esm_get_port,
.query_devinfo = esm_query_devinfo,
.allocm = esm_malloc,
.freem = esm_free,
.round_buffersize = esm_round_buffersize,
.get_props = esm_get_props,
.trigger_output = esm_trigger_output,
.trigger_input = esm_trigger_input,
.get_locks = esm_get_locks,
};
struct audio_device esm_device = {
"ESS Maestro",
"",
"esm"
};
#define ESM_FORMAT(enc, prec, ch, chmask) \
{ \
.mode = AUMODE_PLAY | AUMODE_RECORD, \
.encoding = (enc), \
.validbits = (prec), \
.precision = (prec), \
.channels = (ch), \
.channel_mask = (chmask), \
.frequency_type = 0, \
.frequency = { 4000, 48000 }, \
}
static const struct audio_format esm_formats[] = {
ESM_FORMAT(AUDIO_ENCODING_SLINEAR_LE, 16, 2, AUFMT_STEREO),
ESM_FORMAT(AUDIO_ENCODING_SLINEAR_LE, 16, 1, AUFMT_MONAURAL),
ESM_FORMAT(AUDIO_ENCODING_ULINEAR_LE, 8, 2, AUFMT_STEREO),
ESM_FORMAT(AUDIO_ENCODING_ULINEAR_LE, 8, 1, AUFMT_MONAURAL),
};
#define ESM_NFORMATS __arraycount(esm_formats)
static const struct esm_quirks esm_quirks[] = {
{ PCI_VENDOR_COMPAL, PCI_PRODUCT_COMPAL_38W2, ESM_QUIRKF_SWAPPEDCH },
{ PCI_VENDOR_COMPAQ, PCI_PRODUCT_COMPAQ_M700, ESM_QUIRKF_SWAPPEDCH },
{ PCI_VENDOR_NEC, PCI_PRODUCT_NEC_VA26D, ESM_QUIRKF_GPIO },
{ PCI_VENDOR_NEC, PCI_PRODUCT_NEC_VERSALX, ESM_QUIRKF_GPIO },
{ PCI_VENDOR_TOSHIBA2, PCI_PRODUCT_TOSHIBA2_PORTEGE, ESM_QUIRKF_SWAPPEDCH }
};
enum esm_quirk_flags
esm_get_quirks(pcireg_t subid)
{
int i;
for (i = 0; i < __arraycount(esm_quirks); i++) {
if (PCI_VENDOR(subid) == esm_quirks[i].eq_vendor &&
PCI_PRODUCT(subid) == esm_quirks[i].eq_product) {
return esm_quirks[i].eq_quirks;
}
}
return 0;
}
#ifdef AUDIO_DEBUG
struct esm_reg_info {
int offset;
int width;
} dump_regs[] = {
{ PORT_WAVCACHE_CTRL, 2 },
{ PORT_HOSTINT_CTRL, 2 },
{ PORT_HOSTINT_STAT, 2 },
{ PORT_HWVOL_VOICE_SHADOW, 1 },
{ PORT_HWVOL_VOICE, 1 },
{ PORT_HWVOL_MASTER_SHADOW, 1 },
{ PORT_HWVOL_MASTER, 1 },
{ PORT_RINGBUS_CTRL, 4 },
{ PORT_GPIO_DATA, 2 },
{ PORT_GPIO_MASK, 2 },
{ PORT_GPIO_DIR, 2 },
{ PORT_ASSP_CTRL_A, 1 },
{ PORT_ASSP_CTRL_B, 1 },
{ PORT_ASSP_CTRL_C, 1 },
{ PORT_ASSP_INT_STAT, 1 }
};
static void
esm_dump_regs(struct esm_softc *ess)
{
int i;
printf("%s registers:", device_xname(ess->sc_dev));
for (i = 0; i < __arraycount(dump_regs); i++) {
if (i % 5 == 0)
printf("\n");
printf("0x%2.2x: ", dump_regs[i].offset);
switch(dump_regs[i].width) {
case 4:
printf("%8.8x, ", bus_space_read_4(ess->st, ess->sh,
dump_regs[i].offset));
break;
case 2:
printf("%4.4x, ", bus_space_read_2(ess->st, ess->sh,
dump_regs[i].offset));
break;
default:
printf("%2.2x, ",
bus_space_read_1(ess->st, ess->sh,
dump_regs[i].offset));
}
}
printf("\n");
}
#endif
int
esm_read_codec(void *sc, uint8_t regno, uint16_t *result)
{
struct esm_softc *ess;
unsigned t;
ess = sc;
for (t = 0; t < 20; t++) {
if ((bus_space_read_1(ess->st, ess->sh, PORT_CODEC_STAT)
& CODEC_STAT_MASK) != CODEC_STAT_PROGLESS)
break;
delay(2);
}
if (t == 20)
printf("%s: esm_read_codec() PROGLESS timed out.\n",
device_xname(ess->sc_dev));
bus_space_write_1(ess->st, ess->sh, PORT_CODEC_CMD,
CODEC_CMD_READ | regno);
delay(21);
for (t = 0; t < 20; t++) {
if ((bus_space_read_1(ess->st, ess->sh, PORT_CODEC_STAT)
& CODEC_STAT_MASK) == CODEC_STAT_RW_DONE)
break;
delay(2);
}
if (t == 20)
printf("%s: esm_read_codec() RW_DONE timed out.\n",
device_xname(ess->sc_dev));
*result = bus_space_read_2(ess->st, ess->sh, PORT_CODEC_REG);
return 0;
}
int
esm_write_codec(void *sc, uint8_t regno, uint16_t data)
{
struct esm_softc *ess;
unsigned t;
ess = sc;
for (t = 0; t < 20; t++) {
if ((bus_space_read_1(ess->st, ess->sh, PORT_CODEC_STAT)
& CODEC_STAT_MASK) != CODEC_STAT_PROGLESS)
break;
delay(2);
}
if (t == 20) {
printf("%s: esm_write_codec() PROGLESS timed out.\n",
device_xname(ess->sc_dev));
return -1;
}
bus_space_write_2(ess->st, ess->sh, PORT_CODEC_REG, data);
bus_space_write_1(ess->st, ess->sh, PORT_CODEC_CMD,
CODEC_CMD_WRITE | regno);
return 0;
}
static inline void
ringbus_setdest(struct esm_softc *ess, int src, int dest)
{
uint32_t data;
data = bus_space_read_4(ess->st, ess->sh, PORT_RINGBUS_CTRL);
data &= ~(0xfU << src);
data |= (0xfU & dest) << src;
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL, data);
}
static inline uint16_t
wp_rdreg(struct esm_softc *ess, uint16_t reg)
{
bus_space_write_2(ess->st, ess->sh, PORT_DSP_INDEX, reg);
return bus_space_read_2(ess->st, ess->sh, PORT_DSP_DATA);
}
static inline void
wp_wrreg(struct esm_softc *ess, uint16_t reg, uint16_t data)
{
bus_space_write_2(ess->st, ess->sh, PORT_DSP_INDEX, reg);
bus_space_write_2(ess->st, ess->sh, PORT_DSP_DATA, data);
}
static inline void
apu_setindex(struct esm_softc *ess, uint16_t reg)
{
int t;
wp_wrreg(ess, WPREG_CRAM_PTR, reg);
for (t = 0; t < 1000; t++) {
if (bus_space_read_2(ess->st, ess->sh, PORT_DSP_DATA) == reg)
break;
bus_space_write_2(ess->st, ess->sh, PORT_DSP_DATA, reg);
}
if (t == 1000)
printf("%s: apu_setindex() timed out.\n", device_xname(ess->sc_dev));
}
static inline uint16_t
wp_rdapu(struct esm_softc *ess, int ch, uint16_t reg)
{
uint16_t ret;
apu_setindex(ess, ((unsigned)ch << 4) + reg);
ret = wp_rdreg(ess, WPREG_DATA_PORT);
return ret;
}
static inline void
wp_wrapu(struct esm_softc *ess, int ch, uint16_t reg, uint16_t data)
{
int t;
DPRINTF(ESM_DEBUG_APU,
("wp_wrapu(%p, ch=%d, reg=0x%x, data=0x%04x)\n",
ess, ch, reg, data));
apu_setindex(ess, ((unsigned)ch << 4) + reg);
wp_wrreg(ess, WPREG_DATA_PORT, data);
for (t = 0; t < 1000; t++) {
if (bus_space_read_2(ess->st, ess->sh, PORT_DSP_DATA) == data)
break;
bus_space_write_2(ess->st, ess->sh, PORT_DSP_DATA, data);
}
if (t == 1000)
printf("%s: wp_wrapu() timed out.\n", device_xname(ess->sc_dev));
}
static inline void
wp_settimer(struct esm_softc *ess, u_int freq)
{
u_int clock;
u_int prescale, divide;
clock = 48000 << 2;
prescale = 0;
divide = (freq != 0) ? (clock / freq) : ~0;
RANGE(divide, WPTIMER_MINDIV, WPTIMER_MAXDIV);
for (; divide > 32 << 1; divide >>= 1)
prescale++;
divide = (divide + 1) >> 1;
for (; prescale < 7 && divide > 2 && !(divide & 1); divide >>= 1)
prescale++;
DPRINTF(ESM_DEBUG_TIMER,
("wp_settimer(%p, %u): clock = %u, prescale = %u, divide = %u\n",
ess, freq, clock, prescale, divide));
wp_wrreg(ess, WPREG_TIMER_ENABLE, 0);
wp_wrreg(ess, WPREG_TIMER_FREQ,
(prescale << WP_TIMER_FREQ_PRESCALE_SHIFT) | (divide - 1));
wp_wrreg(ess, WPREG_TIMER_ENABLE, 1);
}
static inline void
wp_starttimer(struct esm_softc *ess)
{
wp_wrreg(ess, WPREG_TIMER_START, 1);
}
static inline void
wp_stoptimer(struct esm_softc *ess)
{
wp_wrreg(ess, WPREG_TIMER_START, 0);
bus_space_write_2(ess->st, ess->sh, PORT_INT_STAT, 1);
}
static inline void
wc_wrreg(struct esm_softc *ess, uint16_t reg, uint16_t data)
{
bus_space_write_2(ess->st, ess->sh, PORT_WAVCACHE_INDEX, reg);
bus_space_write_2(ess->st, ess->sh, PORT_WAVCACHE_DATA, data);
}
static inline void
wc_wrchctl(struct esm_softc *ess, int ch, uint16_t data)
{
wc_wrreg(ess, ch << 3, data);
}
int
esm_attach_codec(void *sc, struct ac97_codec_if *codec_if)
{
struct esm_softc *ess;
ess = sc;
ess->codec_if = codec_if;
return 0;
}
int
esm_reset_codec(void *sc)
{
return 0;
}
enum ac97_host_flags
esm_flags_codec(void *sc)
{
struct esm_softc *ess;
ess = sc;
return ess->codec_flags;
}
void
esm_initcodec(struct esm_softc *ess)
{
uint16_t data;
DPRINTF(ESM_DEBUG_CODEC, ("esm_initcodec(%p)\n", ess));
if (bus_space_read_4(ess->st, ess->sh, PORT_RINGBUS_CTRL)
& RINGBUS_CTRL_ACLINK_ENABLED) {
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL, 0);
delay(104);
}
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL,
RINGBUS_CTRL_AC97_SWRESET);
delay(2);
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL,
RINGBUS_CTRL_ACLINK_ENABLED);
delay(21);
esm_read_codec(ess, 0, &data);
if (bus_space_read_1(ess->st, ess->sh, PORT_CODEC_STAT)
& CODEC_STAT_MASK) {
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL, 0);
delay(21);
printf("%s: will perform cold reset.\n", device_xname(ess->sc_dev));
data = bus_space_read_2(ess->st, ess->sh, PORT_GPIO_DIR);
if (pci_conf_read(ess->pc, ess->tag, 0x58) & 1)
data |= 0x10;
data |= 0x009 &
~bus_space_read_2(ess->st, ess->sh, PORT_GPIO_DATA);
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_MASK, 0xff6);
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_DIR,
data | 0x009);
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_DATA, 0x000);
delay(2);
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_DATA, 0x001);
delay(1);
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_DATA, 0x009);
delay(500000);
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_DIR, data);
delay(84);
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL,
RINGBUS_CTRL_ACLINK_ENABLED);
delay(21);
}
}
void
esm_init(struct esm_softc *ess)
{
bus_space_write_2(ess->st, ess->sh, PORT_HOSTINT_CTRL,
HOSTINT_CTRL_DSOUND_RESET);
delay(10000);
bus_space_write_2(ess->st, ess->sh, PORT_HOSTINT_CTRL, 0);
delay(10000);
bus_space_write_2(ess->st, ess->sh, PORT_HOSTINT_CTRL,
HOSTINT_CTRL_DSOUND_INT_ENABLED);
wp_wrreg(ess, WPREG_WAVE_ROMRAM,
WP_WAVE_VIRTUAL_ENABLED | WP_WAVE_DRAM_ENABLED);
bus_space_write_2(ess->st, ess->sh, PORT_WAVCACHE_CTRL,
WAVCACHE_ENABLED | WAVCACHE_WTSIZE_4MB);
esm_initcodec(ess);
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL,
RINGBUS_CTRL_RINGBUS_ENABLED | RINGBUS_CTRL_ACLINK_ENABLED);
wp_wrreg(ess, 0x8, 0xB004);
wp_wrreg(ess, 0x9, 0x001B);
wp_wrreg(ess, 0xA, 0x8000);
wp_wrreg(ess, 0xB, 0x3F37);
wp_wrreg(ess, 0xD, 0x7632);
wp_wrreg(ess, WPREG_BASE, 0x8598);
ringbus_setdest(ess, RINGBUS_SRC_ADC,
RINGBUS_DEST_STEREO | RINGBUS_DEST_DSOUND_IN);
ringbus_setdest(ess, RINGBUS_SRC_DSOUND,
RINGBUS_DEST_STEREO | RINGBUS_DEST_DAC);
bus_space_write_1(ess->st, ess->sh, PORT_ASSP_CTRL_B, 0x00);
bus_space_write_1(ess->st, ess->sh, PORT_ASSP_CTRL_A, 0x03);
bus_space_write_1(ess->st, ess->sh, PORT_ASSP_CTRL_C, 0x00);
if (esm_get_quirks(ess->subid) & ESM_QUIRKF_GPIO) {
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_MASK,
0x9ff);
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_DIR,
bus_space_read_2(ess->st, ess->sh, PORT_GPIO_DIR) |
0x600);
bus_space_write_2(ess->st, ess->sh, PORT_GPIO_DATA,
0x200);
}
DUMPREG(ess);
}
int
esm_init_output (void *sc, void *start, int size)
{
struct esm_softc *ess;
struct esm_dma *p;
ess = sc;
p = &ess->sc_dma;
if ((char *)start != (char *)p->addr + MAESTRO_PLAYBUF_OFF) {
printf("%s: esm_init_output: bad addr %p\n",
device_xname(ess->sc_dev), start);
return EINVAL;
}
ess->pch.base = DMAADDR(p) + MAESTRO_PLAYBUF_OFF;
DPRINTF(ESM_DEBUG_DMA, ("%s: pch.base = 0x%x\n",
device_xname(ess->sc_dev), ess->pch.base));
return 0;
}
int
esm_init_input (void *sc, void *start, int size)
{
struct esm_softc *ess;
struct esm_dma *p;
ess = sc;
p = &ess->sc_dma;
if ((char *)start != (char *)p->addr + MAESTRO_RECBUF_OFF) {
printf("%s: esm_init_input: bad addr %p\n",
device_xname(ess->sc_dev), start);
return EINVAL;
}
switch (ess->rch.aputype) {
case APUTYPE_16BITSTEREO:
ess->rch.base = DMAADDR(p) + MAESTRO_RECBUF_L_OFF;
break;
default:
ess->rch.base = DMAADDR(p) + MAESTRO_RECBUF_OFF;
break;
}
DPRINTF(ESM_DEBUG_DMA, ("%s: rch.base = 0x%x\n",
device_xname(ess->sc_dev), ess->rch.base));
return 0;
}
int
esm_trigger_output(void *sc, void *start, void *end, int blksize,
void (*intr)(void *), void *arg, const audio_params_t *param)
{
size_t size;
struct esm_softc *ess;
struct esm_chinfo *ch;
struct esm_dma *p;
int pan, choffset;
int i, nch;
unsigned speed, offset, wpwa, dv;
uint16_t apuch;
DPRINTF(ESM_DEBUG_DMA,
("esm_trigger_output(%p, %p, %p, 0x%x, %p, %p, %p)\n",
sc, start, end, blksize, intr, arg, param));
ess = sc;
ch = &ess->pch;
pan = 0;
nch = 1;
speed = ch->sample_rate;
apuch = ch->num << 1;
#ifdef DIAGNOSTIC
if (ess->pactive) {
printf("%s: esm_trigger_output: already running",
device_xname(ess->sc_dev));
return EINVAL;
}
#endif
ess->sc_pintr = intr;
ess->sc_parg = arg;
p = &ess->sc_dma;
if ((char *)start != (char *)p->addr + MAESTRO_PLAYBUF_OFF) {
printf("%s: esm_trigger_output: bad addr %p\n",
device_xname(ess->sc_dev), start);
return EINVAL;
}
ess->pch.blocksize = blksize;
ess->pch.apublk = blksize >> 1;
ess->pactive = 1;
size = (size_t)(((char *)end - (char *)start) >> 1);
choffset = MAESTRO_PLAYBUF_OFF;
offset = choffset >> 1;
wpwa = APU_USE_SYSMEM | ((offset >> 8) & APU_64KPAGE_MASK);
DPRINTF(ESM_DEBUG_DMA,
("choffs=0x%x, wpwa=0x%x, size=0x%lx words\n",
choffset, wpwa, (unsigned long int)size));
switch (ch->aputype) {
case APUTYPE_16BITSTEREO:
ess->pch.apublk >>= 1;
wpwa >>= 1;
size >>= 1;
offset >>= 1;
case APUTYPE_8BITSTEREO:
if (ess->codec_flags & AC97_HOST_SWAPPED_CHANNELS)
pan = 8;
else
pan = -8;
nch++;
break;
case APUTYPE_8BITLINEAR:
ess->pch.apublk <<= 1;
speed >>= 1;
break;
}
ess->pch.apubase = offset;
ess->pch.apubuf = size;
ess->pch.nextirq = ess->pch.apublk;
set_timer(ess);
wp_starttimer(ess);
dv = (((speed % 48000) << 16) + 24000) / 48000
+ ((speed / 48000) << 16);
for (i = nch-1; i >= 0; i--) {
wp_wrapu(ess, apuch + i, APUREG_WAVESPACE, wpwa & 0xff00);
wp_wrapu(ess, apuch + i, APUREG_CURPTR, offset);
wp_wrapu(ess, apuch + i, APUREG_ENDPTR, offset + size);
wp_wrapu(ess, apuch + i, APUREG_LOOPLEN, size - 1);
wp_wrapu(ess, apuch + i, APUREG_AMPLITUDE, 0xe800);
wp_wrapu(ess, apuch + i, APUREG_POSITION, 0x8f00
| (RADIUS_CENTERCIRCLE << APU_RADIUS_SHIFT)
| ((PAN_FRONT + pan) << APU_PAN_SHIFT));
wp_wrapu(ess, apuch + i, APUREG_FREQ_LOBYTE, APU_plus6dB
| ((dv & 0xff) << APU_FREQ_LOBYTE_SHIFT));
wp_wrapu(ess, apuch + i, APUREG_FREQ_HIWORD, dv >> 8);
if (ch->aputype == APUTYPE_16BITSTEREO)
wpwa |= APU_STEREO >> 1;
pan = -pan;
}
wc_wrchctl(ess, apuch, ch->wcreg_tpl);
if (nch > 1)
wc_wrchctl(ess, apuch + 1, ch->wcreg_tpl);
wp_wrapu(ess, apuch, APUREG_APUTYPE,
(ch->aputype << APU_APUTYPE_SHIFT) | APU_DMA_ENABLED | 0xf);
if (ch->wcreg_tpl & WAVCACHE_CHCTL_STEREO)
wp_wrapu(ess, apuch + 1, APUREG_APUTYPE,
(ch->aputype << APU_APUTYPE_SHIFT) | APU_DMA_ENABLED | 0xf);
return 0;
}
int
esm_trigger_input(void *sc, void *start, void *end, int blksize,
void (*intr)(void *), void *arg, const audio_params_t *param)
{
size_t size;
size_t mixsize;
struct esm_softc *ess;
struct esm_chinfo *ch;
struct esm_dma *p;
uint32_t chctl, choffset;
uint32_t speed, offset, wpwa, dv;
uint32_t mixoffset, mixdv;
int i, nch;
uint16_t apuch;
uint16_t reg;
DPRINTF(ESM_DEBUG_DMA,
("esm_trigger_input(%p, %p, %p, 0x%x, %p, %p, %p)\n",
sc, start, end, blksize, intr, arg, param));
ess = sc;
ch = &ess->rch;
nch = 1;
speed = ch->sample_rate;
apuch = ch->num << 1;
#ifdef DIAGNOSTIC
if (ess->ractive) {
printf("%s: esm_trigger_input: already running",
device_xname(ess->sc_dev));
return EINVAL;
}
#endif
ess->sc_rintr = intr;
ess->sc_rarg = arg;
p = &ess->sc_dma;
if ((char *)start != (char *)p->addr + MAESTRO_RECBUF_OFF) {
printf("%s: esm_trigger_input: bad addr %p\n",
device_xname(ess->sc_dev), start);
return EINVAL;
}
ess->rch.buffer = (void *)start;
ess->rch.offset = 0;
ess->rch.blocksize = blksize;
ess->rch.bufsize = ((char *)end - (char *)start);
ess->rch.apublk = blksize >> 1;
ess->ractive = 1;
size = (size_t)(((char *)end - (char *)start) >> 1);
choffset = MAESTRO_RECBUF_OFF;
switch (ch->aputype) {
case APUTYPE_16BITSTEREO:
size >>= 1;
choffset = MAESTRO_RECBUF_L_OFF;
ess->rch.apublk >>= 1;
nch++;
break;
case APUTYPE_16BITLINEAR:
break;
default:
ess->ractive = 0;
return EINVAL;
}
mixsize = (MAESTRO_MIXBUF_SZ >> 1) >> 1;
mixoffset = MAESTRO_MIXBUF_OFF;
ess->rch.apubase = (choffset >> 1);
ess->rch.apubuf = size;
ess->rch.nextirq = ess->rch.apublk;
set_timer(ess);
wp_starttimer(ess);
if (speed > 47999) speed = 47999;
if (speed < 4000) speed = 4000;
dv = (((speed % 48000) << 16) + 24000) / 48000
+ ((speed / 48000) << 16);
mixdv = 65536;
for (i = 0; i < nch; i++) {
for (reg = 0; reg < 15; reg++)
wp_wrapu(ess, apuch + i, reg, 0);
chctl = (DMAADDR(p) + choffset - 0x10) &
WAVCACHE_CHCTL_ADDRTAG_MASK;
wc_wrchctl(ess, apuch + i, chctl);
wp_wrapu(ess, apuch + i, APUREG_FREQ_LOBYTE, APU_plus6dB
| ((dv & 0xff) << APU_FREQ_LOBYTE_SHIFT) | 0x08);
wp_wrapu(ess, apuch + i, APUREG_FREQ_HIWORD, dv >> 8);
offset = choffset >> 1;
wpwa = APU_USE_SYSMEM | ((offset >> 8) & APU_64KPAGE_MASK);
wp_wrapu(ess, apuch + i, APUREG_WAVESPACE, wpwa);
wp_wrapu(ess, apuch + i, APUREG_CURPTR, offset);
wp_wrapu(ess, apuch + i, APUREG_ENDPTR, offset + size);
wp_wrapu(ess, apuch + i, APUREG_LOOPLEN, size - 1);
wp_wrapu(ess, apuch + i, APUREG_EFFECTS_ENV, 0x00f0);
wp_wrapu(ess, apuch + i, APUREG_AMPLITUDE, 0xe800);
wp_wrapu(ess, apuch + i, APUREG_POSITION, 0x8f00
| (RADIUS_CENTERCIRCLE << APU_RADIUS_SHIFT)
| (PAN_FRONT << APU_PAN_SHIFT));
wp_wrapu(ess, apuch + i, APUREG_ROUTE, apuch + 2 + i);
DPRINTF(ESM_DEBUG_DMA,
("choffs=0x%x, wpwa=0x%x, offset=0x%x words, size=0x%lx words\n",
choffset, wpwa, offset, (unsigned long int)size));
for (reg = 0; reg < 15; reg++)
wp_wrapu(ess, apuch + 2 + i, reg, 0);
chctl = (ess->rch.base + mixoffset - 0x10) &
WAVCACHE_CHCTL_ADDRTAG_MASK;
wc_wrchctl(ess, apuch + 2 + i, chctl);
wp_wrapu(ess, apuch + 2 + i, APUREG_FREQ_LOBYTE, APU_plus6dB
| ((mixdv & 0xff) << APU_FREQ_LOBYTE_SHIFT) | 0x08);
wp_wrapu(ess, apuch + 2 + i, APUREG_FREQ_HIWORD, mixdv >> 8);
offset = mixoffset >> 1;
wpwa = APU_USE_SYSMEM | ((offset >> 8) & APU_64KPAGE_MASK);
wp_wrapu(ess, apuch + 2 + i, APUREG_WAVESPACE, wpwa);
wp_wrapu(ess, apuch + 2 + i, APUREG_CURPTR, offset);
wp_wrapu(ess, apuch + 2 + i, APUREG_ENDPTR,
offset + mixsize);
wp_wrapu(ess, apuch + 2 + i, APUREG_LOOPLEN, mixsize);
wp_wrapu(ess, apuch + 2 + i, APUREG_EFFECTS_ENV, 0x00f0);
wp_wrapu(ess, apuch + 2 + i, APUREG_AMPLITUDE, 0xe800);
wp_wrapu(ess, apuch + 2 + i, APUREG_POSITION, 0x8f00
| (RADIUS_CENTERCIRCLE << APU_RADIUS_SHIFT)
| (PAN_FRONT << APU_PAN_SHIFT));
wp_wrapu(ess, apuch + 2 + i, APUREG_ROUTE,
ROUTE_PARALLEL + i);
DPRINTF(ESM_DEBUG_DMA,
("mixoffs=0x%x, wpwa=0x%x, offset=0x%x words, size=0x%lx words\n",
mixoffset, wpwa, offset, (unsigned long int)mixsize));
choffset += MAESTRO_RECBUF_L_SZ;
mixoffset += MAESTRO_MIXBUF_SZ >> 1;
}
wp_wrapu(ess, apuch, APUREG_APUTYPE,
(APUTYPE_RATECONV << APU_APUTYPE_SHIFT) |
APU_DMA_ENABLED | 0xf);
if (nch > 1)
wp_wrapu(ess, apuch + 1, APUREG_APUTYPE,
(APUTYPE_RATECONV << APU_APUTYPE_SHIFT) |
APU_DMA_ENABLED | 0xf);
wp_wrapu(ess, apuch + 2, APUREG_APUTYPE,
(APUTYPE_INPUTMIXER << APU_APUTYPE_SHIFT) |
APU_DMA_ENABLED | 0xf);
if (nch > 1)
wp_wrapu(ess, apuch + 3, APUREG_APUTYPE,
(APUTYPE_RATECONV << APU_APUTYPE_SHIFT) |
APU_DMA_ENABLED | 0xf);
return 0;
}
int
esm_halt_output(void *sc)
{
struct esm_softc *ess;
struct esm_chinfo *ch;
DPRINTF(ESM_DEBUG_PARAM, ("esm_halt_output(%p)\n", sc));
ess = sc;
ch = &ess->pch;
wp_wrapu(ess, (ch->num << 1), APUREG_APUTYPE,
APUTYPE_INACTIVE << APU_APUTYPE_SHIFT);
wp_wrapu(ess, (ch->num << 1) + 1, APUREG_APUTYPE,
APUTYPE_INACTIVE << APU_APUTYPE_SHIFT);
ess->pactive = 0;
if (!ess->ractive)
wp_stoptimer(ess);
return 0;
}
int
esm_halt_input(void *sc)
{
struct esm_softc *ess;
struct esm_chinfo *ch;
DPRINTF(ESM_DEBUG_PARAM, ("esm_halt_input(%p)\n", sc));
ess = sc;
ch = &ess->rch;
wp_wrapu(ess, (ch->num << 1), APUREG_APUTYPE,
APUTYPE_INACTIVE << APU_APUTYPE_SHIFT);
wp_wrapu(ess, (ch->num << 1) + 1, APUREG_APUTYPE,
APUTYPE_INACTIVE << APU_APUTYPE_SHIFT);
wp_wrapu(ess, (ch->num << 1) + 2, APUREG_APUTYPE,
APUTYPE_INACTIVE << APU_APUTYPE_SHIFT);
wp_wrapu(ess, (ch->num << 1) + 3, APUREG_APUTYPE,
APUTYPE_INACTIVE << APU_APUTYPE_SHIFT);
ess->ractive = 0;
if (!ess->pactive)
wp_stoptimer(ess);
return 0;
}
static inline u_int
calc_timer_freq(struct esm_chinfo *ch)
{
u_int freq;
freq = (ch->sample_rate + ch->apublk - 1) / ch->apublk;
DPRINTF(ESM_DEBUG_TIMER,
("calc_timer_freq(%p): rate = %u, blk = 0x%x (0x%x): freq = %u\n",
ch, ch->sample_rate, ch->apublk, ch->blocksize, freq));
return freq;
}
static void
set_timer(struct esm_softc *ess)
{
unsigned freq, freq2;
freq = 0;
if (ess->pactive)
freq = calc_timer_freq(&ess->pch);
if (ess->ractive) {
freq2 = calc_timer_freq(&ess->rch);
if (freq2 > freq)
freq = freq2;
}
KASSERT(freq != 0);
for (; freq < MAESTRO_MINFREQ; freq <<= 1)
continue;
if (freq > 0)
wp_settimer(ess, freq);
}
static void
esmch_set_format(struct esm_chinfo *ch, const audio_params_t *p)
{
uint16_t wcreg_tpl;
uint16_t aputype;
wcreg_tpl = (ch->base - 16) & WAVCACHE_CHCTL_ADDRTAG_MASK;
aputype = APUTYPE_16BITLINEAR;
if (p->channels == 2) {
wcreg_tpl |= WAVCACHE_CHCTL_STEREO;
aputype++;
}
if (p->precision == 8) {
aputype += 2;
switch (p->encoding) {
case AUDIO_ENCODING_ULINEAR:
case AUDIO_ENCODING_ULINEAR_BE:
case AUDIO_ENCODING_ULINEAR_LE:
wcreg_tpl |= WAVCACHE_CHCTL_U8;
break;
}
}
ch->wcreg_tpl = wcreg_tpl;
ch->aputype = aputype;
ch->sample_rate = p->sample_rate;
DPRINTF(ESM_DEBUG_PARAM, ("esmch_set_format: "
"numch=%u, prec=%u, tpl=0x%x, aputype=%d, rate=%u\n",
p->channels, p->precision, wcreg_tpl, aputype, p->sample_rate));
}
static void
esmch_combine_input(struct esm_softc *ess, struct esm_chinfo *ch)
{
size_t offset, resid, count;
uint32_t *dst32s;
const uint32_t *left32s, *right32s;
uint32_t left32, right32;
offset = ch->offset;
resid = ch->blocksize;
while (resid > 0) {
left32s = (const uint32_t *)((char *)ess->sc_dma.addr +
MAESTRO_RECBUF_L_OFF + offset / 2);
right32s = (const uint32_t *)((char *)ess->sc_dma.addr +
MAESTRO_RECBUF_R_OFF + offset / 2);
dst32s = (uint32_t *)((char *)ch->buffer + offset);
count = ch->bufsize - offset;
if (count > resid)
count = resid;
resid -= count;
offset += count;
if (offset == ch->bufsize)
offset = 0;
KASSERT((count & (sizeof(uint32_t) * 2 - 1)) == 0);
count /= (sizeof(uint32_t) * 2);
while (count > 0) {
left32 = *(left32s++);
right32 = *(right32s++);
#if BYTE_ORDER == LITTLE_ENDIAN
*(dst32s++) = (left32 & 0xFFFF) | (right32 << 16);
*(dst32s++) = (left32 >> 16) | (right32 & 0xFFFF0000);
#else
*(dst32s++) = (left32 & 0xFFFF0000) | (right32 >> 16);
*(dst32s++) = (left32 << 16) | (right32 & 0xFFFF);
#endif
count--;
}
}
ch->offset = offset;
}
int
esm_getdev (void *sc, struct audio_device *adp)
{
*adp = esm_device;
return 0;
}
int
esm_round_blocksize(void *sc, int blk, int mode,
const audio_params_t *param)
{
DPRINTF(ESM_DEBUG_PARAM,
("esm_round_blocksize(%p, 0x%x)", sc, blk));
blk &= ~0x3f;
if (blk < 0x40)
blk = 0x40;
DPRINTF(ESM_DEBUG_PARAM, (" = 0x%x\n", blk));
return blk;
}
int
esm_query_format(void *sc, audio_format_query_t *afp)
{
return audio_query_format(esm_formats, ESM_NFORMATS, afp);
}
int
esm_set_format(void *sc, int setmode,
const audio_params_t *play, const audio_params_t *rec,
audio_filter_reg_t *pfil, audio_filter_reg_t *rfil)
{
struct esm_softc *ess;
DPRINTF(ESM_DEBUG_PARAM,
("%s(%p, 0x%x, %p, %p)\n", __func__,
sc, setmode, play, rec));
ess = sc;
if ((setmode & AUMODE_PLAY))
esmch_set_format(&ess->pch, play);
if ((setmode & AUMODE_RECORD))
esmch_set_format(&ess->rch, rec);
return 0;
}
int
esm_set_port(void *sc, mixer_ctrl_t *cp)
{
struct esm_softc *ess;
ess = sc;
return ess->codec_if->vtbl->mixer_set_port(ess->codec_if, cp);
}
int
esm_get_port(void *sc, mixer_ctrl_t *cp)
{
struct esm_softc *ess;
ess = sc;
return ess->codec_if->vtbl->mixer_get_port(ess->codec_if, cp);
}
int
esm_query_devinfo(void *sc, mixer_devinfo_t *dip)
{
struct esm_softc *ess;
ess = sc;
return ess->codec_if->vtbl->query_devinfo(ess->codec_if, dip);
}
void *
esm_malloc(void *sc, int direction, size_t size)
{
struct esm_softc *ess;
int off;
DPRINTF(ESM_DEBUG_DMA,
("esm_malloc(%p, %d, 0x%zd)", sc, direction, size));
ess = sc;
if (ess->rings_alloced & direction) {
DPRINTF(ESM_DEBUG_DMA, (" = 0 (ENOMEM)\n"));
return 0;
}
ess->rings_alloced |= direction;
off = (direction == AUMODE_PLAY ?
MAESTRO_PLAYBUF_OFF : MAESTRO_RECBUF_OFF);
DPRINTF(ESM_DEBUG_DMA, (" = %p (DMAADDR 0x%x)\n",
(char *)ess->sc_dma.addr + off,
(int)DMAADDR(&ess->sc_dma) + off));
return (char *)ess->sc_dma.addr + off;
}
void
esm_free(void *sc, void *ptr, size_t size)
{
struct esm_softc *ess;
DPRINTF(ESM_DEBUG_DMA, ("esm_free(%p, %p, %zd)\n", sc, ptr, size));
ess = sc;
if ((char *)ptr == (char *)ess->sc_dma.addr + MAESTRO_PLAYBUF_OFF)
ess->rings_alloced &= ~AUMODE_PLAY;
else if ((char *)ptr == (char *)ess->sc_dma.addr + MAESTRO_RECBUF_OFF)
ess->rings_alloced &= ~AUMODE_RECORD;
}
size_t
esm_round_buffersize(void *sc, int direction, size_t size)
{
if (size > MAESTRO_PLAYBUF_SZ)
size = MAESTRO_PLAYBUF_SZ;
if (size > MAESTRO_RECBUF_SZ)
size = MAESTRO_RECBUF_SZ;
return size;
}
int
esm_get_props(void *sc)
{
return AUDIO_PROP_PLAYBACK | AUDIO_PROP_CAPTURE |
AUDIO_PROP_INDEPENDENT | AUDIO_PROP_FULLDUPLEX;
}
static int
esm_intr(void *sc)
{
struct esm_softc *ess;
uint16_t status;
uint16_t pos;
ess = sc;
status = bus_space_read_1(ess->st, ess->sh, PORT_HOSTINT_STAT);
if (!status)
return 0;
mutex_spin_enter(&ess->sc_intr_lock);
bus_space_write_2(ess->st, ess->sh, PORT_INT_STAT, 1);
bus_space_write_1(ess->st, ess->sh, PORT_HOSTINT_STAT, 0);
#if 0
if (status & HOSTINT_STAT_HWVOL) {
u_int delta;
delta = bus_space_read_1(ess->st, ess->sh, PORT_HWVOL_MASTER)
- 0x88;
if (delta & 0x11)
mixer_set(device_get_softc(ess->dev),
SOUND_MIXER_VOLUME, 0);
else {
mixer_set(device_get_softc(ess->dev),
SOUND_MIXER_VOLUME,
mixer_get(device_get_softc(ess->dev),
SOUND_MIXER_VOLUME)
+ ((delta >> 5) & 0x7) - 4
+ ((delta << 7) & 0x700) - 0x400);
}
bus_space_write_1(ess->st, ess->sh, PORT_HWVOL_MASTER, 0x88);
}
#endif
if (ess->pactive) {
pos = wp_rdapu(ess, ess->pch.num << 1, APUREG_CURPTR);
DPRINTF(ESM_DEBUG_IRQ, (" %4.4x/%4.4x ", pos,
wp_rdapu(ess, (ess->pch.num<<1)+1, APUREG_CURPTR)));
pos -= ess->pch.apubase;
if (pos >= ess->pch.nextirq &&
pos - ess->pch.nextirq < ess->pch.apubuf / 2) {
ess->pch.nextirq += ess->pch.apublk;
if (ess->pch.nextirq >= ess->pch.apubuf)
ess->pch.nextirq = 0;
if (ess->sc_pintr) {
DPRINTF(ESM_DEBUG_IRQ, ("P\n"));
ess->sc_pintr(ess->sc_parg);
}
}
}
if (ess->ractive) {
pos = wp_rdapu(ess, ess->rch.num << 1, APUREG_CURPTR);
DPRINTF(ESM_DEBUG_IRQ, (" %4.4x/%4.4x ", pos,
wp_rdapu(ess, (ess->rch.num<<1)+1, APUREG_CURPTR)));
pos -= ess->rch.apubase;
if (pos >= ess->rch.nextirq &&
pos - ess->rch.nextirq < ess->rch.apubuf / 2) {
ess->rch.nextirq += ess->rch.apublk;
if (ess->rch.nextirq >= ess->rch.apubuf)
ess->rch.nextirq = 0;
if (ess->sc_rintr) {
DPRINTF(ESM_DEBUG_IRQ, ("R\n"));
switch(ess->rch.aputype) {
case APUTYPE_16BITSTEREO:
esmch_combine_input(ess, &ess->rch);
break;
}
ess->sc_rintr(ess->sc_rarg);
}
}
}
mutex_spin_exit(&ess->sc_intr_lock);
return 1;
}
static void
esm_freemem(struct esm_softc *sc, struct esm_dma *p)
{
if (p->size == 0)
return;
bus_dmamap_unload(sc->dmat, p->map);
bus_dmamap_destroy(sc->dmat, p->map);
bus_dmamem_unmap(sc->dmat, p->addr, p->size);
bus_dmamem_free(sc->dmat, p->segs, p->nsegs);
p->size = 0;
}
static int
esm_allocmem(struct esm_softc *sc, size_t size, size_t align,
struct esm_dma *p)
{
int error;
p->size = size;
error = bus_dmamem_alloc(sc->dmat, p->size, align, 0,
p->segs, __arraycount(p->segs),
&p->nsegs, BUS_DMA_WAITOK);
if (error)
return error;
error = bus_dmamem_map(sc->dmat, p->segs, p->nsegs, p->size,
&p->addr, BUS_DMA_WAITOK|BUS_DMA_COHERENT);
if (error)
goto free;
error = bus_dmamap_create(sc->dmat, p->size, 1, p->size,
0, BUS_DMA_WAITOK, &p->map);
if (error)
goto unmap;
error = bus_dmamap_load(sc->dmat, p->map, p->addr, p->size, NULL,
BUS_DMA_WAITOK);
if (error)
goto destroy;
return 0;
destroy:
bus_dmamap_destroy(sc->dmat, p->map);
unmap:
bus_dmamem_unmap(sc->dmat, p->addr, p->size);
free:
bus_dmamem_free(sc->dmat, p->segs, p->nsegs);
p->size = 0;
return error;
}
static int
esm_match(device_t dev, cfdata_t match, void *aux)
{
struct pci_attach_args *pa;
pa = (struct pci_attach_args *)aux;
switch (PCI_VENDOR(pa->pa_id)) {
case PCI_VENDOR_ESSTECH:
switch (PCI_PRODUCT(pa->pa_id)) {
case PCI_PRODUCT_ESSTECH_MAESTRO1:
case PCI_PRODUCT_ESSTECH_MAESTRO2:
case PCI_PRODUCT_ESSTECH_MAESTRO2E:
return 1;
}
break;
case PCI_VENDOR_ESSTECH2:
switch (PCI_PRODUCT(pa->pa_id)) {
case PCI_PRODUCT_ESSTECH2_MAESTRO1:
return 1;
}
}
return 0;
}
static void
esm_attach(device_t parent, device_t self, void *aux)
{
struct esm_softc *ess;
struct pci_attach_args *pa;
const char *intrstr;
pci_chipset_tag_t pc;
pcitag_t tag;
pci_intr_handle_t ih;
pcireg_t csr, data;
uint16_t codec_data;
uint16_t pcmbar;
int error;
char intrbuf[PCI_INTRSTR_LEN];
ess = device_private(self);
ess->sc_dev = self;
pa = (struct pci_attach_args *)aux;
pc = pa->pa_pc;
tag = pa->pa_tag;
pci_aprint_devinfo(pa, "Audio controller");
mutex_init(&ess->sc_lock, MUTEX_DEFAULT, IPL_NONE);
mutex_init(&ess->sc_intr_lock, MUTEX_DEFAULT, IPL_AUDIO);
csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG,
csr | PCI_COMMAND_MASTER_ENABLE | PCI_COMMAND_IO_ENABLE);
if (pci_mapreg_map(pa, PCI_CBIO, PCI_MAPREG_TYPE_IO, 0,
&ess->st, &ess->sh, NULL, &ess->sz)) {
aprint_error_dev(ess->sc_dev, "can't map i/o space\n");
mutex_destroy(&ess->sc_lock);
mutex_destroy(&ess->sc_intr_lock);
return;
}
ess->pch.num = 0;
ess->rch.num = 1;
ess->dmat = pa->pa_dmat;
ess->tag = tag;
ess->pc = pc;
ess->subid = pci_conf_read(pc, tag, PCI_SUBSYS_ID_REG);
DPRINTF(ESM_DEBUG_PCI,
("%s: sub-system vendor 0x%4.4x, product 0x%4.4x\n",
device_xname(ess->sc_dev),
PCI_VENDOR(ess->subid), PCI_PRODUCT(ess->subid)));
if (pci_intr_map(pa, &ih)) {
aprint_error_dev(ess->sc_dev, "can't map interrupt\n");
mutex_destroy(&ess->sc_lock);
mutex_destroy(&ess->sc_intr_lock);
return;
}
intrstr = pci_intr_string(pc, ih, intrbuf, sizeof(intrbuf));
ess->ih = pci_intr_establish_xname(pc, ih, IPL_AUDIO, esm_intr, ess,
device_xname(self));
if (ess->ih == NULL) {
aprint_error_dev(ess->sc_dev, "can't establish interrupt");
if (intrstr != NULL)
aprint_error(" at %s", intrstr);
aprint_error("\n");
mutex_destroy(&ess->sc_lock);
mutex_destroy(&ess->sc_intr_lock);
return;
}
aprint_normal_dev(ess->sc_dev, "interrupting at %s\n", intrstr);
if ((error = pci_activate(pa->pa_pc, pa->pa_tag, self,
pci_activate_null)) && error != EOPNOTSUPP) {
aprint_error_dev(ess->sc_dev, "cannot activate %d\n", error);
mutex_destroy(&ess->sc_lock);
mutex_destroy(&ess->sc_intr_lock);
return;
}
delay(100000);
data = pci_conf_read(pc, tag, CONF_LEGACY);
pci_conf_write(pc, tag, CONF_LEGACY, data | LEGACY_DISABLED);
data = pci_conf_read(pc, tag, CONF_MAESTRO);
data |= MAESTRO_CHIBUS | MAESTRO_POSTEDWRITE | MAESTRO_DMA_PCITIMING;
data &= ~MAESTRO_SWAP_LR;
pci_conf_write(pc, tag, CONF_MAESTRO, data);
esm_init(ess);
esm_read_codec(ess, 0, &codec_data);
if (codec_data == 0x80) {
aprint_error_dev(ess->sc_dev, "PT101 codec detected!\n");
mutex_destroy(&ess->sc_lock);
mutex_destroy(&ess->sc_intr_lock);
return;
}
if (esm_get_quirks(ess->subid) & ESM_QUIRKF_SWAPPEDCH) {
ess->codec_flags |= AC97_HOST_SWAPPED_CHANNELS;
}
ess->codec_flags |= AC97_HOST_DONT_READ;
ess->host_if.arg = ess;
ess->host_if.attach = esm_attach_codec;
ess->host_if.read = esm_read_codec;
ess->host_if.write = esm_write_codec;
ess->host_if.reset = esm_reset_codec;
ess->host_if.flags = esm_flags_codec;
if (ac97_attach(&ess->host_if, self, &ess->sc_lock) != 0) {
mutex_destroy(&ess->sc_lock);
mutex_destroy(&ess->sc_intr_lock);
return;
}
if (esm_allocmem(ess, MAESTRO_DMA_SZ, MAESTRO_DMA_ALIGN,
&ess->sc_dma)) {
aprint_error_dev(ess->sc_dev, "couldn't allocate memory!\n");
mutex_destroy(&ess->sc_lock);
mutex_destroy(&ess->sc_intr_lock);
return;
}
ess->rings_alloced = 0;
for (pcmbar = WAVCACHE_PCMBAR; pcmbar < WAVCACHE_PCMBAR + 4; pcmbar++)
wc_wrreg(ess, pcmbar,
DMAADDR(&ess->sc_dma) >> WAVCACHE_BASEADDR_SHIFT);
audio_attach_mi(&esm_hw_if, ess, ess->sc_dev);
if (!pmf_device_register(self, esm_suspend, esm_resume))
aprint_error_dev(self, "couldn't establish power handler\n");
}
static void
esm_childdet(device_t self, device_t child)
{
}
static int
esm_detach(device_t self, int flags)
{
int rc;
struct esm_softc *ess = device_private(self);
if ((rc = config_detach_children(self, flags)) != 0)
return rc;
pmf_device_deregister(self);
esm_freemem(ess, &ess->sc_dma);
if (ess->codec_if != NULL) {
mutex_enter(&ess->sc_lock);
ess->codec_if->vtbl->detach(ess->codec_if);
mutex_exit(&ess->sc_lock);
}
if (ess->ih != NULL)
pci_intr_disestablish(ess->pc, ess->ih);
bus_space_unmap(ess->st, ess->sh, ess->sz);
mutex_destroy(&ess->sc_lock);
mutex_destroy(&ess->sc_intr_lock);
return 0;
}
static bool
esm_suspend(device_t dv, const pmf_qual_t *qual)
{
struct esm_softc *ess = device_private(dv);
mutex_enter(&ess->sc_lock);
mutex_spin_enter(&ess->sc_intr_lock);
wp_stoptimer(ess);
bus_space_write_2(ess->st, ess->sh, PORT_HOSTINT_CTRL, 0);
esm_halt_output(ess);
esm_halt_input(ess);
mutex_spin_exit(&ess->sc_intr_lock);
esm_write_codec(ess, AC97_REG_POWER, 0xdf00);
delay(20);
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL, 0);
delay(1);
mutex_exit(&ess->sc_lock);
return true;
}
static bool
esm_resume(device_t dv, const pmf_qual_t *qual)
{
struct esm_softc *ess = device_private(dv);
uint16_t pcmbar;
delay(100000);
mutex_enter(&ess->sc_lock);
mutex_spin_enter(&ess->sc_intr_lock);
esm_init(ess);
for (pcmbar = WAVCACHE_PCMBAR; pcmbar < WAVCACHE_PCMBAR + 4; pcmbar++)
wc_wrreg(ess, pcmbar,
DMAADDR(&ess->sc_dma) >> WAVCACHE_BASEADDR_SHIFT);
mutex_spin_exit(&ess->sc_intr_lock);
ess->codec_if->vtbl->restore_ports(ess->codec_if);
mutex_spin_enter(&ess->sc_intr_lock);
#if 0
if (mixer_reinit(dev)) {
printf("%s: unable to reinitialize the mixer\n",
device_xname(ess->sc_dev));
return ENXIO;
}
#endif
#if TODO
if (ess->pactive)
esm_start_output(ess);
if (ess->ractive)
esm_start_input(ess);
#endif
if (ess->pactive || ess->ractive) {
set_timer(ess);
wp_starttimer(ess);
}
mutex_spin_exit(&ess->sc_intr_lock);
mutex_exit(&ess->sc_lock);
return true;
}
void
esm_get_locks(void *addr, kmutex_t **intr, kmutex_t **proc)
{
struct esm_softc *esm;
esm = addr;
*intr = &esm->sc_intr_lock;
*proc = &esm->sc_lock;
}