Aren
/
NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
NetBSD/sys/dev/pci/esm.c

1418 lines
33 KiB
C
Raw Normal View History

*minor* knf
2001-01-09 09:36:13 +03:00
/* $NetBSD: esm.c,v 1.2 2001/01/09 06:36:13 lukem Exp $ */
Initial import of the Maestro 2/2e 'esm' PCI audio driver. This driver is based on the FreeBSD 'maestro' driver by Taku YAMAMOTO <taku@cent.saitama-u.ac.jp>
2001-01-08 22:54:31 +03:00
/*-
* Copyright (c) 2000, 2001 Rene Hexel <rh@netbsd.org>
* All rights reserved.
*
* Copyright (c) 2000 Taku YAMAMOTO <taku@cent.saitama-u.ac.jp>
* 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 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 AUTHOR 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.
*
* Taku Id: maestro.c,v 1.12 2000/09/06 03:32:34 taku Exp
* FreeBSD: /c/ncvs/src/sys/dev/sound/pci/maestro.c,v 1.4 2000/12/18 01:36:35 cg Exp
*/
/*
* TODO:
* - hardware volume support
* - recording
* - MIDI support
* - joystick support
* - power management hooks
*
*
* Credits:
*
* This code is based on the FreeBSD driver written by Taku YAMAMOTO
*
*
* Original credits from the FreeBSD driver:
*
* Part of this code (especially in many magic numbers) was heavily inspired
* by the Linux driver originally written by
* Alan Cox <alan.cox@linux.org>, modified heavily by
* Zach Brown <zab@zabbo.net>.
*
* busdma()-ize and buffer size reduction were suggested by
* Cameron Grant <gandalf@vilnya.demon.co.uk>.
* Also he showed me the way to use busdma() suite.
*
* Internal speaker problems on NEC VersaPro's and Dell Inspiron 7500
* were looked at by
* Munehiro Matsuda <haro@tk.kubota.co.jp>,
* who brought patches based on the Linux driver with some simplification.
*/
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/device.h>
#include <machine/bus.h>
#include <sys/audioio.h>
#include <dev/audio_if.h>
#include <dev/mulaw.h>
#include <dev/auconv.h>
#include <dev/ic/ac97var.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 /* Configuration Base I/O Address */
/* Debug */
#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
#else
#define DPRINTF(x,y) /* nothing */
#define DUMPREG(x) /* nothing */
#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) /* nothing */
#endif
#define inline __inline
static inline void ringbus_setdest(struct esm_softc *, int, int);
static inline u_int16_t wp_rdreg(struct esm_softc *, u_int16_t);
static inline void wp_wrreg(struct esm_softc *, u_int16_t, u_int16_t);
static inline u_int16_t wp_rdapu(struct esm_softc *, int, u_int16_t);
static inline void wp_wrapu(struct esm_softc *, int, u_int16_t,
u_int16_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 u_int16_t wc_rdreg(struct esm_softc *, u_int16_t);
static inline void wc_wrreg(struct esm_softc *, u_int16_t, u_int16_t);
static inline u_int16_t wc_rdchctl(struct esm_softc *, int);
static inline void wc_wrchctl(struct esm_softc *, int, u_int16_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 *,
struct audio_params *p);
struct cfattach esm_ca = {
sizeof(struct esm_softc), esm_match, esm_attach
};
struct audio_hw_if esm_hw_if = {
esm_open,
esm_close,
NULL, /* drain */
esm_query_encoding,
esm_set_params,
esm_round_blocksize,
NULL, /* commit_settings */
esm_init_output,
NULL, /* init_input */
NULL, /* start_output */
NULL, /* start_input */
esm_halt_output,
esm_halt_input,
NULL, /* speaker_ctl */
esm_getdev,
NULL, /* getfd */
esm_set_port,
esm_get_port,
esm_query_devinfo,
esm_malloc,
esm_free,
esm_round_buffersize,
esm_mappage,
esm_get_props,
esm_trigger_output,
esm_trigger_input
};
struct audio_device esm_device = {
"ESS Maestro",
"",
"esm"
};
static audio_encoding_t esm_encoding[] = {
{ 0, AudioEulinear, AUDIO_ENCODING_ULINEAR, 8, 0 },
{ 1, AudioEmulaw, AUDIO_ENCODING_ULAW, 8,
AUDIO_ENCODINGFLAG_EMULATED },
{ 2, AudioEalaw, AUDIO_ENCODING_ALAW, 8, AUDIO_ENCODINGFLAG_EMULATED },
{ 3, AudioEslinear, AUDIO_ENCODING_SLINEAR, 8, 0 },
{ 4, AudioEslinear_le, AUDIO_ENCODING_SLINEAR_LE, 16, 0 },
{ 5, AudioEulinear_le, AUDIO_ENCODING_ULINEAR_LE, 16,
AUDIO_ENCODINGFLAG_EMULATED },
{ 6, AudioEslinear_be, AUDIO_ENCODING_SLINEAR_BE, 16,
AUDIO_ENCODINGFLAG_EMULATED },
{ 7, AudioEulinear_be, AUDIO_ENCODING_ULINEAR_BE, 16,
AUDIO_ENCODINGFLAG_EMULATED },
};
#define MAESTRO_NENCODINGS 8
#ifdef AUDIO_DEBUG
struct esm_reg_info {
int offset; /* register offset */
int width; /* 1/2/4 bytes */
} 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 },
{ -1, -1 }
};
*minor* knf
2001-01-09 09:36:13 +03:00
static void
esm_dump_regs(struct esm_softc *ess)
Initial import of the Maestro 2/2e 'esm' PCI audio driver. This driver is based on the FreeBSD 'maestro' driver by Taku YAMAMOTO <taku@cent.saitama-u.ac.jp>
2001-01-08 22:54:31 +03:00
{
int i = 0;
printf("%s registers:", ess->sc_dev.dv_xname);
while (dump_regs[i].offset != -1) {
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));
}
i++;
}
printf("\n");
}
#endif
/* -----------------------------
* Subsystems.
*/
/* Codec/Ringbus */
/* -------------------------------------------------------------------- */
int
esm_read_codec(void *sc, u_int8_t regno, u_int16_t *result)
{
struct esm_softc *ess = sc;
unsigned t;
/* We have to wait for a SAFE time to write addr/data */
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); /* 20.8us / 13 */
}
if (t == 20)
printf("%s: esm_read_codec() PROGLESS timed out.\n",
ess->sc_dev.dv_xname);
bus_space_write_1(ess->st, ess->sh, PORT_CODEC_CMD,
CODEC_CMD_READ | regno);
delay(21); /* AC97 cycle = 20.8usec */
/* Wait for data retrieve */
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); /* 20.8us / 13 */
}
if (t == 20)
/* Timed out, but perform dummy read. */
printf("%s: esm_read_codec() RW_DONE timed out.\n",
ess->sc_dev.dv_xname);
*result = bus_space_read_2(ess->st, ess->sh, PORT_CODEC_REG);
return 0;
}
int
esm_write_codec(void *sc, u_int8_t regno, u_int16_t data)
{
struct esm_softc *ess = sc;
unsigned t;
/* We have to wait for a SAFE time to write addr/data */
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); /* 20.8us / 13 */
}
if (t == 20) {
/* Timed out. Abort writing. */
printf("%s: esm_write_codec() PROGLESS timed out.\n",
ess->sc_dev.dv_xname);
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)
{
u_int32_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);
}
/* Wave Processor */
static inline u_int16_t
wp_rdreg(struct esm_softc *ess, u_int16_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, u_int16_t reg, u_int16_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, u_int16_t reg)
{
int t;
wp_wrreg(ess, WPREG_CRAM_PTR, reg);
/* Sometimes WP fails to set apu register index. */
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", ess->sc_dev.dv_xname);
}
static inline u_int16_t
wp_rdapu(struct esm_softc *ess, int ch, u_int16_t reg)
{
u_int16_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, u_int16_t reg, u_int16_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", ess->sc_dev.dv_xname);
}
static inline void
wp_settimer(struct esm_softc *ess, u_int freq)
{
u_int clock = 48000 << 2;
u_int 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);
}
/* WaveCache */
static inline u_int16_t
wc_rdreg(struct esm_softc *ess, u_int16_t reg)
{
bus_space_write_2(ess->st, ess->sh, PORT_WAVCACHE_INDEX, reg);
return bus_space_read_2(ess->st, ess->sh, PORT_WAVCACHE_DATA);
}
static inline void
wc_wrreg(struct esm_softc *ess, u_int16_t reg, u_int16_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 u_int16_t
wc_rdchctl(struct esm_softc *ess, int ch)
{
return wc_rdreg(ess, ch << 3);
}
static inline void
wc_wrchctl(struct esm_softc *ess, int ch, u_int16_t data)
{
wc_wrreg(ess, ch << 3, data);
}
/* Power management */
void
esm_power(struct esm_softc *ess, int status)
{
u_int8_t data;
data = pci_conf_read(ess->pc, ess->tag, CONF_PM_PTR);
if ((pci_conf_read(ess->pc, ess->tag, data) & 0xff) == PPMI_CID)
pci_conf_write(ess->pc, ess->tag, data + PM_CTRL, status);
}
/* -----------------------------
* Controller.
*/
int
esm_attach_codec(void *sc, struct ac97_codec_if *codec_if)
{
struct esm_softc *ess = sc;
ess->codec_if = codec_if;
return 0;
}
void
esm_reset_codec(void *sc)
{
}
void
esm_initcodec(struct esm_softc *ess)
{
u_int16_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); /* 20.8us * (4 + 1) */
}
/* XXX - 2nd codec should be looked at. */
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);
/* Try cold reset. */
printf("%s: will perform cold reset.\n", ess->sc_dev.dv_xname);
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); /* 20.8us * 4 */
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL,
RINGBUS_CTRL_ACLINK_ENABLED);
delay(21);
}
}
void
esm_init(struct esm_softc *ess)
{
/* Reset direct sound. */
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);
/* Enable direct sound interruption. */
bus_space_write_2(ess->st, ess->sh, PORT_HOSTINT_CTRL,
HOSTINT_CTRL_DSOUND_INT_ENABLED);
/* Setup Wave Processor. */
/* Enable WaveCache */
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);
/* Setup Codec/Ringbus. */
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, WPREG_BASE, 0x8500); /* Parallel I/O */
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);
/* Setup ASSP. Needed for Dell Inspiron 7500? */
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);
/*
* Setup GPIO.
* There seems to be speciality with NEC systems.
*/
switch (PCI_VENDOR(ess->subid)) {
case PCI_VENDOR_NEC:
switch (PCI_PRODUCT(ess->subid)) {
case PCI_PRODUCT_NEC_VERSALX:
case PCI_PRODUCT_NEC_VA26D:
/* Matthew Braithwaite <matt@braithwaite.net> reported
* that NEC Versa LX doesn't need GPIO operation. */
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);
break;
}
break;
}
DUMPREG(ess);
}
/* Channel controller. */
int
esm_init_output (void *sc, void *start, int size)
{
struct esm_softc *ess = sc;
struct esm_dma *p;
u_int32_t data;
for (p = ess->sc_dmas; p && KERNADDR(p) != start; p = p->next)
;
if (!p) {
printf("%s: esm_init_output: bad addr %p\n",
ess->sc_dev.dv_xname, start);
return EINVAL;
}
ess->pch.base = DMAADDR(p) & ~0xFFF;
DPRINTF(ESM_DEBUG_DMA, ("%s: pch.base = 0x%x\n",
ess->sc_dev.dv_xname, ess->pch.base));
/* set DMA base address */
for (data = WAVCACHE_PCMBAR; data < WAVCACHE_PCMBAR + 4; data++)
wc_wrreg(ess, data, ess->pch.base >> WAVCACHE_BASEADDR_SHIFT);
return 0;
}
int
esm_trigger_output(void *sc, void *start, void *end, int blksize,
void (*intr)(void *), void *arg, struct audio_params *param)
{
struct esm_softc *ess = sc;
struct esm_chinfo *ch = &ess->pch;
struct esm_dma *p;
int pan = 0, choffset;
unsigned speed = ch->sample_rate, offset, wpwa, dv;
size_t size;
u_int16_t apuch = ch->num << 1;
DPRINTF(ESM_DEBUG_DMA,
("esm_trigger_output(%p, %p, %p, 0x%x, %p, %p, %p)\n",
sc, start, end, blksize, intr, arg, param));
#ifdef DIAGNOSTIC
if (ess->pactive) {
printf("%s: esm_trigger_output: already running",
ess->sc_dev.dv_xname);
return EINVAL;
}
#endif
ess->sc_pintr = intr;
ess->sc_parg = arg;
for (p = ess->sc_dmas; p && KERNADDR(p) != start; p = p->next)
;
if (!p) {
printf("%s: esm_trigger_output: bad addr %p\n",
ess->sc_dev.dv_xname, start);
return EINVAL;
}
ess->pch.blocksize = blksize;
ess->pch.apublk = blksize >> 1;
ess->pactive = 1;
size = (size_t)(((caddr_t)end - (caddr_t)start) >> 1);
choffset = DMAADDR(p) - ess->pch.base;
offset = choffset >> 1;
wpwa = APU_USE_SYSMEM | (offset >> 9);
DPRINTF(ESM_DEBUG_DMA,
("choffs=0x%x, wpwa=0x%x, size=0x%x words\n",
choffset, wpwa, size));
switch (ch->aputype) {
case APUTYPE_16BITSTEREO:
ess->pch.apublk >>= 1;
wpwa >>= 1;
size >>= 1;
offset >>= 1;
/* FALLTHROUGH */
case APUTYPE_8BITSTEREO:
pan = 8;
apuch++;
break;
case APUTYPE_8BITLINEAR:
ess->pch.apublk <<= 1;
speed >>= 1;
break;
}
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);
do {
wp_wrapu(ess, apuch, APUREG_WAVESPACE, wpwa & 0xff00);
wp_wrapu(ess, apuch, APUREG_CURPTR, offset);
wp_wrapu(ess, apuch, APUREG_ENDPTR, offset + size);
wp_wrapu(ess, apuch, APUREG_LOOPLEN, size - 1);
wp_wrapu(ess, apuch, APUREG_AMPLITUDE, 0xe800);
wp_wrapu(ess, apuch, APUREG_POSITION, 0x8f00
| (RADIUS_CENTERCIRCLE << APU_RADIUS_SHIFT)
| ((PAN_FRONT + pan) << APU_PAN_SHIFT));
wp_wrapu(ess, apuch, APUREG_FREQ_LOBYTE, APU_plus6dB
| ((dv & 0xff) << APU_FREQ_LOBYTE_SHIFT));
wp_wrapu(ess, apuch, APUREG_FREQ_HIWORD, dv >> 8);
if (ch->aputype == APUTYPE_16BITSTEREO)
wpwa |= APU_STEREO >> 1;
pan = -pan;
} while (pan < 0 && apuch--);
wc_wrchctl(ess, apuch, ch->wcreg_tpl);
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, struct audio_params *param)
{
return 0;
}
int
esm_halt_output(void *sc)
{
struct esm_softc *ess = sc;
struct esm_chinfo *ch = &ess->pch;
DPRINTF(ESM_DEBUG_PARAM, ("esm_halt_output(%p)\n", sc));
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)
{
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 = 0, freq2;
if (ess->pactive)
freq = calc_timer_freq(&ess->pch);
if (ess->ractive) {
freq2 = calc_timer_freq(&ess->rch);
if (freq2 < freq)
freq = freq2;
}
for (; freq < MAESTRO_MINFREQ; freq <<= 1)
;
if (freq > 0)
wp_settimer(ess, freq);
}
static void
esmch_set_format(struct esm_chinfo *ch, struct audio_params *p)
{
u_int16_t wcreg_tpl = (ch->base - 16) & WAVCACHE_CHCTL_ADDRTAG_MASK;
u_int16_t aputype = APUTYPE_16BITLINEAR;
if (p->channels == 2) {
wcreg_tpl |= WAVCACHE_CHCTL_STEREO;
aputype++;
}
if (p->precision * p->factor == 8) {
aputype += 2;
if (p->encoding == AUDIO_ENCODING_ULINEAR)
wcreg_tpl |= WAVCACHE_CHCTL_U8;
}
ch->wcreg_tpl = wcreg_tpl;
ch->aputype = aputype;
ch->sample_rate = p->sample_rate;
DPRINTF(ESM_DEBUG_PARAM, ("esmch_set_format: "
"numch=%d, prec=%d*%d, tpl=0x%x, aputype=%d, rate=%ld\n",
p->channels, p->precision, p->factor, wcreg_tpl, aputype,
p->sample_rate));
}
/*
* Audio interface glue functions
*/
int
esm_open(void *sc, int flags)
{
DPRINTF(ESM_DEBUG_PARAM, ("esm_open(%p, 0x%x)\n", sc, flags));
return 0;
}
void
esm_close(void *sc)
{
DPRINTF(ESM_DEBUG_PARAM, ("esm_close(%p)\n", sc));
}
int
esm_getdev (void *sc, struct audio_device *adp)
{
*adp = esm_device;
return 0;
}
int
esm_round_blocksize (void *sc, int blk)
{
DPRINTF(ESM_DEBUG_PARAM,
("esm_round_blocksize(%p, 0x%x)", sc, blk));
blk &= ~0x3f; /* keep good alignment */
DPRINTF(ESM_DEBUG_PARAM, (" = 0x%x\n", blk));
return blk;
}
int
esm_query_encoding(void *sc, struct audio_encoding *fp)
{
DPRINTF(ESM_DEBUG_PARAM,
("esm_query_encoding(%p, %d)\n", sc, fp->index));
if (fp->index < 0 || fp->index >= MAESTRO_NENCODINGS)
return EINVAL;
*fp = esm_encoding[fp->index];
return 0;
}
int
esm_set_params(void *sc, int setmode, int usemode,
struct audio_params *play, struct audio_params *rec)
{
struct esm_softc *ess = sc;
struct audio_params *p;
int mode;
DPRINTF(ESM_DEBUG_PARAM,
("esm_set_params(%p, 0x%x, 0x%x, %p, %p)\n",
sc, setmode, usemode, play, rec));
for (mode = AUMODE_RECORD; mode != -1;
mode = mode == AUMODE_RECORD ? AUMODE_PLAY : -1) {
if ((setmode & mode) == 0)
continue;
p = mode == AUMODE_PLAY ? play : rec;
if (p->sample_rate < 4000 || p->sample_rate > 48000 ||
(p->precision != 8 && p->precision != 16) ||
(p->channels != 1 && p->channels != 2))
return EINVAL;
p->factor = 1;
p->sw_code = 0;
switch (p->encoding) {
case AUDIO_ENCODING_SLINEAR_BE:
if (p->precision == 16)
p->sw_code = swap_bytes;
else
p->sw_code = change_sign8;
break;
case AUDIO_ENCODING_SLINEAR_LE:
if (p->precision != 16)
p->sw_code = change_sign8;
break;
case AUDIO_ENCODING_ULINEAR_BE:
if (p->precision == 16) {
if (mode == AUMODE_PLAY)
p->sw_code = swap_bytes_change_sign16_le;
else
p->sw_code = change_sign16_swap_bytes_le;
}
break;
case AUDIO_ENCODING_ULINEAR_LE:
if (p->precision == 16)
p->sw_code = change_sign16_le;
break;
case AUDIO_ENCODING_ULAW:
if (mode == AUMODE_PLAY) {
p->factor = 2;
p->sw_code = mulaw_to_slinear16_le;
} else
p->sw_code = ulinear8_to_mulaw;
break;
case AUDIO_ENCODING_ALAW:
if (mode == AUMODE_PLAY) {
p->factor = 2;
p->sw_code = alaw_to_slinear16_le;
} else
p->sw_code = ulinear8_to_alaw;
break;
default:
return EINVAL;
}
}
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 = 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 = 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 = sc;
return (ess->codec_if->vtbl->query_devinfo(ess->codec_if, dip));
}
void *
esm_malloc(void *sc, int direction, size_t size, int pool, int flags)
{
struct esm_softc *ess = sc;
struct esm_dma *p;
int error;
DPRINTF(ESM_DEBUG_DMA,
("esm_malloc(%p, %d, 0x%x, 0x%x, 0x%x)",
sc, direction, size, pool, flags));
p = malloc(sizeof(*p), pool, flags);
if (!p)
return 0;
error = esm_allocmem(ess, size, 16, p);
if (error) {
free(p, pool);
DPRINTF(ESM_DEBUG_DMA, (" = 0 (ENOMEM)\n"));
return 0;
}
p->next = ess->sc_dmas;
ess->sc_dmas = p;
DPRINTF(ESM_DEBUG_DMA,
(": KERNADDR(%p) = %p (DMAADDR 0x%x)\n", p, KERNADDR(p), (int)DMAADDR(p)));
return KERNADDR(p);
}
void
esm_free(void *sc, void *ptr, int pool)
{
struct esm_softc *ess = sc;
struct esm_dma *p, **pp;
DPRINTF(ESM_DEBUG_DMA,
("esm_free(%p, %p, 0x%x)\n",
sc, ptr, pool));
for (pp = &ess->sc_dmas; (p = *pp) != NULL; pp = &p->next) {
if (KERNADDR(p) == ptr) {
esm_freemem(ess, p);
*pp = p->next;
free(p, pool);
return;
}
}
}
size_t
esm_round_buffersize(void *sc, int direction, size_t size)
{
return size;
}
paddr_t
esm_mappage(void *sc, void *mem, off_t off, int prot)
{
struct esm_softc *ess = sc;
struct esm_dma *p;
DPRINTF(ESM_DEBUG_DMA,
("esm_mappage(%p, %p, 0x%lx, 0x%x)\n",
sc, mem, (unsigned long)off, prot));
if (off < 0)
return (-1);
for (p = ess->sc_dmas; p && KERNADDR(p) != mem; p = p->next)
;
if (!p)
return (-1);
return bus_dmamem_mmap(ess->dmat, p->segs, p->nsegs, off,
prot, BUS_DMA_WAITOK);
}
int
esm_get_props(void *sc)
{
return AUDIO_PROP_MMAP | AUDIO_PROP_INDEPENDENT | AUDIO_PROP_FULLDUPLEX;
}
/* -----------------------------
* Bus space.
*/
int
esm_intr(void *sc)
{
struct esm_softc *ess = sc;
u_int16_t status;
u_int16_t pos;
int ret = 0;
status = bus_space_read_1(ess->st, ess->sh, PORT_HOSTINT_STAT);
if (!status)
return 0;
/* Acknowledge all. */
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 /* XXX - HWVOL */
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);
ret++;
}
#endif /* XXX - HWVOL */
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)));
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);
}
}
ret++;
}
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)));
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"));
ess->sc_rintr(ess->sc_parg);
}
}
ret++;
}
return ret;
}
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, sizeof(p->segs)/sizeof(p->segs[0]),
&p->nsegs, BUS_DMA_NOWAIT);
if (error)
return error;
error = bus_dmamem_map(sc->dmat, p->segs, p->nsegs, p->size,
&p->addr, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
if (error)
goto free;
error = bus_dmamap_create(sc->dmat, p->size, 1, p->size,
0, BUS_DMA_NOWAIT, &p->map);
if (error)
goto unmap;
error = bus_dmamap_load(sc->dmat, p->map, p->addr, p->size, NULL,
BUS_DMA_NOWAIT);
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);
return error;
}
int
esm_freemem(struct esm_softc *sc, struct esm_dma *p)
{
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);
return 0;
}
int
esm_match(struct device *dev, struct cfdata *match, void *aux)
{
struct pci_attach_args *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;
}
case PCI_VENDOR_ESSTECH2:
switch (PCI_PRODUCT(pa->pa_id)) {
case PCI_PRODUCT_ESSTECH2_MAESTRO1:
return 1;
}
}
return 0;
}
void
esm_attach(struct device *parent, struct device *self, void *aux)
{
struct esm_softc *ess = (struct esm_softc *)self;
struct pci_attach_args *pa = (struct pci_attach_args *)aux;
pci_chipset_tag_t pc = pa->pa_pc;
pcitag_t tag = pa->pa_tag;
pci_intr_handle_t ih;
pcireg_t csr, data;
u_int16_t codec_data;
const char *intrstr;
int revision;
char devinfo[256];
pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo);
revision = PCI_REVISION(pa->pa_class);
printf(": %s (rev. 0x%02x)\n", devinfo, revision);
/* Enable the device. */
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);
/* Map I/O register */
if (pci_mapreg_map(pa, PCI_CBIO, PCI_MAPREG_TYPE_IO, 0,
&ess->st, &ess->sh, NULL, NULL)) {
printf("%s: can't map i/o space\n", ess->sc_dev.dv_xname);
return;
}
/* Initialize softc */
ess->pch.num = 0;
ess->rch.num = 2;
ess->dmat = pa->pa_dmat;
ess->tag = tag;
ess->pc = pc;
ess->subid = pci_conf_read(pc, tag, PCI_SUBSYS_ID_REG);
/* Map and establish the interrupt. */
if (pci_intr_map(pa, &ih)) {
printf("%s: can't map interrupt\n", ess->sc_dev.dv_xname);
return;
}
intrstr = pci_intr_string(pc, ih);
ess->ih = pci_intr_establish(pc, ih, IPL_AUDIO, esm_intr, self);
if (ess->ih == NULL) {
printf("%s: can't establish interrupt", ess->sc_dev.dv_xname);
if (intrstr != NULL)
printf(" at %s", intrstr);
printf("\n");
return;
}
printf("%s: interrupting at %s\n", ess->sc_dev.dv_xname, intrstr);
/*
* Setup PCI config registers
*/
/* set to power state D0 */
esm_power(ess, PPMI_D0);
delay(100000);
/* Disable all legacy emulations. */
data = pci_conf_read(pc, tag, CONF_LEGACY);
pci_conf_write(pc, tag, CONF_LEGACY, data | LEGACY_DISABLED);
/* Disconnect from CHI. (Makes Dell inspiron 7500 work?)
* Enable posted write.
* Prefer PCI timing rather than that of ISA.
* Don't swap L/R. */
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);
/* initialize sound chip */
esm_init(ess);
esm_read_codec(ess, 0, &codec_data);
if (codec_data == 0x80) {
printf("%s: PT101 codec detected!\n", ess->sc_dev.dv_xname);
return;
}
/* initialize AC97 host interface */
ess->host_if.arg = self;
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;
if (ac97_attach(&ess->host_if) != 0)
return;
audio_attach_mi(&esm_hw_if, self, &ess->sc_dev);
}
#if 0
int
esm_suspend(struct esm_softc *ess)
{
int i, x;
x = splaudio();
wp_stoptimer(ess);
bus_space_write_2(ess->st, ess->sh, PORT_HOSTINT_CTRL, 0);
esm_halt_output(ess);
esm_halt_input(ess);
splx(x);
/* Power down everything except clock. */
esm_write_codec(ess, AC97_REG_POWER, 0xdf00);
delay(20);
bus_space_write_4(ess->st, ess->sh, PORT_RINGBUS_CTRL, 0);
delay(1);
esm_power(ess, PPMI_D3);
return 0;
}
int
esm_resume(struct esm_softc *ess)
{
int i, x;
esm_power(ess, PPMI_D0);
delay(100000);
esm_init(ess);
if (mixer_reinit(dev)) {
printf("%s: unable to reinitialize the mixer\n",
ess->sc_dev.dv_xname);
return ENXIO;
}
x = splaudio();
if (ess->pactive)
esm_start_output(ess);
if (ess->ractive)
esm_start_input(ess);
if (ess->pactive || ess->ractive) {
set_timer(ess);
wp_starttimer(ess);
}
splx(x);
return 0;
}
int
esm_shutdown(struct esm_softc *ess)
{
int i;
wp_stoptimer(ess);
bus_space_write_2(ess->st, ess->sh, PORT_HOSTINT_CTRL, 0);
esm_halt_output(ess);
esm_halt_input(ess);
return 0;
}
#endif