| /* |
| * 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 */ |
| /* #define VERBOSE_ES1370 */ |
| #define SILENT_ES1370 |
| |
| #include "hw.h" |
| #include "audiodev.h" |
| #include "audio/audio.h" |
| #include "pci.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 |
| |
| #define IO_READ_PROTO(n) \ |
| static uint32_t n (void *opaque, uint32_t addr) |
| #define IO_WRITE_PROTO(n) \ |
| static void n (void *opaque, uint32_t addr, uint32_t val) |
| |
| 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); |
| |
| #ifdef DEBUG_ES1370 |
| |
| #define ldebug(...) AUD_log ("es1370", __VA_ARGS__) |
| |
| static void print_ctl (uint32_t val) |
| { |
| char buf[1024]; |
| |
| buf[0] = '\0'; |
| #define a(n) if (val & CTRL_##n) strcat (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) |
| { |
| static const char *fmt_names[] = {"8M", "8S", "16M", "16S"}; |
| char buf[1024]; |
| |
| buf[0] = '\0'; |
| |
| #define a(n) if (val & SCTRL_##n) strcat (buf, " "#n) |
| #define b(n) if (!(val & SCTRL_##n)) strcat (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]) { |
| strcat (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] |
| ); |
| } |
| #else |
| #define ldebug(...) |
| #define print_ctl(...) |
| #define print_sctl(...) |
| #endif |
| |
| #ifdef VERBOSE_ES1370 |
| #define dolog(...) AUD_log ("es1370", __VA_ARGS__) |
| #else |
| #define dolog(...) |
| #endif |
| |
| #ifndef SILENT_ES1370 |
| #define lwarn(...) AUD_log ("es1370: warning", __VA_ARGS__) |
| #else |
| #define lwarn(...) |
| #endif |
| |
| struct chan { |
| uint32_t shift; |
| uint32_t leftover; |
| uint32_t scount; |
| uint32_t frame_addr; |
| uint32_t frame_cnt; |
| }; |
| |
| typedef struct ES1370State { |
| PCIDevice *pci_dev; |
| |
| QEMUSoundCard card; |
| 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; |
| } ES1370State; |
| |
| typedef struct PCIES1370State { |
| PCIDevice dev; |
| ES1370State es1370; |
| } PCIES1370State; |
| |
| 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; |
| } |
| qemu_set_irq(s->pci_dev->irq[0], !!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; |
| } |
| } |
| qemu_irq_lower(s->pci_dev->irq[0]); |
| } |
| |
| 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); |
| ldebug ("channel %d, freq = %d, nchannels %d, fmt %d, shift %d\n", |
| i, |
| new_freq, |
| 1 << (new_fmt & 1), |
| (new_fmt & 2) ? AUD_FMT_S16 : AUD_FMT_U8, |
| d->shift); |
| if (new_freq) { |
| struct audsettings as; |
| |
| as.freq = new_freq; |
| as.nchannels = 1 << (new_fmt & 1); |
| as.fmt = (new_fmt & 2) ? AUD_FMT_S16 : AUD_FMT_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; |
| } |
| |
| IO_WRITE_PROTO (es1370_writeb) |
| { |
| ES1370State *s = opaque; |
| uint32_t shift, mask; |
| |
| addr = es1370_fixup (s, addr); |
| |
| switch (addr) { |
| case ES1370_REG_CONTROL: |
| case ES1370_REG_CONTROL + 1: |
| case ES1370_REG_CONTROL + 2: |
| case ES1370_REG_CONTROL + 3: |
| shift = (addr - ES1370_REG_CONTROL) << 3; |
| mask = 0xff << shift; |
| val = (s->ctl & ~mask) | ((val & 0xff) << shift); |
| es1370_update_voices (s, val, s->sctl); |
| print_ctl (val); |
| break; |
| case ES1370_REG_MEMPAGE: |
| s->mempage = val; |
| break; |
| case ES1370_REG_SERIAL_CONTROL: |
| case ES1370_REG_SERIAL_CONTROL + 1: |
| case ES1370_REG_SERIAL_CONTROL + 2: |
| case ES1370_REG_SERIAL_CONTROL + 3: |
| shift = (addr - ES1370_REG_SERIAL_CONTROL) << 3; |
| mask = 0xff << shift; |
| val = (s->sctl & ~mask) | ((val & 0xff) << shift); |
| es1370_maybe_lower_irq (s, val); |
| es1370_update_voices (s, s->ctl, val); |
| print_sctl (val); |
| break; |
| default: |
| lwarn ("writeb %#x <- %#x\n", addr, val); |
| break; |
| } |
| } |
| |
| IO_WRITE_PROTO (es1370_writew) |
| { |
| ES1370State *s = opaque; |
| addr = es1370_fixup (s, addr); |
| uint32_t shift, mask; |
| struct chan *d = &s->chan[0]; |
| |
| switch (addr) { |
| case ES1370_REG_CODEC: |
| dolog ("ignored codec write address %#x, data %#x\n", |
| (val >> 8) & 0xff, val & 0xff); |
| s->codec = val; |
| break; |
| |
| case ES1370_REG_CONTROL: |
| case ES1370_REG_CONTROL + 2: |
| shift = (addr != ES1370_REG_CONTROL) << 4; |
| mask = 0xffff << shift; |
| val = (s->ctl & ~mask) | ((val & 0xffff) << shift); |
| es1370_update_voices (s, val, s->sctl); |
| print_ctl (val); |
| break; |
| |
| case ES1370_REG_ADC_SCOUNT: |
| d++; |
| case ES1370_REG_DAC2_SCOUNT: |
| d++; |
| case ES1370_REG_DAC1_SCOUNT: |
| d->scount = (d->scount & ~0xffff) | (val & 0xffff); |
| break; |
| |
| default: |
| lwarn ("writew %#x <- %#x\n", addr, val); |
| break; |
| } |
| } |
| |
| IO_WRITE_PROTO (es1370_writel) |
| { |
| 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_ADC_SCOUNT: |
| d++; |
| case ES1370_REG_DAC2_SCOUNT: |
| d++; |
| case ES1370_REG_DAC1_SCOUNT: |
| d->scount = (val & 0xffff) | (d->scount & ~0xffff); |
| ldebug ("chan %d CURR_SAMP_CT %d, SAMP_CT %d\n", |
| d - &s->chan[0], val >> 16, (val & 0xffff)); |
| break; |
| |
| case ES1370_REG_ADC_FRAMEADR: |
| d++; |
| case ES1370_REG_DAC2_FRAMEADR: |
| d++; |
| case ES1370_REG_DAC1_FRAMEADR: |
| d->frame_addr = val; |
| ldebug ("chan %d frame address %#x\n", d - &s->chan[0], val); |
| break; |
| |
| case ES1370_REG_PHANTOM_FRAMECNT: |
| lwarn ("writing to phantom frame count %#x\n", val); |
| break; |
| case ES1370_REG_PHANTOM_FRAMEADR: |
| lwarn ("writing to phantom frame address %#x\n", val); |
| break; |
| |
| case ES1370_REG_ADC_FRAMECNT: |
| d++; |
| case ES1370_REG_DAC2_FRAMECNT: |
| d++; |
| case ES1370_REG_DAC1_FRAMECNT: |
| d->frame_cnt = val; |
| d->leftover = 0; |
| ldebug ("chan %d frame count %d, buffer size %d\n", |
| d - &s->chan[0], val >> 16, val & 0xffff); |
| break; |
| |
| default: |
| lwarn ("writel %#x <- %#x\n", addr, val); |
| break; |
| } |
| } |
| |
| IO_READ_PROTO (es1370_readb) |
| { |
| ES1370State *s = opaque; |
| uint32_t val; |
| |
| addr = es1370_fixup (s, addr); |
| |
| switch (addr) { |
| case 0x1b: /* Legacy */ |
| lwarn ("Attempt to read from legacy register\n"); |
| val = 5; |
| break; |
| case ES1370_REG_MEMPAGE: |
| val = s->mempage; |
| break; |
| case ES1370_REG_CONTROL + 0: |
| case ES1370_REG_CONTROL + 1: |
| case ES1370_REG_CONTROL + 2: |
| case ES1370_REG_CONTROL + 3: |
| val = s->ctl >> ((addr - ES1370_REG_CONTROL) << 3); |
| break; |
| case ES1370_REG_STATUS + 0: |
| case ES1370_REG_STATUS + 1: |
| case ES1370_REG_STATUS + 2: |
| case ES1370_REG_STATUS + 3: |
| val = s->status >> ((addr - ES1370_REG_STATUS) << 3); |
| break; |
| default: |
| val = ~0; |
| lwarn ("readb %#x -> %#x\n", addr, val); |
| break; |
| } |
| return val; |
| } |
| |
| IO_READ_PROTO (es1370_readw) |
| { |
| ES1370State *s = opaque; |
| struct chan *d = &s->chan[0]; |
| uint32_t val; |
| |
| addr = es1370_fixup (s, addr); |
| |
| switch (addr) { |
| case ES1370_REG_ADC_SCOUNT + 2: |
| d++; |
| case ES1370_REG_DAC2_SCOUNT + 2: |
| d++; |
| case ES1370_REG_DAC1_SCOUNT + 2: |
| val = d->scount >> 16; |
| break; |
| |
| case ES1370_REG_ADC_FRAMECNT: |
| d++; |
| case ES1370_REG_DAC2_FRAMECNT: |
| d++; |
| case ES1370_REG_DAC1_FRAMECNT: |
| val = d->frame_cnt & 0xffff; |
| break; |
| |
| case ES1370_REG_ADC_FRAMECNT + 2: |
| d++; |
| case ES1370_REG_DAC2_FRAMECNT + 2: |
| d++; |
| case ES1370_REG_DAC1_FRAMECNT + 2: |
| val = d->frame_cnt >> 16; |
| break; |
| |
| default: |
| val = ~0; |
| lwarn ("readw %#x -> %#x\n", addr, val); |
| break; |
| } |
| |
| return val; |
| } |
| |
| IO_READ_PROTO (es1370_readl) |
| { |
| 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_ADC_SCOUNT: |
| d++; |
| case ES1370_REG_DAC2_SCOUNT: |
| d++; |
| case ES1370_REG_DAC1_SCOUNT: |
| val = d->scount; |
| #ifdef DEBUG_ES1370 |
| { |
| uint32_t curr_count = d->scount >> 16; |
| uint32_t count = d->scount & 0xffff; |
| |
| curr_count <<= d->shift; |
| count <<= d->shift; |
| dolog ("read scount curr %d, total %d\n", curr_count, count); |
| } |
| #endif |
| break; |
| |
| case ES1370_REG_ADC_FRAMECNT: |
| d++; |
| case ES1370_REG_DAC2_FRAMECNT: |
| d++; |
| case ES1370_REG_DAC1_FRAMECNT: |
| val = d->frame_cnt; |
| #ifdef DEBUG_ES1370 |
| { |
| uint32_t size = ((d->frame_cnt & 0xffff) + 1) << 2; |
| uint32_t curr = ((d->frame_cnt >> 16) + 1) << 2; |
| if (curr > size) |
| dolog ("read framecnt curr %d, size %d %d\n", curr, size, |
| curr > size); |
| } |
| #endif |
| break; |
| |
| case ES1370_REG_ADC_FRAMEADR: |
| d++; |
| case ES1370_REG_DAC2_FRAMEADR: |
| d++; |
| case ES1370_REG_DAC1_FRAMEADR: |
| 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 %#x -> %#x\n", addr, val); |
| break; |
| } |
| return val; |
| } |
| |
| |
| static void es1370_transfer_audio (ES1370State *s, struct chan *d, int loop_sel, |
| int max, int *irq) |
| { |
| uint8_t tmpbuf[4096]; |
| 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; |
| int left = ((size - cnt + 1) << 2) + d->leftover; |
| int transfered = 0; |
| int temp = audio_MIN (max, audio_MIN (left, csc_bytes)); |
| int index = d - &s->chan[0]; |
| |
| addr += (cnt << 2) + d->leftover; |
| |
| if (index == ADC_CHANNEL) { |
| while (temp) { |
| int acquired, to_copy; |
| |
| to_copy = audio_MIN ((size_t) temp, sizeof (tmpbuf)); |
| acquired = AUD_read (s->adc_voice, tmpbuf, to_copy); |
| if (!acquired) |
| break; |
| |
| cpu_physical_memory_write (addr, tmpbuf, acquired); |
| |
| temp -= acquired; |
| addr += acquired; |
| transfered += acquired; |
| } |
| } |
| else { |
| SWVoiceOut *voice = s->dac_voice[index]; |
| |
| while (temp) { |
| int copied, to_copy; |
| |
| to_copy = audio_MIN ((size_t) temp, sizeof (tmpbuf)); |
| cpu_physical_memory_read (addr, tmpbuf, to_copy); |
| copied = AUD_write (voice, tmpbuf, to_copy); |
| if (!copied) |
| break; |
| temp -= copied; |
| addr += copied; |
| transfered += copied; |
| } |
| } |
| |
| if (csc_bytes == transfered) { |
| *irq = 1; |
| d->scount = sc | (sc << 16); |
| ldebug ("sc = %d, rate = %f\n", |
| (sc + 1) << d->shift, |
| (sc + 1) / (double) 44100); |
| } |
| else { |
| *irq = 0; |
| d->scount = sc | (((csc_bytes - transfered - 1) >> d->shift) << 16); |
| } |
| |
| cnt += (transfered + d->leftover) >> 2; |
| |
| if (s->sctl & loop_sel) { |
| /* Bah, how stupid is that having a 0 represent true value? |
| i just spent few hours on this shit */ |
| 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 = (transfered + d->leftover) & 3; |
| } |
| |
| static void es1370_run_channel (ES1370State *s, size_t chan, int free_or_avail) |
| { |
| uint32_t new_status = s->status; |
| int max_bytes, 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; |
| } |
| |
| 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 void es1370_map (PCIDevice *pci_dev, int region_num, |
| uint32_t addr, uint32_t size, int type) |
| { |
| PCIES1370State *d = (PCIES1370State *) pci_dev; |
| ES1370State *s = &d->es1370; |
| |
| (void) region_num; |
| (void) size; |
| (void) type; |
| |
| register_ioport_write (addr, 0x40 * 4, 1, es1370_writeb, s); |
| register_ioport_write (addr, 0x40 * 2, 2, es1370_writew, s); |
| register_ioport_write (addr, 0x40, 4, es1370_writel, s); |
| |
| register_ioport_read (addr, 0x40 * 4, 1, es1370_readb, s); |
| register_ioport_read (addr, 0x40 * 2, 2, es1370_readw, s); |
| register_ioport_read (addr, 0x40, 4, es1370_readl, s); |
| } |
| |
| static void es1370_save (QEMUFile *f, void *opaque) |
| { |
| ES1370State *s = opaque; |
| size_t i; |
| |
| pci_device_save (s->pci_dev, f); |
| for (i = 0; i < NB_CHANNELS; ++i) { |
| struct chan *d = &s->chan[i]; |
| qemu_put_be32s (f, &d->shift); |
| qemu_put_be32s (f, &d->leftover); |
| qemu_put_be32s (f, &d->scount); |
| qemu_put_be32s (f, &d->frame_addr); |
| qemu_put_be32s (f, &d->frame_cnt); |
| } |
| qemu_put_be32s (f, &s->ctl); |
| qemu_put_be32s (f, &s->status); |
| qemu_put_be32s (f, &s->mempage); |
| qemu_put_be32s (f, &s->codec); |
| qemu_put_be32s (f, &s->sctl); |
| } |
| |
| static int es1370_load (QEMUFile *f, void *opaque, int version_id) |
| { |
| int ret; |
| uint32_t ctl, sctl; |
| ES1370State *s = opaque; |
| size_t i; |
| |
| if (version_id != 2) |
| return -EINVAL; |
| |
| ret = pci_device_load (s->pci_dev, f); |
| if (ret) |
| return ret; |
| |
| for (i = 0; i < NB_CHANNELS; ++i) { |
| struct chan *d = &s->chan[i]; |
| qemu_get_be32s (f, &d->shift); |
| qemu_get_be32s (f, &d->leftover); |
| qemu_get_be32s (f, &d->scount); |
| qemu_get_be32s (f, &d->frame_addr); |
| qemu_get_be32s (f, &d->frame_cnt); |
| 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; |
| } |
| } |
| } |
| |
| qemu_get_be32s (f, &ctl); |
| qemu_get_be32s (f, &s->status); |
| qemu_get_be32s (f, &s->mempage); |
| qemu_get_be32s (f, &s->codec); |
| qemu_get_be32s (f, &sctl); |
| |
| s->ctl = 0; |
| s->sctl = 0; |
| es1370_update_voices (s, ctl, sctl); |
| return 0; |
| } |
| |
| static void es1370_on_reset (void *opaque) |
| { |
| ES1370State *s = opaque; |
| es1370_reset (s); |
| } |
| |
| int es1370_init (PCIBus *bus, AudioState *audio) |
| { |
| PCIES1370State *d; |
| ES1370State *s; |
| uint8_t *c; |
| |
| if (!bus) { |
| dolog ("No PCI bus\n"); |
| return -1; |
| } |
| |
| if (!audio) { |
| dolog ("No audio state\n"); |
| return -1; |
| } |
| |
| d = (PCIES1370State *) pci_register_device (bus, "ES1370", |
| sizeof (PCIES1370State), |
| -1, NULL, NULL); |
| |
| if (!d) { |
| AUD_log (NULL, "Failed to register PCI device for ES1370\n"); |
| return -1; |
| } |
| |
| c = d->dev.config; |
| c[0x00] = 0x74; |
| c[0x01] = 0x12; |
| c[0x02] = 0x00; |
| c[0x03] = 0x50; |
| c[0x07] = 2 << 1; |
| c[0x0a] = 0x01; |
| c[0x0b] = 0x04; |
| |
| #if 1 |
| c[0x2c] = 0x42; |
| c[0x2d] = 0x49; |
| c[0x2e] = 0x4c; |
| c[0x2f] = 0x4c; |
| #else |
| c[0x2c] = 0x74; |
| c[0x2d] = 0x12; |
| c[0x2e] = 0x71; |
| c[0x2f] = 0x13; |
| c[0x34] = 0xdc; |
| c[0x3c] = 10; |
| c[0xdc] = 0x00; |
| #endif |
| |
| c[0x3d] = 1; |
| c[0x3e] = 0x0c; |
| c[0x3f] = 0x80; |
| |
| s = &d->es1370; |
| s->pci_dev = &d->dev; |
| |
| pci_register_io_region (&d->dev, 0, 256, PCI_ADDRESS_SPACE_IO, es1370_map); |
| register_savevm ("es1370", 0, 2, es1370_save, es1370_load, s); |
| qemu_register_reset (es1370_on_reset, s); |
| |
| AUD_register_card (audio, "es1370", &s->card); |
| es1370_reset (s); |
| return 0; |
| } |
