856a6fe4f4
Signed-off-by: Richard Henderson <richard.henderson@linaro.org> Message-Id: <20231221031652.119827-24-richard.henderson@linaro.org>
914 lines
27 KiB
C
914 lines
27 KiB
C
/*
|
|
* QEMU ES1370 emulation
|
|
*
|
|
* Copyright (c) 2005 Vassili Karpov (malc)
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
|
|
#define DEBUG_ES1370 0
|
|
#define VERBOSE_ES1370 0
|
|
|
|
#include "qemu/osdep.h"
|
|
#include "hw/audio/soundhw.h"
|
|
#include "audio/audio.h"
|
|
#include "hw/pci/pci_device.h"
|
|
#include "migration/vmstate.h"
|
|
#include "qemu/cutils.h"
|
|
#include "qemu/module.h"
|
|
#include "sysemu/dma.h"
|
|
#include "qom/object.h"
|
|
#include "trace.h"
|
|
|
|
/* Missing stuff:
|
|
SCTRL_P[12](END|ST)INC
|
|
SCTRL_P1SCTRLD
|
|
SCTRL_P2DACSEN
|
|
CTRL_DAC_SYNC
|
|
MIDI
|
|
non looped mode
|
|
surely more
|
|
*/
|
|
|
|
/*
|
|
Following macros and samplerate array were copied verbatim from
|
|
Linux kernel 2.4.30: drivers/sound/es1370.c
|
|
|
|
Copyright (C) 1998-2001, 2003 Thomas Sailer (t.sailer@alumni.ethz.ch)
|
|
*/
|
|
|
|
/* Start blatant GPL violation */
|
|
|
|
#define ES1370_REG_CONTROL 0x00
|
|
#define ES1370_REG_STATUS 0x04
|
|
#define ES1370_REG_UART_DATA 0x08
|
|
#define ES1370_REG_UART_STATUS 0x09
|
|
#define ES1370_REG_UART_CONTROL 0x09
|
|
#define ES1370_REG_UART_TEST 0x0a
|
|
#define ES1370_REG_MEMPAGE 0x0c
|
|
#define ES1370_REG_CODEC 0x10
|
|
#define ES1370_REG_SERIAL_CONTROL 0x20
|
|
#define ES1370_REG_DAC1_SCOUNT 0x24
|
|
#define ES1370_REG_DAC2_SCOUNT 0x28
|
|
#define ES1370_REG_ADC_SCOUNT 0x2c
|
|
|
|
#define ES1370_REG_DAC1_FRAMEADR 0xc30
|
|
#define ES1370_REG_DAC1_FRAMECNT 0xc34
|
|
#define ES1370_REG_DAC2_FRAMEADR 0xc38
|
|
#define ES1370_REG_DAC2_FRAMECNT 0xc3c
|
|
#define ES1370_REG_ADC_FRAMEADR 0xd30
|
|
#define ES1370_REG_ADC_FRAMECNT 0xd34
|
|
#define ES1370_REG_PHANTOM_FRAMEADR 0xd38
|
|
#define ES1370_REG_PHANTOM_FRAMECNT 0xd3c
|
|
|
|
static const unsigned dac1_samplerate[] = { 5512, 11025, 22050, 44100 };
|
|
|
|
#define DAC2_SRTODIV(x) (((1411200+(x)/2)/(x))-2)
|
|
#define DAC2_DIVTOSR(x) (1411200/((x)+2))
|
|
|
|
#define CTRL_ADC_STOP 0x80000000 /* 1 = ADC stopped */
|
|
#define CTRL_XCTL1 0x40000000 /* electret mic bias */
|
|
#define CTRL_OPEN 0x20000000 /* no function, can be read and written */
|
|
#define CTRL_PCLKDIV 0x1fff0000 /* ADC/DAC2 clock divider */
|
|
#define CTRL_SH_PCLKDIV 16
|
|
#define CTRL_MSFMTSEL 0x00008000 /* MPEG serial data fmt: 0 = Sony, 1 = I2S */
|
|
#define CTRL_M_SBB 0x00004000 /* DAC2 clock: 0 = PCLKDIV, 1 = MPEG */
|
|
#define CTRL_WTSRSEL 0x00003000 /* DAC1 clock freq: 0=5512, 1=11025, 2=22050, 3=44100 */
|
|
#define CTRL_SH_WTSRSEL 12
|
|
#define CTRL_DAC_SYNC 0x00000800 /* 1 = DAC2 runs off DAC1 clock */
|
|
#define CTRL_CCB_INTRM 0x00000400 /* 1 = CCB "voice" ints enabled */
|
|
#define CTRL_M_CB 0x00000200 /* recording source: 0 = ADC, 1 = MPEG */
|
|
#define CTRL_XCTL0 0x00000100 /* 0 = Line in, 1 = Line out */
|
|
#define CTRL_BREQ 0x00000080 /* 1 = test mode (internal mem test) */
|
|
#define CTRL_DAC1_EN 0x00000040 /* enable DAC1 */
|
|
#define CTRL_DAC2_EN 0x00000020 /* enable DAC2 */
|
|
#define CTRL_ADC_EN 0x00000010 /* enable ADC */
|
|
#define CTRL_UART_EN 0x00000008 /* enable MIDI uart */
|
|
#define CTRL_JYSTK_EN 0x00000004 /* enable Joystick port (presumably at address 0x200) */
|
|
#define CTRL_CDC_EN 0x00000002 /* enable serial (CODEC) interface */
|
|
#define CTRL_SERR_DIS 0x00000001 /* 1 = disable PCI SERR signal */
|
|
|
|
#define STAT_INTR 0x80000000 /* wired or of all interrupt bits */
|
|
#define STAT_CSTAT 0x00000400 /* 1 = codec busy or codec write in progress */
|
|
#define STAT_CBUSY 0x00000200 /* 1 = codec busy */
|
|
#define STAT_CWRIP 0x00000100 /* 1 = codec write in progress */
|
|
#define STAT_VC 0x00000060 /* CCB int source, 0=DAC1, 1=DAC2, 2=ADC, 3=undef */
|
|
#define STAT_SH_VC 5
|
|
#define STAT_MCCB 0x00000010 /* CCB int pending */
|
|
#define STAT_UART 0x00000008 /* UART int pending */
|
|
#define STAT_DAC1 0x00000004 /* DAC1 int pending */
|
|
#define STAT_DAC2 0x00000002 /* DAC2 int pending */
|
|
#define STAT_ADC 0x00000001 /* ADC int pending */
|
|
|
|
#define USTAT_RXINT 0x80 /* UART rx int pending */
|
|
#define USTAT_TXINT 0x04 /* UART tx int pending */
|
|
#define USTAT_TXRDY 0x02 /* UART tx ready */
|
|
#define USTAT_RXRDY 0x01 /* UART rx ready */
|
|
|
|
#define UCTRL_RXINTEN 0x80 /* 1 = enable RX ints */
|
|
#define UCTRL_TXINTEN 0x60 /* TX int enable field mask */
|
|
#define UCTRL_ENA_TXINT 0x20 /* enable TX int */
|
|
#define UCTRL_CNTRL 0x03 /* control field */
|
|
#define UCTRL_CNTRL_SWR 0x03 /* software reset command */
|
|
|
|
#define SCTRL_P2ENDINC 0x00380000 /* */
|
|
#define SCTRL_SH_P2ENDINC 19
|
|
#define SCTRL_P2STINC 0x00070000 /* */
|
|
#define SCTRL_SH_P2STINC 16
|
|
#define SCTRL_R1LOOPSEL 0x00008000 /* 0 = loop mode */
|
|
#define SCTRL_P2LOOPSEL 0x00004000 /* 0 = loop mode */
|
|
#define SCTRL_P1LOOPSEL 0x00002000 /* 0 = loop mode */
|
|
#define SCTRL_P2PAUSE 0x00001000 /* 1 = pause mode */
|
|
#define SCTRL_P1PAUSE 0x00000800 /* 1 = pause mode */
|
|
#define SCTRL_R1INTEN 0x00000400 /* enable interrupt */
|
|
#define SCTRL_P2INTEN 0x00000200 /* enable interrupt */
|
|
#define SCTRL_P1INTEN 0x00000100 /* enable interrupt */
|
|
#define SCTRL_P1SCTRLD 0x00000080 /* reload sample count register for DAC1 */
|
|
#define SCTRL_P2DACSEN 0x00000040 /* 1 = DAC2 play back last sample when disabled */
|
|
#define SCTRL_R1SEB 0x00000020 /* 1 = 16bit */
|
|
#define SCTRL_R1SMB 0x00000010 /* 1 = stereo */
|
|
#define SCTRL_R1FMT 0x00000030 /* format mask */
|
|
#define SCTRL_SH_R1FMT 4
|
|
#define SCTRL_P2SEB 0x00000008 /* 1 = 16bit */
|
|
#define SCTRL_P2SMB 0x00000004 /* 1 = stereo */
|
|
#define SCTRL_P2FMT 0x0000000c /* format mask */
|
|
#define SCTRL_SH_P2FMT 2
|
|
#define SCTRL_P1SEB 0x00000002 /* 1 = 16bit */
|
|
#define SCTRL_P1SMB 0x00000001 /* 1 = stereo */
|
|
#define SCTRL_P1FMT 0x00000003 /* format mask */
|
|
#define SCTRL_SH_P1FMT 0
|
|
|
|
/* End blatant GPL violation */
|
|
|
|
#define NB_CHANNELS 3
|
|
#define DAC1_CHANNEL 0
|
|
#define DAC2_CHANNEL 1
|
|
#define ADC_CHANNEL 2
|
|
|
|
static void es1370_dac1_callback (void *opaque, int free);
|
|
static void es1370_dac2_callback (void *opaque, int free);
|
|
static void es1370_adc_callback (void *opaque, int avail);
|
|
|
|
static void print_ctl(uint32_t val)
|
|
{
|
|
if (DEBUG_ES1370) {
|
|
char buf[1024];
|
|
|
|
buf[0] = '\0';
|
|
#define a(n) if (val & CTRL_##n) pstrcat(buf, sizeof(buf), " "#n)
|
|
a(ADC_STOP);
|
|
a(XCTL1);
|
|
a(OPEN);
|
|
a(MSFMTSEL);
|
|
a(M_SBB);
|
|
a(DAC_SYNC);
|
|
a(CCB_INTRM);
|
|
a(M_CB);
|
|
a(XCTL0);
|
|
a(BREQ);
|
|
a(DAC1_EN);
|
|
a(DAC2_EN);
|
|
a(ADC_EN);
|
|
a(UART_EN);
|
|
a(JYSTK_EN);
|
|
a(CDC_EN);
|
|
a(SERR_DIS);
|
|
#undef a
|
|
AUD_log("es1370", "ctl - PCLKDIV %d(DAC2 freq %d), freq %d,%s\n",
|
|
(val & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV,
|
|
DAC2_DIVTOSR((val & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV),
|
|
dac1_samplerate[(val & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL],
|
|
buf);
|
|
}
|
|
}
|
|
|
|
static void print_sctl(uint32_t val)
|
|
{
|
|
if (DEBUG_ES1370) {
|
|
static const char *fmt_names[] = {"8M", "8S", "16M", "16S"};
|
|
char buf[1024];
|
|
|
|
buf[0] = '\0';
|
|
|
|
#define a(n) if (val & SCTRL_##n) pstrcat(buf, sizeof(buf), " "#n)
|
|
#define b(n) if (!(val & SCTRL_##n)) pstrcat(buf, sizeof(buf), " "#n)
|
|
b(R1LOOPSEL);
|
|
b(P2LOOPSEL);
|
|
b(P1LOOPSEL);
|
|
a(P2PAUSE);
|
|
a(P1PAUSE);
|
|
a(R1INTEN);
|
|
a(P2INTEN);
|
|
a(P1INTEN);
|
|
a(P1SCTRLD);
|
|
a(P2DACSEN);
|
|
if (buf[0]) {
|
|
pstrcat(buf, sizeof(buf), "\n ");
|
|
} else {
|
|
buf[0] = ' ';
|
|
buf[1] = '\0';
|
|
}
|
|
#undef b
|
|
#undef a
|
|
AUD_log("es1370",
|
|
"%s p2_end_inc %d, p2_st_inc %d,"
|
|
" r1_fmt %s, p2_fmt %s, p1_fmt %s\n",
|
|
buf,
|
|
(val & SCTRL_P2ENDINC) >> SCTRL_SH_P2ENDINC,
|
|
(val & SCTRL_P2STINC) >> SCTRL_SH_P2STINC,
|
|
fmt_names[(val >> SCTRL_SH_R1FMT) & 3],
|
|
fmt_names[(val >> SCTRL_SH_P2FMT) & 3],
|
|
fmt_names[(val >> SCTRL_SH_P1FMT) & 3]);
|
|
}
|
|
}
|
|
|
|
#define lwarn(...) \
|
|
do { \
|
|
if (VERBOSE_ES1370) { \
|
|
AUD_log("es1370: warning", __VA_ARGS__); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TYPE_ES1370 "ES1370"
|
|
OBJECT_DECLARE_SIMPLE_TYPE(ES1370State, ES1370)
|
|
|
|
struct chan {
|
|
uint32_t shift;
|
|
uint32_t leftover;
|
|
uint32_t scount;
|
|
uint32_t frame_addr;
|
|
uint32_t frame_cnt;
|
|
};
|
|
|
|
struct ES1370State {
|
|
PCIDevice dev;
|
|
QEMUSoundCard card;
|
|
MemoryRegion io;
|
|
struct chan chan[NB_CHANNELS];
|
|
SWVoiceOut *dac_voice[2];
|
|
SWVoiceIn *adc_voice;
|
|
|
|
uint32_t ctl;
|
|
uint32_t status;
|
|
uint32_t mempage;
|
|
uint32_t codec;
|
|
uint32_t sctl;
|
|
};
|
|
|
|
struct chan_bits {
|
|
uint32_t ctl_en;
|
|
uint32_t stat_int;
|
|
uint32_t sctl_pause;
|
|
uint32_t sctl_inten;
|
|
uint32_t sctl_fmt;
|
|
uint32_t sctl_sh_fmt;
|
|
uint32_t sctl_loopsel;
|
|
void (*calc_freq) (ES1370State *s, uint32_t ctl,
|
|
uint32_t *old_freq, uint32_t *new_freq);
|
|
};
|
|
|
|
static void es1370_dac1_calc_freq (ES1370State *s, uint32_t ctl,
|
|
uint32_t *old_freq, uint32_t *new_freq);
|
|
static void es1370_dac2_and_adc_calc_freq (ES1370State *s, uint32_t ctl,
|
|
uint32_t *old_freq,
|
|
uint32_t *new_freq);
|
|
|
|
static const struct chan_bits es1370_chan_bits[] = {
|
|
{CTRL_DAC1_EN, STAT_DAC1, SCTRL_P1PAUSE, SCTRL_P1INTEN,
|
|
SCTRL_P1FMT, SCTRL_SH_P1FMT, SCTRL_P1LOOPSEL,
|
|
es1370_dac1_calc_freq},
|
|
|
|
{CTRL_DAC2_EN, STAT_DAC2, SCTRL_P2PAUSE, SCTRL_P2INTEN,
|
|
SCTRL_P2FMT, SCTRL_SH_P2FMT, SCTRL_P2LOOPSEL,
|
|
es1370_dac2_and_adc_calc_freq},
|
|
|
|
{CTRL_ADC_EN, STAT_ADC, 0, SCTRL_R1INTEN,
|
|
SCTRL_R1FMT, SCTRL_SH_R1FMT, SCTRL_R1LOOPSEL,
|
|
es1370_dac2_and_adc_calc_freq}
|
|
};
|
|
|
|
static void es1370_update_status (ES1370State *s, uint32_t new_status)
|
|
{
|
|
uint32_t level = new_status & (STAT_DAC1 | STAT_DAC2 | STAT_ADC);
|
|
|
|
if (level) {
|
|
s->status = new_status | STAT_INTR;
|
|
} else {
|
|
s->status = new_status & ~STAT_INTR;
|
|
}
|
|
pci_set_irq(&s->dev, !!level);
|
|
}
|
|
|
|
static void es1370_reset (ES1370State *s)
|
|
{
|
|
size_t i;
|
|
|
|
s->ctl = 1;
|
|
s->status = 0x60;
|
|
s->mempage = 0;
|
|
s->codec = 0;
|
|
s->sctl = 0;
|
|
|
|
for (i = 0; i < NB_CHANNELS; ++i) {
|
|
struct chan *d = &s->chan[i];
|
|
d->scount = 0;
|
|
d->leftover = 0;
|
|
if (i == ADC_CHANNEL) {
|
|
AUD_close_in (&s->card, s->adc_voice);
|
|
s->adc_voice = NULL;
|
|
} else {
|
|
AUD_close_out (&s->card, s->dac_voice[i]);
|
|
s->dac_voice[i] = NULL;
|
|
}
|
|
}
|
|
pci_irq_deassert(&s->dev);
|
|
}
|
|
|
|
static void es1370_maybe_lower_irq (ES1370State *s, uint32_t sctl)
|
|
{
|
|
uint32_t new_status = s->status;
|
|
|
|
if (!(sctl & SCTRL_P1INTEN) && (s->sctl & SCTRL_P1INTEN)) {
|
|
new_status &= ~STAT_DAC1;
|
|
}
|
|
|
|
if (!(sctl & SCTRL_P2INTEN) && (s->sctl & SCTRL_P2INTEN)) {
|
|
new_status &= ~STAT_DAC2;
|
|
}
|
|
|
|
if (!(sctl & SCTRL_R1INTEN) && (s->sctl & SCTRL_R1INTEN)) {
|
|
new_status &= ~STAT_ADC;
|
|
}
|
|
|
|
if (new_status != s->status) {
|
|
es1370_update_status (s, new_status);
|
|
}
|
|
}
|
|
|
|
static void es1370_dac1_calc_freq (ES1370State *s, uint32_t ctl,
|
|
uint32_t *old_freq, uint32_t *new_freq)
|
|
|
|
{
|
|
*old_freq = dac1_samplerate[(s->ctl & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL];
|
|
*new_freq = dac1_samplerate[(ctl & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL];
|
|
}
|
|
|
|
static void es1370_dac2_and_adc_calc_freq (ES1370State *s, uint32_t ctl,
|
|
uint32_t *old_freq,
|
|
uint32_t *new_freq)
|
|
|
|
{
|
|
uint32_t old_pclkdiv, new_pclkdiv;
|
|
|
|
new_pclkdiv = (ctl & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV;
|
|
old_pclkdiv = (s->ctl & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV;
|
|
*new_freq = DAC2_DIVTOSR (new_pclkdiv);
|
|
*old_freq = DAC2_DIVTOSR (old_pclkdiv);
|
|
}
|
|
|
|
static void es1370_update_voices (ES1370State *s, uint32_t ctl, uint32_t sctl)
|
|
{
|
|
size_t i;
|
|
uint32_t old_freq, new_freq, old_fmt, new_fmt;
|
|
|
|
for (i = 0; i < NB_CHANNELS; ++i) {
|
|
struct chan *d = &s->chan[i];
|
|
const struct chan_bits *b = &es1370_chan_bits[i];
|
|
|
|
new_fmt = (sctl & b->sctl_fmt) >> b->sctl_sh_fmt;
|
|
old_fmt = (s->sctl & b->sctl_fmt) >> b->sctl_sh_fmt;
|
|
|
|
b->calc_freq (s, ctl, &old_freq, &new_freq);
|
|
|
|
if ((old_fmt != new_fmt) || (old_freq != new_freq)) {
|
|
d->shift = (new_fmt & 1) + (new_fmt >> 1);
|
|
trace_es1370_stream_format(i, new_freq,
|
|
new_fmt & 2 ? "s16" : "u8", new_fmt & 1 ? "stereo" : "mono",
|
|
d->shift);
|
|
if (new_freq) {
|
|
struct audsettings as;
|
|
|
|
as.freq = new_freq;
|
|
as.nchannels = 1 << (new_fmt & 1);
|
|
as.fmt = (new_fmt & 2) ? AUDIO_FORMAT_S16 : AUDIO_FORMAT_U8;
|
|
as.endianness = 0;
|
|
|
|
if (i == ADC_CHANNEL) {
|
|
s->adc_voice =
|
|
AUD_open_in (
|
|
&s->card,
|
|
s->adc_voice,
|
|
"es1370.adc",
|
|
s,
|
|
es1370_adc_callback,
|
|
&as
|
|
);
|
|
} else {
|
|
s->dac_voice[i] =
|
|
AUD_open_out (
|
|
&s->card,
|
|
s->dac_voice[i],
|
|
i ? "es1370.dac2" : "es1370.dac1",
|
|
s,
|
|
i ? es1370_dac2_callback : es1370_dac1_callback,
|
|
&as
|
|
);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (((ctl ^ s->ctl) & b->ctl_en)
|
|
|| ((sctl ^ s->sctl) & b->sctl_pause)) {
|
|
int on = (ctl & b->ctl_en) && !(sctl & b->sctl_pause);
|
|
|
|
if (i == ADC_CHANNEL) {
|
|
AUD_set_active_in (s->adc_voice, on);
|
|
} else {
|
|
AUD_set_active_out (s->dac_voice[i], on);
|
|
}
|
|
}
|
|
}
|
|
|
|
s->ctl = ctl;
|
|
s->sctl = sctl;
|
|
}
|
|
|
|
static inline uint32_t es1370_fixup (ES1370State *s, uint32_t addr)
|
|
{
|
|
addr &= 0xff;
|
|
if (addr >= 0x30 && addr <= 0x3f) {
|
|
addr |= s->mempage << 8;
|
|
}
|
|
return addr;
|
|
}
|
|
|
|
static void es1370_write(void *opaque, hwaddr addr, uint64_t val, unsigned size)
|
|
{
|
|
ES1370State *s = opaque;
|
|
struct chan *d = &s->chan[0];
|
|
|
|
addr = es1370_fixup (s, addr);
|
|
|
|
switch (addr) {
|
|
case ES1370_REG_CONTROL:
|
|
es1370_update_voices (s, val, s->sctl);
|
|
print_ctl (val);
|
|
break;
|
|
|
|
case ES1370_REG_MEMPAGE:
|
|
s->mempage = val & 0xf;
|
|
break;
|
|
|
|
case ES1370_REG_SERIAL_CONTROL:
|
|
es1370_maybe_lower_irq (s, val);
|
|
es1370_update_voices (s, s->ctl, val);
|
|
print_sctl (val);
|
|
break;
|
|
|
|
case ES1370_REG_DAC1_SCOUNT:
|
|
case ES1370_REG_DAC2_SCOUNT:
|
|
case ES1370_REG_ADC_SCOUNT:
|
|
d += (addr - ES1370_REG_DAC1_SCOUNT) >> 2;
|
|
d->scount = (val & 0xffff) << 16 | (val & 0xffff);
|
|
trace_es1370_sample_count_wr(d - &s->chan[0],
|
|
d->scount >> 16, d->scount & 0xffff);
|
|
break;
|
|
|
|
case ES1370_REG_ADC_FRAMEADR:
|
|
d += 2;
|
|
goto frameadr;
|
|
case ES1370_REG_DAC1_FRAMEADR:
|
|
case ES1370_REG_DAC2_FRAMEADR:
|
|
d += (addr - ES1370_REG_DAC1_FRAMEADR) >> 3;
|
|
frameadr:
|
|
d->frame_addr = val;
|
|
trace_es1370_frame_address_wr(d - &s->chan[0], d->frame_addr);
|
|
break;
|
|
|
|
case ES1370_REG_PHANTOM_FRAMECNT:
|
|
lwarn("writing to phantom frame count 0x%" PRIx64 "\n", val);
|
|
break;
|
|
case ES1370_REG_PHANTOM_FRAMEADR:
|
|
lwarn("writing to phantom frame address 0x%" PRIx64 "\n", val);
|
|
break;
|
|
|
|
case ES1370_REG_ADC_FRAMECNT:
|
|
d += 2;
|
|
goto framecnt;
|
|
case ES1370_REG_DAC1_FRAMECNT:
|
|
case ES1370_REG_DAC2_FRAMECNT:
|
|
d += (addr - ES1370_REG_DAC1_FRAMECNT) >> 3;
|
|
framecnt:
|
|
d->frame_cnt = val;
|
|
d->leftover = 0;
|
|
trace_es1370_frame_count_wr(d - &s->chan[0],
|
|
d->frame_cnt >> 16, d->frame_cnt & 0xffff);
|
|
break;
|
|
|
|
default:
|
|
lwarn("writel 0x%" PRIx64 " <- 0x%" PRIx64 "\n", addr, val);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static uint64_t es1370_read(void *opaque, hwaddr addr, unsigned size)
|
|
{
|
|
ES1370State *s = opaque;
|
|
uint32_t val;
|
|
struct chan *d = &s->chan[0];
|
|
|
|
addr = es1370_fixup (s, addr);
|
|
|
|
switch (addr) {
|
|
case ES1370_REG_CONTROL:
|
|
val = s->ctl;
|
|
break;
|
|
case ES1370_REG_STATUS:
|
|
val = s->status;
|
|
break;
|
|
case ES1370_REG_MEMPAGE:
|
|
val = s->mempage;
|
|
break;
|
|
case ES1370_REG_CODEC:
|
|
val = s->codec;
|
|
break;
|
|
case ES1370_REG_SERIAL_CONTROL:
|
|
val = s->sctl;
|
|
break;
|
|
|
|
case ES1370_REG_DAC1_SCOUNT:
|
|
case ES1370_REG_DAC2_SCOUNT:
|
|
case ES1370_REG_ADC_SCOUNT:
|
|
d += (addr - ES1370_REG_DAC1_SCOUNT) >> 2;
|
|
trace_es1370_sample_count_rd(d - &s->chan[0],
|
|
d->scount >> 16, d->scount & 0xffff);
|
|
val = d->scount;
|
|
break;
|
|
|
|
case ES1370_REG_ADC_FRAMECNT:
|
|
d += 2;
|
|
goto framecnt;
|
|
case ES1370_REG_DAC1_FRAMECNT:
|
|
case ES1370_REG_DAC2_FRAMECNT:
|
|
d += (addr - ES1370_REG_DAC1_FRAMECNT) >> 3;
|
|
framecnt:
|
|
trace_es1370_frame_count_rd(d - &s->chan[0],
|
|
d->frame_cnt >> 16, d->frame_cnt & 0xffff);
|
|
val = d->frame_cnt;
|
|
break;
|
|
|
|
case ES1370_REG_ADC_FRAMEADR:
|
|
d += 2;
|
|
goto frameadr;
|
|
case ES1370_REG_DAC1_FRAMEADR:
|
|
case ES1370_REG_DAC2_FRAMEADR:
|
|
d += (addr - ES1370_REG_DAC1_FRAMEADR) >> 3;
|
|
frameadr:
|
|
trace_es1370_frame_address_rd(d - &s->chan[0], d->frame_addr);
|
|
val = d->frame_addr;
|
|
break;
|
|
|
|
case ES1370_REG_PHANTOM_FRAMECNT:
|
|
val = ~0U;
|
|
lwarn("reading from phantom frame count\n");
|
|
break;
|
|
case ES1370_REG_PHANTOM_FRAMEADR:
|
|
val = ~0U;
|
|
lwarn("reading from phantom frame address\n");
|
|
break;
|
|
|
|
default:
|
|
val = ~0U;
|
|
lwarn("readl 0x%" PRIx64 " -> 0x%x\n", addr, val);
|
|
break;
|
|
}
|
|
return val;
|
|
}
|
|
|
|
static void es1370_transfer_audio (ES1370State *s, struct chan *d, int loop_sel,
|
|
int max, bool *irq)
|
|
{
|
|
uint8_t tmpbuf[4096];
|
|
size_t to_transfer;
|
|
uint32_t addr = d->frame_addr;
|
|
int sc = d->scount & 0xffff;
|
|
int csc = d->scount >> 16;
|
|
int csc_bytes = (csc + 1) << d->shift;
|
|
int cnt = d->frame_cnt >> 16;
|
|
int size = d->frame_cnt & 0xffff;
|
|
if (size < cnt) {
|
|
return;
|
|
}
|
|
int left = ((size - cnt + 1) << 2) + d->leftover;
|
|
int transferred = 0;
|
|
int index = d - &s->chan[0];
|
|
|
|
to_transfer = MIN(max, MIN(left, csc_bytes));
|
|
addr += (cnt << 2) + d->leftover;
|
|
|
|
if (index == ADC_CHANNEL) {
|
|
while (to_transfer > 0) {
|
|
int acquired, to_copy;
|
|
|
|
to_copy = MIN(to_transfer, sizeof(tmpbuf));
|
|
acquired = AUD_read (s->adc_voice, tmpbuf, to_copy);
|
|
if (!acquired) {
|
|
break;
|
|
}
|
|
|
|
pci_dma_write (&s->dev, addr, tmpbuf, acquired);
|
|
|
|
to_transfer -= acquired;
|
|
addr += acquired;
|
|
transferred += acquired;
|
|
}
|
|
} else {
|
|
SWVoiceOut *voice = s->dac_voice[index];
|
|
|
|
while (to_transfer > 0) {
|
|
int copied, to_copy;
|
|
|
|
to_copy = MIN(to_transfer, sizeof(tmpbuf));
|
|
pci_dma_read (&s->dev, addr, tmpbuf, to_copy);
|
|
copied = AUD_write (voice, tmpbuf, to_copy);
|
|
if (!copied) {
|
|
break;
|
|
}
|
|
to_transfer -= copied;
|
|
addr += copied;
|
|
transferred += copied;
|
|
}
|
|
}
|
|
|
|
if (csc_bytes == transferred) {
|
|
if (*irq) {
|
|
trace_es1370_lost_interrupt(index);
|
|
}
|
|
*irq = true;
|
|
d->scount = sc | (sc << 16);
|
|
} else {
|
|
*irq = false;
|
|
d->scount = sc | (((csc_bytes - transferred - 1) >> d->shift) << 16);
|
|
}
|
|
|
|
cnt += (transferred + d->leftover) >> 2;
|
|
|
|
if (s->sctl & loop_sel) {
|
|
/*
|
|
* loop_sel tells us which bit in the SCTL register to look at
|
|
* (either P1_LOOP_SEL, P2_LOOP_SEL or R1_LOOP_SEL). The sense
|
|
* of these bits is 0 for loop mode (set interrupt and keep recording
|
|
* when the sample count reaches zero) or 1 for stop mode (set
|
|
* interrupt and stop recording).
|
|
*/
|
|
AUD_log ("es1370: warning", "non looping mode\n");
|
|
} else {
|
|
d->frame_cnt = size;
|
|
|
|
if ((uint32_t) cnt <= d->frame_cnt) {
|
|
d->frame_cnt |= cnt << 16;
|
|
}
|
|
}
|
|
|
|
d->leftover = (transferred + d->leftover) & 3;
|
|
trace_es1370_transfer_audio(index,
|
|
d->frame_cnt >> 16, d->frame_cnt & 0xffff,
|
|
d->scount >> 16, d->scount & 0xffff,
|
|
d->leftover, *irq);
|
|
}
|
|
|
|
static void es1370_run_channel (ES1370State *s, size_t chan, int free_or_avail)
|
|
{
|
|
uint32_t new_status = s->status;
|
|
int max_bytes;
|
|
bool irq;
|
|
struct chan *d = &s->chan[chan];
|
|
const struct chan_bits *b = &es1370_chan_bits[chan];
|
|
|
|
if (!(s->ctl & b->ctl_en) || (s->sctl & b->sctl_pause)) {
|
|
return;
|
|
}
|
|
|
|
max_bytes = free_or_avail;
|
|
max_bytes &= ~((1 << d->shift) - 1);
|
|
if (!max_bytes) {
|
|
return;
|
|
}
|
|
|
|
irq = s->sctl & b->sctl_inten && s->status & b->stat_int;
|
|
|
|
es1370_transfer_audio (s, d, b->sctl_loopsel, max_bytes, &irq);
|
|
|
|
if (irq) {
|
|
if (s->sctl & b->sctl_inten) {
|
|
new_status |= b->stat_int;
|
|
}
|
|
}
|
|
|
|
if (new_status != s->status) {
|
|
es1370_update_status (s, new_status);
|
|
}
|
|
}
|
|
|
|
static void es1370_dac1_callback (void *opaque, int free)
|
|
{
|
|
ES1370State *s = opaque;
|
|
|
|
es1370_run_channel (s, DAC1_CHANNEL, free);
|
|
}
|
|
|
|
static void es1370_dac2_callback (void *opaque, int free)
|
|
{
|
|
ES1370State *s = opaque;
|
|
|
|
es1370_run_channel (s, DAC2_CHANNEL, free);
|
|
}
|
|
|
|
static void es1370_adc_callback (void *opaque, int avail)
|
|
{
|
|
ES1370State *s = opaque;
|
|
|
|
es1370_run_channel (s, ADC_CHANNEL, avail);
|
|
}
|
|
|
|
static const MemoryRegionOps es1370_io_ops = {
|
|
.read = es1370_read,
|
|
.write = es1370_write,
|
|
.valid = {
|
|
.min_access_size = 1,
|
|
.max_access_size = 4,
|
|
},
|
|
.impl = {
|
|
.min_access_size = 4,
|
|
.max_access_size = 4,
|
|
},
|
|
.endianness = DEVICE_LITTLE_ENDIAN,
|
|
};
|
|
|
|
static const VMStateDescription vmstate_es1370_channel = {
|
|
.name = "es1370_channel",
|
|
.version_id = 2,
|
|
.minimum_version_id = 2,
|
|
.fields = (const VMStateField[]) {
|
|
VMSTATE_UINT32 (shift, struct chan),
|
|
VMSTATE_UINT32 (leftover, struct chan),
|
|
VMSTATE_UINT32 (scount, struct chan),
|
|
VMSTATE_UINT32 (frame_addr, struct chan),
|
|
VMSTATE_UINT32 (frame_cnt, struct chan),
|
|
VMSTATE_END_OF_LIST ()
|
|
}
|
|
};
|
|
|
|
static int es1370_post_load (void *opaque, int version_id)
|
|
{
|
|
uint32_t ctl, sctl;
|
|
ES1370State *s = opaque;
|
|
size_t i;
|
|
|
|
for (i = 0; i < NB_CHANNELS; ++i) {
|
|
if (i == ADC_CHANNEL) {
|
|
if (s->adc_voice) {
|
|
AUD_close_in (&s->card, s->adc_voice);
|
|
s->adc_voice = NULL;
|
|
}
|
|
} else {
|
|
if (s->dac_voice[i]) {
|
|
AUD_close_out (&s->card, s->dac_voice[i]);
|
|
s->dac_voice[i] = NULL;
|
|
}
|
|
}
|
|
}
|
|
|
|
ctl = s->ctl;
|
|
sctl = s->sctl;
|
|
s->ctl = 0;
|
|
s->sctl = 0;
|
|
es1370_update_voices (s, ctl, sctl);
|
|
return 0;
|
|
}
|
|
|
|
static const VMStateDescription vmstate_es1370 = {
|
|
.name = "es1370",
|
|
.version_id = 2,
|
|
.minimum_version_id = 2,
|
|
.post_load = es1370_post_load,
|
|
.fields = (const VMStateField[]) {
|
|
VMSTATE_PCI_DEVICE (dev, ES1370State),
|
|
VMSTATE_STRUCT_ARRAY (chan, ES1370State, NB_CHANNELS, 2,
|
|
vmstate_es1370_channel, struct chan),
|
|
VMSTATE_UINT32 (ctl, ES1370State),
|
|
VMSTATE_UINT32 (status, ES1370State),
|
|
VMSTATE_UINT32 (mempage, ES1370State),
|
|
VMSTATE_UINT32 (codec, ES1370State),
|
|
VMSTATE_UINT32 (sctl, ES1370State),
|
|
VMSTATE_END_OF_LIST ()
|
|
}
|
|
};
|
|
|
|
static void es1370_on_reset(DeviceState *dev)
|
|
{
|
|
ES1370State *s = ES1370(dev);
|
|
|
|
es1370_reset (s);
|
|
}
|
|
|
|
static void es1370_realize(PCIDevice *dev, Error **errp)
|
|
{
|
|
ES1370State *s = ES1370(dev);
|
|
uint8_t *c = s->dev.config;
|
|
|
|
if (!AUD_register_card ("es1370", &s->card, errp)) {
|
|
return;
|
|
}
|
|
|
|
c[PCI_STATUS + 1] = PCI_STATUS_DEVSEL_SLOW >> 8;
|
|
|
|
#if 0
|
|
c[PCI_CAPABILITY_LIST] = 0xdc;
|
|
c[PCI_INTERRUPT_LINE] = 10;
|
|
c[0xdc] = 0x00;
|
|
#endif
|
|
|
|
c[PCI_INTERRUPT_PIN] = 1;
|
|
c[PCI_MIN_GNT] = 0x0c;
|
|
c[PCI_MAX_LAT] = 0x80;
|
|
|
|
memory_region_init_io (&s->io, OBJECT(s), &es1370_io_ops, s, "es1370", 256);
|
|
pci_register_bar (&s->dev, 0, PCI_BASE_ADDRESS_SPACE_IO, &s->io);
|
|
|
|
es1370_reset (s);
|
|
}
|
|
|
|
static void es1370_exit(PCIDevice *dev)
|
|
{
|
|
ES1370State *s = ES1370(dev);
|
|
int i;
|
|
|
|
for (i = 0; i < 2; ++i) {
|
|
AUD_close_out(&s->card, s->dac_voice[i]);
|
|
}
|
|
|
|
AUD_close_in(&s->card, s->adc_voice);
|
|
AUD_remove_card(&s->card);
|
|
}
|
|
|
|
static Property es1370_properties[] = {
|
|
DEFINE_AUDIO_PROPERTIES(ES1370State, card),
|
|
DEFINE_PROP_END_OF_LIST(),
|
|
};
|
|
|
|
static void es1370_class_init (ObjectClass *klass, void *data)
|
|
{
|
|
DeviceClass *dc = DEVICE_CLASS (klass);
|
|
PCIDeviceClass *k = PCI_DEVICE_CLASS (klass);
|
|
|
|
k->realize = es1370_realize;
|
|
k->exit = es1370_exit;
|
|
k->vendor_id = PCI_VENDOR_ID_ENSONIQ;
|
|
k->device_id = PCI_DEVICE_ID_ENSONIQ_ES1370;
|
|
k->class_id = PCI_CLASS_MULTIMEDIA_AUDIO;
|
|
k->subsystem_vendor_id = 0x4942;
|
|
k->subsystem_id = 0x4c4c;
|
|
set_bit(DEVICE_CATEGORY_SOUND, dc->categories);
|
|
dc->desc = "ENSONIQ AudioPCI ES1370";
|
|
dc->vmsd = &vmstate_es1370;
|
|
dc->reset = es1370_on_reset;
|
|
device_class_set_props(dc, es1370_properties);
|
|
}
|
|
|
|
static const TypeInfo es1370_info = {
|
|
.name = TYPE_ES1370,
|
|
.parent = TYPE_PCI_DEVICE,
|
|
.instance_size = sizeof (ES1370State),
|
|
.class_init = es1370_class_init,
|
|
.interfaces = (InterfaceInfo[]) {
|
|
{ INTERFACE_CONVENTIONAL_PCI_DEVICE },
|
|
{ },
|
|
},
|
|
};
|
|
|
|
static void es1370_register_types (void)
|
|
{
|
|
type_register_static (&es1370_info);
|
|
deprecated_register_soundhw("es1370", "ENSONIQ AudioPCI ES1370",
|
|
0, TYPE_ES1370);
|
|
}
|
|
|
|
type_init (es1370_register_types)
|