xref: /openbmc/qemu/hw/audio/es1370.c (revision 6016b7b4)
1 /*
2  * QEMU ES1370 emulation
3  *
4  * Copyright (c) 2005 Vassili Karpov (malc)
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a copy
7  * of this software and associated documentation files (the "Software"), to deal
8  * in the Software without restriction, including without limitation the rights
9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10  * copies of the Software, and to permit persons to whom the Software is
11  * furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22  * THE SOFTWARE.
23  */
24 
25 /* #define DEBUG_ES1370 */
26 /* #define VERBOSE_ES1370 */
27 #define SILENT_ES1370
28 
29 #include "qemu/osdep.h"
30 #include "hw/audio/soundhw.h"
31 #include "audio/audio.h"
32 #include "hw/pci/pci.h"
33 #include "migration/vmstate.h"
34 #include "qemu/module.h"
35 #include "sysemu/dma.h"
36 #include "qom/object.h"
37 
38 /* Missing stuff:
39    SCTRL_P[12](END|ST)INC
40    SCTRL_P1SCTRLD
41    SCTRL_P2DACSEN
42    CTRL_DAC_SYNC
43    MIDI
44    non looped mode
45    surely more
46 */
47 
48 /*
49   Following macros and samplerate array were copied verbatim from
50   Linux kernel 2.4.30: drivers/sound/es1370.c
51 
52   Copyright (C) 1998-2001, 2003 Thomas Sailer (t.sailer@alumni.ethz.ch)
53 */
54 
55 /* Start blatant GPL violation */
56 
57 #define ES1370_REG_CONTROL        0x00
58 #define ES1370_REG_STATUS         0x04
59 #define ES1370_REG_UART_DATA      0x08
60 #define ES1370_REG_UART_STATUS    0x09
61 #define ES1370_REG_UART_CONTROL   0x09
62 #define ES1370_REG_UART_TEST      0x0a
63 #define ES1370_REG_MEMPAGE        0x0c
64 #define ES1370_REG_CODEC          0x10
65 #define ES1370_REG_SERIAL_CONTROL 0x20
66 #define ES1370_REG_DAC1_SCOUNT    0x24
67 #define ES1370_REG_DAC2_SCOUNT    0x28
68 #define ES1370_REG_ADC_SCOUNT     0x2c
69 
70 #define ES1370_REG_DAC1_FRAMEADR    0xc30
71 #define ES1370_REG_DAC1_FRAMECNT    0xc34
72 #define ES1370_REG_DAC2_FRAMEADR    0xc38
73 #define ES1370_REG_DAC2_FRAMECNT    0xc3c
74 #define ES1370_REG_ADC_FRAMEADR     0xd30
75 #define ES1370_REG_ADC_FRAMECNT     0xd34
76 #define ES1370_REG_PHANTOM_FRAMEADR 0xd38
77 #define ES1370_REG_PHANTOM_FRAMECNT 0xd3c
78 
79 static const unsigned dac1_samplerate[] = { 5512, 11025, 22050, 44100 };
80 
81 #define DAC2_SRTODIV(x) (((1411200+(x)/2)/(x))-2)
82 #define DAC2_DIVTOSR(x) (1411200/((x)+2))
83 
84 #define CTRL_ADC_STOP   0x80000000  /* 1 = ADC stopped */
85 #define CTRL_XCTL1      0x40000000  /* electret mic bias */
86 #define CTRL_OPEN       0x20000000  /* no function, can be read and written */
87 #define CTRL_PCLKDIV    0x1fff0000  /* ADC/DAC2 clock divider */
88 #define CTRL_SH_PCLKDIV 16
89 #define CTRL_MSFMTSEL   0x00008000  /* MPEG serial data fmt: 0 = Sony, 1 = I2S */
90 #define CTRL_M_SBB      0x00004000  /* DAC2 clock: 0 = PCLKDIV, 1 = MPEG */
91 #define CTRL_WTSRSEL    0x00003000  /* DAC1 clock freq: 0=5512, 1=11025, 2=22050, 3=44100 */
92 #define CTRL_SH_WTSRSEL 12
93 #define CTRL_DAC_SYNC   0x00000800  /* 1 = DAC2 runs off DAC1 clock */
94 #define CTRL_CCB_INTRM  0x00000400  /* 1 = CCB "voice" ints enabled */
95 #define CTRL_M_CB       0x00000200  /* recording source: 0 = ADC, 1 = MPEG */
96 #define CTRL_XCTL0      0x00000100  /* 0 = Line in, 1 = Line out */
97 #define CTRL_BREQ       0x00000080  /* 1 = test mode (internal mem test) */
98 #define CTRL_DAC1_EN    0x00000040  /* enable DAC1 */
99 #define CTRL_DAC2_EN    0x00000020  /* enable DAC2 */
100 #define CTRL_ADC_EN     0x00000010  /* enable ADC */
101 #define CTRL_UART_EN    0x00000008  /* enable MIDI uart */
102 #define CTRL_JYSTK_EN   0x00000004  /* enable Joystick port (presumably at address 0x200) */
103 #define CTRL_CDC_EN     0x00000002  /* enable serial (CODEC) interface */
104 #define CTRL_SERR_DIS   0x00000001  /* 1 = disable PCI SERR signal */
105 
106 #define STAT_INTR       0x80000000  /* wired or of all interrupt bits */
107 #define STAT_CSTAT      0x00000400  /* 1 = codec busy or codec write in progress */
108 #define STAT_CBUSY      0x00000200  /* 1 = codec busy */
109 #define STAT_CWRIP      0x00000100  /* 1 = codec write in progress */
110 #define STAT_VC         0x00000060  /* CCB int source, 0=DAC1, 1=DAC2, 2=ADC, 3=undef */
111 #define STAT_SH_VC      5
112 #define STAT_MCCB       0x00000010  /* CCB int pending */
113 #define STAT_UART       0x00000008  /* UART int pending */
114 #define STAT_DAC1       0x00000004  /* DAC1 int pending */
115 #define STAT_DAC2       0x00000002  /* DAC2 int pending */
116 #define STAT_ADC        0x00000001  /* ADC int pending */
117 
118 #define USTAT_RXINT     0x80        /* UART rx int pending */
119 #define USTAT_TXINT     0x04        /* UART tx int pending */
120 #define USTAT_TXRDY     0x02        /* UART tx ready */
121 #define USTAT_RXRDY     0x01        /* UART rx ready */
122 
123 #define UCTRL_RXINTEN   0x80        /* 1 = enable RX ints */
124 #define UCTRL_TXINTEN   0x60        /* TX int enable field mask */
125 #define UCTRL_ENA_TXINT 0x20        /* enable TX int */
126 #define UCTRL_CNTRL     0x03        /* control field */
127 #define UCTRL_CNTRL_SWR 0x03        /* software reset command */
128 
129 #define SCTRL_P2ENDINC    0x00380000  /*  */
130 #define SCTRL_SH_P2ENDINC 19
131 #define SCTRL_P2STINC     0x00070000  /*  */
132 #define SCTRL_SH_P2STINC  16
133 #define SCTRL_R1LOOPSEL   0x00008000  /* 0 = loop mode */
134 #define SCTRL_P2LOOPSEL   0x00004000  /* 0 = loop mode */
135 #define SCTRL_P1LOOPSEL   0x00002000  /* 0 = loop mode */
136 #define SCTRL_P2PAUSE     0x00001000  /* 1 = pause mode */
137 #define SCTRL_P1PAUSE     0x00000800  /* 1 = pause mode */
138 #define SCTRL_R1INTEN     0x00000400  /* enable interrupt */
139 #define SCTRL_P2INTEN     0x00000200  /* enable interrupt */
140 #define SCTRL_P1INTEN     0x00000100  /* enable interrupt */
141 #define SCTRL_P1SCTRLD    0x00000080  /* reload sample count register for DAC1 */
142 #define SCTRL_P2DACSEN    0x00000040  /* 1 = DAC2 play back last sample when disabled */
143 #define SCTRL_R1SEB       0x00000020  /* 1 = 16bit */
144 #define SCTRL_R1SMB       0x00000010  /* 1 = stereo */
145 #define SCTRL_R1FMT       0x00000030  /* format mask */
146 #define SCTRL_SH_R1FMT    4
147 #define SCTRL_P2SEB       0x00000008  /* 1 = 16bit */
148 #define SCTRL_P2SMB       0x00000004  /* 1 = stereo */
149 #define SCTRL_P2FMT       0x0000000c  /* format mask */
150 #define SCTRL_SH_P2FMT    2
151 #define SCTRL_P1SEB       0x00000002  /* 1 = 16bit */
152 #define SCTRL_P1SMB       0x00000001  /* 1 = stereo */
153 #define SCTRL_P1FMT       0x00000003  /* format mask */
154 #define SCTRL_SH_P1FMT    0
155 
156 /* End blatant GPL violation */
157 
158 #define NB_CHANNELS 3
159 #define DAC1_CHANNEL 0
160 #define DAC2_CHANNEL 1
161 #define ADC_CHANNEL 2
162 
163 static void es1370_dac1_callback (void *opaque, int free);
164 static void es1370_dac2_callback (void *opaque, int free);
165 static void es1370_adc_callback (void *opaque, int avail);
166 
167 #ifdef DEBUG_ES1370
168 
169 #define ldebug(...) AUD_log ("es1370", __VA_ARGS__)
170 
171 static void print_ctl (uint32_t val)
172 {
173     char buf[1024];
174 
175     buf[0] = '\0';
176 #define a(n) if (val & CTRL_##n) strcat (buf, " "#n)
177     a (ADC_STOP);
178     a (XCTL1);
179     a (OPEN);
180     a (MSFMTSEL);
181     a (M_SBB);
182     a (DAC_SYNC);
183     a (CCB_INTRM);
184     a (M_CB);
185     a (XCTL0);
186     a (BREQ);
187     a (DAC1_EN);
188     a (DAC2_EN);
189     a (ADC_EN);
190     a (UART_EN);
191     a (JYSTK_EN);
192     a (CDC_EN);
193     a (SERR_DIS);
194 #undef a
195     AUD_log ("es1370", "ctl - PCLKDIV %d(DAC2 freq %d), freq %d,%s\n",
196              (val & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV,
197              DAC2_DIVTOSR ((val & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV),
198              dac1_samplerate[(val & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL],
199              buf);
200 }
201 
202 static void print_sctl (uint32_t val)
203 {
204     static const char *fmt_names[] = {"8M", "8S", "16M", "16S"};
205     char buf[1024];
206 
207     buf[0] = '\0';
208 
209 #define a(n) if (val & SCTRL_##n) strcat (buf, " "#n)
210 #define b(n) if (!(val & SCTRL_##n)) strcat (buf, " "#n)
211     b (R1LOOPSEL);
212     b (P2LOOPSEL);
213     b (P1LOOPSEL);
214     a (P2PAUSE);
215     a (P1PAUSE);
216     a (R1INTEN);
217     a (P2INTEN);
218     a (P1INTEN);
219     a (P1SCTRLD);
220     a (P2DACSEN);
221     if (buf[0]) {
222         strcat (buf, "\n        ");
223     }
224     else {
225         buf[0] = ' ';
226         buf[1] = '\0';
227     }
228 #undef b
229 #undef a
230     AUD_log ("es1370",
231              "%s"
232              "p2_end_inc %d, p2_st_inc %d, r1_fmt %s, p2_fmt %s, p1_fmt %s\n",
233              buf,
234              (val & SCTRL_P2ENDINC) >> SCTRL_SH_P2ENDINC,
235              (val & SCTRL_P2STINC) >> SCTRL_SH_P2STINC,
236              fmt_names [(val >> SCTRL_SH_R1FMT) & 3],
237              fmt_names [(val >> SCTRL_SH_P2FMT) & 3],
238              fmt_names [(val >> SCTRL_SH_P1FMT) & 3]
239         );
240 }
241 #else
242 #define ldebug(...)
243 #define print_ctl(...)
244 #define print_sctl(...)
245 #endif
246 
247 #ifdef VERBOSE_ES1370
248 #define dolog(...) AUD_log ("es1370", __VA_ARGS__)
249 #else
250 #define dolog(...)
251 #endif
252 
253 #ifndef SILENT_ES1370
254 #define lwarn(...) AUD_log ("es1370: warning", __VA_ARGS__)
255 #else
256 #define lwarn(...)
257 #endif
258 
259 struct chan {
260     uint32_t shift;
261     uint32_t leftover;
262     uint32_t scount;
263     uint32_t frame_addr;
264     uint32_t frame_cnt;
265 };
266 
267 struct ES1370State {
268     PCIDevice dev;
269     QEMUSoundCard card;
270     MemoryRegion io;
271     struct chan chan[NB_CHANNELS];
272     SWVoiceOut *dac_voice[2];
273     SWVoiceIn *adc_voice;
274 
275     uint32_t ctl;
276     uint32_t status;
277     uint32_t mempage;
278     uint32_t codec;
279     uint32_t sctl;
280 };
281 typedef struct ES1370State ES1370State;
282 
283 struct chan_bits {
284     uint32_t ctl_en;
285     uint32_t stat_int;
286     uint32_t sctl_pause;
287     uint32_t sctl_inten;
288     uint32_t sctl_fmt;
289     uint32_t sctl_sh_fmt;
290     uint32_t sctl_loopsel;
291     void (*calc_freq) (ES1370State *s, uint32_t ctl,
292                        uint32_t *old_freq, uint32_t *new_freq);
293 };
294 
295 #define TYPE_ES1370 "ES1370"
296 OBJECT_DECLARE_SIMPLE_TYPE(ES1370State, ES1370)
297 
298 static void es1370_dac1_calc_freq (ES1370State *s, uint32_t ctl,
299                                    uint32_t *old_freq, uint32_t *new_freq);
300 static void es1370_dac2_and_adc_calc_freq (ES1370State *s, uint32_t ctl,
301                                            uint32_t *old_freq,
302                                            uint32_t *new_freq);
303 
304 static const struct chan_bits es1370_chan_bits[] = {
305     {CTRL_DAC1_EN, STAT_DAC1, SCTRL_P1PAUSE, SCTRL_P1INTEN,
306      SCTRL_P1FMT, SCTRL_SH_P1FMT, SCTRL_P1LOOPSEL,
307      es1370_dac1_calc_freq},
308 
309     {CTRL_DAC2_EN, STAT_DAC2, SCTRL_P2PAUSE, SCTRL_P2INTEN,
310      SCTRL_P2FMT, SCTRL_SH_P2FMT, SCTRL_P2LOOPSEL,
311      es1370_dac2_and_adc_calc_freq},
312 
313     {CTRL_ADC_EN, STAT_ADC, 0, SCTRL_R1INTEN,
314      SCTRL_R1FMT, SCTRL_SH_R1FMT, SCTRL_R1LOOPSEL,
315      es1370_dac2_and_adc_calc_freq}
316 };
317 
318 static void es1370_update_status (ES1370State *s, uint32_t new_status)
319 {
320     uint32_t level = new_status & (STAT_DAC1 | STAT_DAC2 | STAT_ADC);
321 
322     if (level) {
323         s->status = new_status | STAT_INTR;
324     }
325     else {
326         s->status = new_status & ~STAT_INTR;
327     }
328     pci_set_irq(&s->dev, !!level);
329 }
330 
331 static void es1370_reset (ES1370State *s)
332 {
333     size_t i;
334 
335     s->ctl = 1;
336     s->status = 0x60;
337     s->mempage = 0;
338     s->codec = 0;
339     s->sctl = 0;
340 
341     for (i = 0; i < NB_CHANNELS; ++i) {
342         struct chan *d = &s->chan[i];
343         d->scount = 0;
344         d->leftover = 0;
345         if (i == ADC_CHANNEL) {
346             AUD_close_in (&s->card, s->adc_voice);
347             s->adc_voice = NULL;
348         }
349         else {
350             AUD_close_out (&s->card, s->dac_voice[i]);
351             s->dac_voice[i] = NULL;
352         }
353     }
354     pci_irq_deassert(&s->dev);
355 }
356 
357 static void es1370_maybe_lower_irq (ES1370State *s, uint32_t sctl)
358 {
359     uint32_t new_status = s->status;
360 
361     if (!(sctl & SCTRL_P1INTEN) && (s->sctl & SCTRL_P1INTEN)) {
362         new_status &= ~STAT_DAC1;
363     }
364 
365     if (!(sctl & SCTRL_P2INTEN) && (s->sctl & SCTRL_P2INTEN)) {
366         new_status &= ~STAT_DAC2;
367     }
368 
369     if (!(sctl & SCTRL_R1INTEN) && (s->sctl & SCTRL_R1INTEN)) {
370         new_status &= ~STAT_ADC;
371     }
372 
373     if (new_status != s->status) {
374         es1370_update_status (s, new_status);
375     }
376 }
377 
378 static void es1370_dac1_calc_freq (ES1370State *s, uint32_t ctl,
379                                    uint32_t *old_freq, uint32_t *new_freq)
380 
381 {
382     *old_freq = dac1_samplerate[(s->ctl & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL];
383     *new_freq = dac1_samplerate[(ctl & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL];
384 }
385 
386 static void es1370_dac2_and_adc_calc_freq (ES1370State *s, uint32_t ctl,
387                                            uint32_t *old_freq,
388                                            uint32_t *new_freq)
389 
390 {
391     uint32_t old_pclkdiv, new_pclkdiv;
392 
393     new_pclkdiv = (ctl & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV;
394     old_pclkdiv = (s->ctl & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV;
395     *new_freq = DAC2_DIVTOSR (new_pclkdiv);
396     *old_freq = DAC2_DIVTOSR (old_pclkdiv);
397 }
398 
399 static void es1370_update_voices (ES1370State *s, uint32_t ctl, uint32_t sctl)
400 {
401     size_t i;
402     uint32_t old_freq, new_freq, old_fmt, new_fmt;
403 
404     for (i = 0; i < NB_CHANNELS; ++i) {
405         struct chan *d = &s->chan[i];
406         const struct chan_bits *b = &es1370_chan_bits[i];
407 
408         new_fmt = (sctl & b->sctl_fmt) >> b->sctl_sh_fmt;
409         old_fmt = (s->sctl & b->sctl_fmt) >> b->sctl_sh_fmt;
410 
411         b->calc_freq (s, ctl, &old_freq, &new_freq);
412 
413         if ((old_fmt != new_fmt) || (old_freq != new_freq)) {
414             d->shift = (new_fmt & 1) + (new_fmt >> 1);
415             ldebug ("channel %zu, freq = %d, nchannels %d, fmt %d, shift %d\n",
416                     i,
417                     new_freq,
418                     1 << (new_fmt & 1),
419                     (new_fmt & 2) ? AUDIO_FORMAT_S16 : AUDIO_FORMAT_U8,
420                     d->shift);
421             if (new_freq) {
422                 struct audsettings as;
423 
424                 as.freq = new_freq;
425                 as.nchannels = 1 << (new_fmt & 1);
426                 as.fmt = (new_fmt & 2) ? AUDIO_FORMAT_S16 : AUDIO_FORMAT_U8;
427                 as.endianness = 0;
428 
429                 if (i == ADC_CHANNEL) {
430                     s->adc_voice =
431                         AUD_open_in (
432                             &s->card,
433                             s->adc_voice,
434                             "es1370.adc",
435                             s,
436                             es1370_adc_callback,
437                             &as
438                             );
439                 }
440                 else {
441                     s->dac_voice[i] =
442                         AUD_open_out (
443                             &s->card,
444                             s->dac_voice[i],
445                             i ? "es1370.dac2" : "es1370.dac1",
446                             s,
447                             i ? es1370_dac2_callback : es1370_dac1_callback,
448                             &as
449                             );
450                 }
451             }
452         }
453 
454         if (((ctl ^ s->ctl) & b->ctl_en)
455             || ((sctl ^ s->sctl) & b->sctl_pause)) {
456             int on = (ctl & b->ctl_en) && !(sctl & b->sctl_pause);
457 
458             if (i == ADC_CHANNEL) {
459                 AUD_set_active_in (s->adc_voice, on);
460             }
461             else {
462                 AUD_set_active_out (s->dac_voice[i], on);
463             }
464         }
465     }
466 
467     s->ctl = ctl;
468     s->sctl = sctl;
469 }
470 
471 static inline uint32_t es1370_fixup (ES1370State *s, uint32_t addr)
472 {
473     addr &= 0xff;
474     if (addr >= 0x30 && addr <= 0x3f)
475         addr |= s->mempage << 8;
476     return addr;
477 }
478 
479 static void es1370_write(void *opaque, hwaddr addr, uint64_t val, unsigned size)
480 {
481     ES1370State *s = opaque;
482     struct chan *d = &s->chan[0];
483 
484     addr = es1370_fixup (s, addr);
485 
486     switch (addr) {
487     case ES1370_REG_CONTROL:
488         es1370_update_voices (s, val, s->sctl);
489         print_ctl (val);
490         break;
491 
492     case ES1370_REG_MEMPAGE:
493         s->mempage = val & 0xf;
494         break;
495 
496     case ES1370_REG_SERIAL_CONTROL:
497         es1370_maybe_lower_irq (s, val);
498         es1370_update_voices (s, s->ctl, val);
499         print_sctl (val);
500         break;
501 
502     case ES1370_REG_DAC1_SCOUNT:
503     case ES1370_REG_DAC2_SCOUNT:
504     case ES1370_REG_ADC_SCOUNT:
505         d += (addr - ES1370_REG_DAC1_SCOUNT) >> 2;
506         d->scount = (val & 0xffff) | (d->scount & ~0xffff);
507         ldebug ("chan %td CURR_SAMP_CT %d, SAMP_CT %d\n",
508                 d - &s->chan[0], val >> 16, (val & 0xffff));
509         break;
510 
511     case ES1370_REG_ADC_FRAMEADR:
512         d += 2;
513         goto frameadr;
514     case ES1370_REG_DAC1_FRAMEADR:
515     case ES1370_REG_DAC2_FRAMEADR:
516         d += (addr - ES1370_REG_DAC1_FRAMEADR) >> 3;
517     frameadr:
518         d->frame_addr = val;
519         ldebug ("chan %td frame address %#x\n", d - &s->chan[0], val);
520         break;
521 
522     case ES1370_REG_PHANTOM_FRAMECNT:
523         lwarn ("writing to phantom frame count %#x\n", val);
524         break;
525     case ES1370_REG_PHANTOM_FRAMEADR:
526         lwarn ("writing to phantom frame address %#x\n", val);
527         break;
528 
529     case ES1370_REG_ADC_FRAMECNT:
530         d += 2;
531         goto framecnt;
532     case ES1370_REG_DAC1_FRAMECNT:
533     case ES1370_REG_DAC2_FRAMECNT:
534         d += (addr - ES1370_REG_DAC1_FRAMECNT) >> 3;
535     framecnt:
536         d->frame_cnt = val;
537         d->leftover = 0;
538         ldebug ("chan %td frame count %d, buffer size %d\n",
539                 d - &s->chan[0], val >> 16, val & 0xffff);
540         break;
541 
542     default:
543         lwarn ("writel %#x <- %#x\n", addr, val);
544         break;
545     }
546 }
547 
548 static uint64_t es1370_read(void *opaque, hwaddr addr, unsigned size)
549 {
550     ES1370State *s = opaque;
551     uint32_t val;
552     struct chan *d = &s->chan[0];
553 
554     addr = es1370_fixup (s, addr);
555 
556     switch (addr) {
557     case ES1370_REG_CONTROL:
558         val = s->ctl;
559         break;
560     case ES1370_REG_STATUS:
561         val = s->status;
562         break;
563     case ES1370_REG_MEMPAGE:
564         val = s->mempage;
565         break;
566     case ES1370_REG_CODEC:
567         val = s->codec;
568         break;
569     case ES1370_REG_SERIAL_CONTROL:
570         val = s->sctl;
571         break;
572 
573     case ES1370_REG_DAC1_SCOUNT:
574     case ES1370_REG_DAC2_SCOUNT:
575     case ES1370_REG_ADC_SCOUNT:
576         d += (addr - ES1370_REG_DAC1_SCOUNT) >> 2;
577         val = d->scount;
578 #ifdef DEBUG_ES1370
579         {
580             uint32_t curr_count = d->scount >> 16;
581             uint32_t count = d->scount & 0xffff;
582 
583             curr_count <<= d->shift;
584             count <<= d->shift;
585             dolog ("read scount curr %d, total %d\n", curr_count, count);
586         }
587 #endif
588         break;
589 
590     case ES1370_REG_ADC_FRAMECNT:
591         d += 2;
592         goto framecnt;
593     case ES1370_REG_DAC1_FRAMECNT:
594     case ES1370_REG_DAC2_FRAMECNT:
595         d += (addr - ES1370_REG_DAC1_FRAMECNT) >> 3;
596     framecnt:
597         val = d->frame_cnt;
598 #ifdef DEBUG_ES1370
599         {
600             uint32_t size = ((d->frame_cnt & 0xffff) + 1) << 2;
601             uint32_t curr = ((d->frame_cnt >> 16) + 1) << 2;
602             if (curr > size) {
603                 dolog ("read framecnt curr %d, size %d %d\n", curr, size,
604                        curr > size);
605             }
606         }
607 #endif
608         break;
609 
610     case ES1370_REG_ADC_FRAMEADR:
611         d += 2;
612         goto frameadr;
613     case ES1370_REG_DAC1_FRAMEADR:
614     case ES1370_REG_DAC2_FRAMEADR:
615         d += (addr - ES1370_REG_DAC1_FRAMEADR) >> 3;
616     frameadr:
617         val = d->frame_addr;
618         break;
619 
620     case ES1370_REG_PHANTOM_FRAMECNT:
621         val = ~0U;
622         lwarn ("reading from phantom frame count\n");
623         break;
624     case ES1370_REG_PHANTOM_FRAMEADR:
625         val = ~0U;
626         lwarn ("reading from phantom frame address\n");
627         break;
628 
629     default:
630         val = ~0U;
631         lwarn ("readl %#x -> %#x\n", addr, val);
632         break;
633     }
634     return val;
635 }
636 
637 static void es1370_transfer_audio (ES1370State *s, struct chan *d, int loop_sel,
638                                    int max, int *irq)
639 {
640     uint8_t tmpbuf[4096];
641     uint32_t addr = d->frame_addr;
642     int sc = d->scount & 0xffff;
643     int csc = d->scount >> 16;
644     int csc_bytes = (csc + 1) << d->shift;
645     int cnt = d->frame_cnt >> 16;
646     int size = d->frame_cnt & 0xffff;
647     if (size < cnt) {
648         return;
649     }
650     int left = ((size - cnt + 1) << 2) + d->leftover;
651     int transferred = 0;
652     int temp = MIN (max, MIN (left, csc_bytes));
653     int index = d - &s->chan[0];
654 
655     addr += (cnt << 2) + d->leftover;
656 
657     if (index == ADC_CHANNEL) {
658         while (temp > 0) {
659             int acquired, to_copy;
660 
661             to_copy = MIN ((size_t) temp, sizeof (tmpbuf));
662             acquired = AUD_read (s->adc_voice, tmpbuf, to_copy);
663             if (!acquired)
664                 break;
665 
666             pci_dma_write (&s->dev, addr, tmpbuf, acquired);
667 
668             temp -= acquired;
669             addr += acquired;
670             transferred += acquired;
671         }
672     }
673     else {
674         SWVoiceOut *voice = s->dac_voice[index];
675 
676         while (temp > 0) {
677             int copied, to_copy;
678 
679             to_copy = MIN ((size_t) temp, sizeof (tmpbuf));
680             pci_dma_read (&s->dev, addr, tmpbuf, to_copy);
681             copied = AUD_write (voice, tmpbuf, to_copy);
682             if (!copied)
683                 break;
684             temp -= copied;
685             addr += copied;
686             transferred += copied;
687         }
688     }
689 
690     if (csc_bytes == transferred) {
691         *irq = 1;
692         d->scount = sc | (sc << 16);
693         ldebug ("sc = %d, rate = %f\n",
694                 (sc + 1) << d->shift,
695                 (sc + 1) / (double) 44100);
696     }
697     else {
698         *irq = 0;
699         d->scount = sc | (((csc_bytes - transferred - 1) >> d->shift) << 16);
700     }
701 
702     cnt += (transferred + d->leftover) >> 2;
703 
704     if (s->sctl & loop_sel) {
705         /* Bah, how stupid is that having a 0 represent true value?
706            i just spent few hours on this shit */
707         AUD_log ("es1370: warning", "non looping mode\n");
708     }
709     else {
710         d->frame_cnt = size;
711 
712         if ((uint32_t) cnt <= d->frame_cnt)
713             d->frame_cnt |= cnt << 16;
714     }
715 
716     d->leftover = (transferred + d->leftover) & 3;
717 }
718 
719 static void es1370_run_channel (ES1370State *s, size_t chan, int free_or_avail)
720 {
721     uint32_t new_status = s->status;
722     int max_bytes, irq;
723     struct chan *d = &s->chan[chan];
724     const struct chan_bits *b = &es1370_chan_bits[chan];
725 
726     if (!(s->ctl & b->ctl_en) || (s->sctl & b->sctl_pause)) {
727         return;
728     }
729 
730     max_bytes = free_or_avail;
731     max_bytes &= ~((1 << d->shift) - 1);
732     if (!max_bytes) {
733         return;
734     }
735 
736     es1370_transfer_audio (s, d, b->sctl_loopsel, max_bytes, &irq);
737 
738     if (irq) {
739         if (s->sctl & b->sctl_inten) {
740             new_status |= b->stat_int;
741         }
742     }
743 
744     if (new_status != s->status) {
745         es1370_update_status (s, new_status);
746     }
747 }
748 
749 static void es1370_dac1_callback (void *opaque, int free)
750 {
751     ES1370State *s = opaque;
752 
753     es1370_run_channel (s, DAC1_CHANNEL, free);
754 }
755 
756 static void es1370_dac2_callback (void *opaque, int free)
757 {
758     ES1370State *s = opaque;
759 
760     es1370_run_channel (s, DAC2_CHANNEL, free);
761 }
762 
763 static void es1370_adc_callback (void *opaque, int avail)
764 {
765     ES1370State *s = opaque;
766 
767     es1370_run_channel (s, ADC_CHANNEL, avail);
768 }
769 
770 static const MemoryRegionOps es1370_io_ops = {
771     .read = es1370_read,
772     .write = es1370_write,
773     .valid = {
774         .min_access_size = 1,
775         .max_access_size = 4,
776     },
777     .impl = {
778         .min_access_size = 4,
779         .max_access_size = 4,
780     },
781     .endianness = DEVICE_LITTLE_ENDIAN,
782 };
783 
784 static const VMStateDescription vmstate_es1370_channel = {
785     .name = "es1370_channel",
786     .version_id = 2,
787     .minimum_version_id = 2,
788     .fields = (VMStateField[]) {
789         VMSTATE_UINT32 (shift, struct chan),
790         VMSTATE_UINT32 (leftover, struct chan),
791         VMSTATE_UINT32 (scount, struct chan),
792         VMSTATE_UINT32 (frame_addr, struct chan),
793         VMSTATE_UINT32 (frame_cnt, struct chan),
794         VMSTATE_END_OF_LIST ()
795     }
796 };
797 
798 static int es1370_post_load (void *opaque, int version_id)
799 {
800     uint32_t ctl, sctl;
801     ES1370State *s = opaque;
802     size_t i;
803 
804     for (i = 0; i < NB_CHANNELS; ++i) {
805         if (i == ADC_CHANNEL) {
806             if (s->adc_voice) {
807                 AUD_close_in (&s->card, s->adc_voice);
808                 s->adc_voice = NULL;
809             }
810         }
811         else {
812             if (s->dac_voice[i]) {
813                 AUD_close_out (&s->card, s->dac_voice[i]);
814                 s->dac_voice[i] = NULL;
815             }
816         }
817     }
818 
819     ctl = s->ctl;
820     sctl = s->sctl;
821     s->ctl = 0;
822     s->sctl = 0;
823     es1370_update_voices (s, ctl, sctl);
824     return 0;
825 }
826 
827 static const VMStateDescription vmstate_es1370 = {
828     .name = "es1370",
829     .version_id = 2,
830     .minimum_version_id = 2,
831     .post_load = es1370_post_load,
832     .fields = (VMStateField[]) {
833         VMSTATE_PCI_DEVICE (dev, ES1370State),
834         VMSTATE_STRUCT_ARRAY (chan, ES1370State, NB_CHANNELS, 2,
835                               vmstate_es1370_channel, struct chan),
836         VMSTATE_UINT32 (ctl, ES1370State),
837         VMSTATE_UINT32 (status, ES1370State),
838         VMSTATE_UINT32 (mempage, ES1370State),
839         VMSTATE_UINT32 (codec, ES1370State),
840         VMSTATE_UINT32 (sctl, ES1370State),
841         VMSTATE_END_OF_LIST ()
842     }
843 };
844 
845 static void es1370_on_reset(DeviceState *dev)
846 {
847     ES1370State *s = container_of(dev, ES1370State, dev.qdev);
848     es1370_reset (s);
849 }
850 
851 static void es1370_realize(PCIDevice *dev, Error **errp)
852 {
853     ES1370State *s = ES1370(dev);
854     uint8_t *c = s->dev.config;
855 
856     c[PCI_STATUS + 1] = PCI_STATUS_DEVSEL_SLOW >> 8;
857 
858 #if 0
859     c[PCI_CAPABILITY_LIST] = 0xdc;
860     c[PCI_INTERRUPT_LINE] = 10;
861     c[0xdc] = 0x00;
862 #endif
863 
864     c[PCI_INTERRUPT_PIN] = 1;
865     c[PCI_MIN_GNT] = 0x0c;
866     c[PCI_MAX_LAT] = 0x80;
867 
868     memory_region_init_io (&s->io, OBJECT(s), &es1370_io_ops, s, "es1370", 256);
869     pci_register_bar (&s->dev, 0, PCI_BASE_ADDRESS_SPACE_IO, &s->io);
870 
871     AUD_register_card ("es1370", &s->card);
872     es1370_reset (s);
873 }
874 
875 static void es1370_exit(PCIDevice *dev)
876 {
877     ES1370State *s = ES1370(dev);
878     int i;
879 
880     for (i = 0; i < 2; ++i) {
881         AUD_close_out(&s->card, s->dac_voice[i]);
882     }
883 
884     AUD_close_in(&s->card, s->adc_voice);
885     AUD_remove_card(&s->card);
886 }
887 
888 static Property es1370_properties[] = {
889     DEFINE_AUDIO_PROPERTIES(ES1370State, card),
890     DEFINE_PROP_END_OF_LIST(),
891 };
892 
893 static void es1370_class_init (ObjectClass *klass, void *data)
894 {
895     DeviceClass *dc = DEVICE_CLASS (klass);
896     PCIDeviceClass *k = PCI_DEVICE_CLASS (klass);
897 
898     k->realize = es1370_realize;
899     k->exit = es1370_exit;
900     k->vendor_id = PCI_VENDOR_ID_ENSONIQ;
901     k->device_id = PCI_DEVICE_ID_ENSONIQ_ES1370;
902     k->class_id = PCI_CLASS_MULTIMEDIA_AUDIO;
903     k->subsystem_vendor_id = 0x4942;
904     k->subsystem_id = 0x4c4c;
905     set_bit(DEVICE_CATEGORY_SOUND, dc->categories);
906     dc->desc = "ENSONIQ AudioPCI ES1370";
907     dc->vmsd = &vmstate_es1370;
908     dc->reset = es1370_on_reset;
909     device_class_set_props(dc, es1370_properties);
910 }
911 
912 static const TypeInfo es1370_info = {
913     .name          = TYPE_ES1370,
914     .parent        = TYPE_PCI_DEVICE,
915     .instance_size = sizeof (ES1370State),
916     .class_init    = es1370_class_init,
917     .interfaces = (InterfaceInfo[]) {
918         { INTERFACE_CONVENTIONAL_PCI_DEVICE },
919         { },
920     },
921 };
922 
923 static void es1370_register_types (void)
924 {
925     type_register_static (&es1370_info);
926     deprecated_register_soundhw("es1370", "ENSONIQ AudioPCI ES1370",
927                                 0, TYPE_ES1370);
928 }
929 
930 type_init (es1370_register_types)
931