?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Kill redundant declarion of perror()
[qemu-kvm/fedora.git] / hw / es1370.c
blobbad237d21fc5739b61f0c72e194a1ef2368f8c3f
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 "hw.h"
30 #include "audiodev.h"
31 #include "audio/audio.h"
32 #include "pci.h"
33
34 /* Missing stuff:
35 SCTRL_P[12](END|ST)INC
36 SCTRL_P1SCTRLD
37 SCTRL_P2DACSEN
38 CTRL_DAC_SYNC
39 MIDI
40 non looped mode
41 surely more
42 */
43
44 /*
45 Following macros and samplerate array were copied verbatim from
46 Linux kernel 2.4.30: drivers/sound/es1370.c
47
48 Copyright (C) 1998-2001, 2003 Thomas Sailer (t.sailer@alumni.ethz.ch)
49 */
50
51 /* Start blatant GPL violation */
52
53 #define ES1370_REG_CONTROL 0x00
54 #define ES1370_REG_STATUS 0x04
55 #define ES1370_REG_UART_DATA 0x08
56 #define ES1370_REG_UART_STATUS 0x09
57 #define ES1370_REG_UART_CONTROL 0x09
58 #define ES1370_REG_UART_TEST 0x0a
59 #define ES1370_REG_MEMPAGE 0x0c
60 #define ES1370_REG_CODEC 0x10
61 #define ES1370_REG_SERIAL_CONTROL 0x20
62 #define ES1370_REG_DAC1_SCOUNT 0x24
63 #define ES1370_REG_DAC2_SCOUNT 0x28
64 #define ES1370_REG_ADC_SCOUNT 0x2c
65
66 #define ES1370_REG_DAC1_FRAMEADR 0xc30
67 #define ES1370_REG_DAC1_FRAMECNT 0xc34
68 #define ES1370_REG_DAC2_FRAMEADR 0xc38
69 #define ES1370_REG_DAC2_FRAMECNT 0xc3c
70 #define ES1370_REG_ADC_FRAMEADR 0xd30
71 #define ES1370_REG_ADC_FRAMECNT 0xd34
72 #define ES1370_REG_PHANTOM_FRAMEADR 0xd38
73 #define ES1370_REG_PHANTOM_FRAMECNT 0xd3c
74
75 static const unsigned dac1_samplerate[] = { 5512, 11025, 22050, 44100 };
76
77 #define DAC2_SRTODIV(x) (((1411200+(x)/2)/(x))-2)
78 #define DAC2_DIVTOSR(x) (1411200/((x)+2))
79
80 #define CTRL_ADC_STOP 0x80000000 /* 1 = ADC stopped */
81 #define CTRL_XCTL1 0x40000000 /* electret mic bias */
82 #define CTRL_OPEN 0x20000000 /* no function, can be read and written */
83 #define CTRL_PCLKDIV 0x1fff0000 /* ADC/DAC2 clock divider */
84 #define CTRL_SH_PCLKDIV 16
85 #define CTRL_MSFMTSEL 0x00008000 /* MPEG serial data fmt: 0 = Sony, 1 = I2S */
86 #define CTRL_M_SBB 0x00004000 /* DAC2 clock: 0 = PCLKDIV, 1 = MPEG */
87 #define CTRL_WTSRSEL 0x00003000 /* DAC1 clock freq: 0=5512, 1=11025, 2=22050, 3=44100 */
88 #define CTRL_SH_WTSRSEL 12
89 #define CTRL_DAC_SYNC 0x00000800 /* 1 = DAC2 runs off DAC1 clock */
90 #define CTRL_CCB_INTRM 0x00000400 /* 1 = CCB "voice" ints enabled */
91 #define CTRL_M_CB 0x00000200 /* recording source: 0 = ADC, 1 = MPEG */
92 #define CTRL_XCTL0 0x00000100 /* 0 = Line in, 1 = Line out */
93 #define CTRL_BREQ 0x00000080 /* 1 = test mode (internal mem test) */
94 #define CTRL_DAC1_EN 0x00000040 /* enable DAC1 */
95 #define CTRL_DAC2_EN 0x00000020 /* enable DAC2 */
96 #define CTRL_ADC_EN 0x00000010 /* enable ADC */
97 #define CTRL_UART_EN 0x00000008 /* enable MIDI uart */
98 #define CTRL_JYSTK_EN 0x00000004 /* enable Joystick port (presumably at address 0x200) */
99 #define CTRL_CDC_EN 0x00000002 /* enable serial (CODEC) interface */
100 #define CTRL_SERR_DIS 0x00000001 /* 1 = disable PCI SERR signal */
101
102 #define STAT_INTR 0x80000000 /* wired or of all interrupt bits */
103 #define STAT_CSTAT 0x00000400 /* 1 = codec busy or codec write in progress */
104 #define STAT_CBUSY 0x00000200 /* 1 = codec busy */
105 #define STAT_CWRIP 0x00000100 /* 1 = codec write in progress */
106 #define STAT_VC 0x00000060 /* CCB int source, 0=DAC1, 1=DAC2, 2=ADC, 3=undef */
107 #define STAT_SH_VC 5
108 #define STAT_MCCB 0x00000010 /* CCB int pending */
109 #define STAT_UART 0x00000008 /* UART int pending */
110 #define STAT_DAC1 0x00000004 /* DAC1 int pending */
111 #define STAT_DAC2 0x00000002 /* DAC2 int pending */
112 #define STAT_ADC 0x00000001 /* ADC int pending */
113
114 #define USTAT_RXINT 0x80 /* UART rx int pending */
115 #define USTAT_TXINT 0x04 /* UART tx int pending */
116 #define USTAT_TXRDY 0x02 /* UART tx ready */
117 #define USTAT_RXRDY 0x01 /* UART rx ready */
118
119 #define UCTRL_RXINTEN 0x80 /* 1 = enable RX ints */
120 #define UCTRL_TXINTEN 0x60 /* TX int enable field mask */
121 #define UCTRL_ENA_TXINT 0x20 /* enable TX int */
122 #define UCTRL_CNTRL 0x03 /* control field */
123 #define UCTRL_CNTRL_SWR 0x03 /* software reset command */
124
125 #define SCTRL_P2ENDINC 0x00380000 /* */
126 #define SCTRL_SH_P2ENDINC 19
127 #define SCTRL_P2STINC 0x00070000 /* */
128 #define SCTRL_SH_P2STINC 16
129 #define SCTRL_R1LOOPSEL 0x00008000 /* 0 = loop mode */
130 #define SCTRL_P2LOOPSEL 0x00004000 /* 0 = loop mode */
131 #define SCTRL_P1LOOPSEL 0x00002000 /* 0 = loop mode */
132 #define SCTRL_P2PAUSE 0x00001000 /* 1 = pause mode */
133 #define SCTRL_P1PAUSE 0x00000800 /* 1 = pause mode */
134 #define SCTRL_R1INTEN 0x00000400 /* enable interrupt */
135 #define SCTRL_P2INTEN 0x00000200 /* enable interrupt */
136 #define SCTRL_P1INTEN 0x00000100 /* enable interrupt */
137 #define SCTRL_P1SCTRLD 0x00000080 /* reload sample count register for DAC1 */
138 #define SCTRL_P2DACSEN 0x00000040 /* 1 = DAC2 play back last sample when disabled */
139 #define SCTRL_R1SEB 0x00000020 /* 1 = 16bit */
140 #define SCTRL_R1SMB 0x00000010 /* 1 = stereo */
141 #define SCTRL_R1FMT 0x00000030 /* format mask */
142 #define SCTRL_SH_R1FMT 4
143 #define SCTRL_P2SEB 0x00000008 /* 1 = 16bit */
144 #define SCTRL_P2SMB 0x00000004 /* 1 = stereo */
145 #define SCTRL_P2FMT 0x0000000c /* format mask */
146 #define SCTRL_SH_P2FMT 2
147 #define SCTRL_P1SEB 0x00000002 /* 1 = 16bit */
148 #define SCTRL_P1SMB 0x00000001 /* 1 = stereo */
149 #define SCTRL_P1FMT 0x00000003 /* format mask */
150 #define SCTRL_SH_P1FMT 0
151
152 /* End blatant GPL violation */
153
154 #define NB_CHANNELS 3
155 #define DAC1_CHANNEL 0
156 #define DAC2_CHANNEL 1
157 #define ADC_CHANNEL 2
158
159 #define IO_READ_PROTO(n) \
160 static uint32_t n (void *opaque, uint32_t addr)
161 #define IO_WRITE_PROTO(n) \
162 static void n (void *opaque, uint32_t addr, uint32_t val)
163
164 static void es1370_dac1_callback (void *opaque, int free);
165 static void es1370_dac2_callback (void *opaque, int free);
166 static void es1370_adc_callback (void *opaque, int avail);
167
168 #ifdef DEBUG_ES1370
169
170 #define ldebug(...) AUD_log ("es1370", __VA_ARGS__)
171
172 static void print_ctl (uint32_t val)
173 {
174 char buf[1024];
175
176 buf[0] = '\0';
177 #define a(n) if (val & CTRL_##n) strcat (buf, " "#n)
178 a (ADC_STOP);
179 a (XCTL1);
180 a (OPEN);
181 a (MSFMTSEL);
182 a (M_SBB);
183 a (DAC_SYNC);
184 a (CCB_INTRM);
185 a (M_CB);
186 a (XCTL0);
187 a (BREQ);
188 a (DAC1_EN);
189 a (DAC2_EN);
190 a (ADC_EN);
191 a (UART_EN);
192 a (JYSTK_EN);
193 a (CDC_EN);
194 a (SERR_DIS);
195 #undef a
196 AUD_log ("es1370", "ctl - PCLKDIV %d(DAC2 freq %d), freq %d,%s\n",
197 (val & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV,
198 DAC2_DIVTOSR ((val & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV),
199 dac1_samplerate[(val & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL],
200 buf);
201 }
202
203 static void print_sctl (uint32_t val)
204 {
205 static const char *fmt_names[] = {"8M", "8S", "16M", "16S"};
206 char buf[1024];
207
208 buf[0] = '\0';
209
210 #define a(n) if (val & SCTRL_##n) strcat (buf, " "#n)
211 #define b(n) if (!(val & SCTRL_##n)) strcat (buf, " "#n)
212 b (R1LOOPSEL);
213 b (P2LOOPSEL);
214 b (P1LOOPSEL);
215 a (P2PAUSE);
216 a (P1PAUSE);
217 a (R1INTEN);
218 a (P2INTEN);
219 a (P1INTEN);
220 a (P1SCTRLD);
221 a (P2DACSEN);
222 if (buf[0]) {
223 strcat (buf, "\n ");
224 }
225 else {
226 buf[0] = ' ';
227 buf[1] = '\0';
228 }
229 #undef b
230 #undef a
231 AUD_log ("es1370",
232 "%s"
233 "p2_end_inc %d, p2_st_inc %d, r1_fmt %s, p2_fmt %s, p1_fmt %s\n",
234 buf,
235 (val & SCTRL_P2ENDINC) >> SCTRL_SH_P2ENDINC,
236 (val & SCTRL_P2STINC) >> SCTRL_SH_P2STINC,
237 fmt_names [(val >> SCTRL_SH_R1FMT) & 3],
238 fmt_names [(val >> SCTRL_SH_P2FMT) & 3],
239 fmt_names [(val >> SCTRL_SH_P1FMT) & 3]
240 );
241 }
242 #else
243 #define ldebug(...)
244 #define print_ctl(...)
245 #define print_sctl(...)
246 #endif
247
248 #ifdef VERBOSE_ES1370
249 #define dolog(...) AUD_log ("es1370", __VA_ARGS__)
250 #else
251 #define dolog(...)
252 #endif
253
254 #ifndef SILENT_ES1370
255 #define lwarn(...) AUD_log ("es1370: warning", __VA_ARGS__)
256 #else
257 #define lwarn(...)
258 #endif
259
260 struct chan {
261 uint32_t shift;
262 uint32_t leftover;
263 uint32_t scount;
264 uint32_t frame_addr;
265 uint32_t frame_cnt;
266 };
267
268 typedef struct ES1370State {
269 PCIDevice *pci_dev;
270
271 QEMUSoundCard card;
272 struct chan chan[NB_CHANNELS];
273 SWVoiceOut *dac_voice[2];
274 SWVoiceIn *adc_voice;
275
276 uint32_t ctl;
277 uint32_t status;
278 uint32_t mempage;
279 uint32_t codec;
280 uint32_t sctl;
281 } ES1370State;
282
283 typedef struct PCIES1370State {
284 PCIDevice dev;
285 ES1370State es1370;
286 } PCIES1370State;
287
288 struct chan_bits {
289 uint32_t ctl_en;
290 uint32_t stat_int;
291 uint32_t sctl_pause;
292 uint32_t sctl_inten;
293 uint32_t sctl_fmt;
294 uint32_t sctl_sh_fmt;
295 uint32_t sctl_loopsel;
296 void (*calc_freq) (ES1370State *s, uint32_t ctl,
297 uint32_t *old_freq, uint32_t *new_freq);
298 };
299
300 static void es1370_dac1_calc_freq (ES1370State *s, uint32_t ctl,
301 uint32_t *old_freq, uint32_t *new_freq);
302 static void es1370_dac2_and_adc_calc_freq (ES1370State *s, uint32_t ctl,
303 uint32_t *old_freq,
304 uint32_t *new_freq);
305
306 static const struct chan_bits es1370_chan_bits[] = {
307 {CTRL_DAC1_EN, STAT_DAC1, SCTRL_P1PAUSE, SCTRL_P1INTEN,
308 SCTRL_P1FMT, SCTRL_SH_P1FMT, SCTRL_P1LOOPSEL,
309 es1370_dac1_calc_freq},
310
311 {CTRL_DAC2_EN, STAT_DAC2, SCTRL_P2PAUSE, SCTRL_P2INTEN,
312 SCTRL_P2FMT, SCTRL_SH_P2FMT, SCTRL_P2LOOPSEL,
313 es1370_dac2_and_adc_calc_freq},
314
315 {CTRL_ADC_EN, STAT_ADC, 0, SCTRL_R1INTEN,
316 SCTRL_R1FMT, SCTRL_SH_R1FMT, SCTRL_R1LOOPSEL,
317 es1370_dac2_and_adc_calc_freq}
318 };
319
320 static void es1370_update_status (ES1370State *s, uint32_t new_status)
321 {
322 uint32_t level = new_status & (STAT_DAC1 | STAT_DAC2 | STAT_ADC);
323
324 if (level) {
325 s->status = new_status | STAT_INTR;
326 }
327 else {
328 s->status = new_status & ~STAT_INTR;
329 }
330 qemu_set_irq(s->pci_dev->irq[0], !!level);
331 }
332
333 static void es1370_reset (ES1370State *s)
334 {
335 size_t i;
336
337 s->ctl = 1;
338 s->status = 0x60;
339 s->mempage = 0;
340 s->codec = 0;
341 s->sctl = 0;
342
343 for (i = 0; i < NB_CHANNELS; ++i) {
344 struct chan *d = &s->chan[i];
345 d->scount = 0;
346 d->leftover = 0;
347 if (i == ADC_CHANNEL) {
348 AUD_close_in (&s->card, s->adc_voice);
349 s->adc_voice = NULL;
350 }
351 else {
352 AUD_close_out (&s->card, s->dac_voice[i]);
353 s->dac_voice[i] = NULL;
354 }
355 }
356 qemu_irq_lower(s->pci_dev->irq[0]);
357 }
358
359 static void es1370_maybe_lower_irq (ES1370State *s, uint32_t sctl)
360 {
361 uint32_t new_status = s->status;
362
363 if (!(sctl & SCTRL_P1INTEN) && (s->sctl & SCTRL_P1INTEN)) {
364 new_status &= ~STAT_DAC1;
365 }
366
367 if (!(sctl & SCTRL_P2INTEN) && (s->sctl & SCTRL_P2INTEN)) {
368 new_status &= ~STAT_DAC2;
369 }
370
371 if (!(sctl & SCTRL_R1INTEN) && (s->sctl & SCTRL_R1INTEN)) {
372 new_status &= ~STAT_ADC;
373 }
374
375 if (new_status != s->status) {
376 es1370_update_status (s, new_status);
377 }
378 }
379
380 static void es1370_dac1_calc_freq (ES1370State *s, uint32_t ctl,
381 uint32_t *old_freq, uint32_t *new_freq)
382
383 {
384 *old_freq = dac1_samplerate[(s->ctl & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL];
385 *new_freq = dac1_samplerate[(ctl & CTRL_WTSRSEL) >> CTRL_SH_WTSRSEL];
386 }
387
388 static void es1370_dac2_and_adc_calc_freq (ES1370State *s, uint32_t ctl,
389 uint32_t *old_freq,
390 uint32_t *new_freq)
391
392 {
393 uint32_t old_pclkdiv, new_pclkdiv;
394
395 new_pclkdiv = (ctl & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV;
396 old_pclkdiv = (s->ctl & CTRL_PCLKDIV) >> CTRL_SH_PCLKDIV;
397 *new_freq = DAC2_DIVTOSR (new_pclkdiv);
398 *old_freq = DAC2_DIVTOSR (old_pclkdiv);
399 }
400
401 static void es1370_update_voices (ES1370State *s, uint32_t ctl, uint32_t sctl)
402 {
403 size_t i;
404 uint32_t old_freq, new_freq, old_fmt, new_fmt;
405
406 for (i = 0; i < NB_CHANNELS; ++i) {
407 struct chan *d = &s->chan[i];
408 const struct chan_bits *b = &es1370_chan_bits[i];
409
410 new_fmt = (sctl & b->sctl_fmt) >> b->sctl_sh_fmt;
411 old_fmt = (s->sctl & b->sctl_fmt) >> b->sctl_sh_fmt;
412
413 b->calc_freq (s, ctl, &old_freq, &new_freq);
414
415 if ((old_fmt != new_fmt) || (old_freq != new_freq)) {
416 d->shift = (new_fmt & 1) + (new_fmt >> 1);
417 ldebug ("channel %d, freq = %d, nchannels %d, fmt %d, shift %d\n",
418 i,
419 new_freq,
420 1 << (new_fmt & 1),
421 (new_fmt & 2) ? AUD_FMT_S16 : AUD_FMT_U8,
422 d->shift);
423 if (new_freq) {
424 struct audsettings as;
425
426 as.freq = new_freq;
427 as.nchannels = 1 << (new_fmt & 1);
428 as.fmt = (new_fmt & 2) ? AUD_FMT_S16 : AUD_FMT_U8;
429 as.endianness = 0;
430
431 if (i == ADC_CHANNEL) {
432 s->adc_voice =
433 AUD_open_in (
434 &s->card,
435 s->adc_voice,
436 "es1370.adc",
437 s,
438 es1370_adc_callback,
439 &as
440 );
441 }
442 else {
443 s->dac_voice[i] =
444 AUD_open_out (
445 &s->card,
446 s->dac_voice[i],
447 i ? "es1370.dac2" : "es1370.dac1",
448 s,
449 i ? es1370_dac2_callback : es1370_dac1_callback,
450 &as
451 );
452 }
453 }
454 }
455
456 if (((ctl ^ s->ctl) & b->ctl_en)
457 || ((sctl ^ s->sctl) & b->sctl_pause)) {
458 int on = (ctl & b->ctl_en) && !(sctl & b->sctl_pause);
459
460 if (i == ADC_CHANNEL) {
461 AUD_set_active_in (s->adc_voice, on);
462 }
463 else {
464 AUD_set_active_out (s->dac_voice[i], on);
465 }
466 }
467 }
468
469 s->ctl = ctl;
470 s->sctl = sctl;
471 }
472
473 static inline uint32_t es1370_fixup (ES1370State *s, uint32_t addr)
474 {
475 addr &= 0xff;
476 if (addr >= 0x30 && addr <= 0x3f)
477 addr |= s->mempage << 8;
478 return addr;
479 }
480
481 IO_WRITE_PROTO (es1370_writeb)
482 {
483 ES1370State *s = opaque;
484 uint32_t shift, mask;
485
486 addr = es1370_fixup (s, addr);
487
488 switch (addr) {
489 case ES1370_REG_CONTROL:
490 case ES1370_REG_CONTROL + 1:
491 case ES1370_REG_CONTROL + 2:
492 case ES1370_REG_CONTROL + 3:
493 shift = (addr - ES1370_REG_CONTROL) << 3;
494 mask = 0xff << shift;
495 val = (s->ctl & ~mask) | ((val & 0xff) << shift);
496 es1370_update_voices (s, val, s->sctl);
497 print_ctl (val);
498 break;
499 case ES1370_REG_MEMPAGE:
500 s->mempage = val;
501 break;
502 case ES1370_REG_SERIAL_CONTROL:
503 case ES1370_REG_SERIAL_CONTROL + 1:
504 case ES1370_REG_SERIAL_CONTROL + 2:
505 case ES1370_REG_SERIAL_CONTROL + 3:
506 shift = (addr - ES1370_REG_SERIAL_CONTROL) << 3;
507 mask = 0xff << shift;
508 val = (s->sctl & ~mask) | ((val & 0xff) << shift);
509 es1370_maybe_lower_irq (s, val);
510 es1370_update_voices (s, s->ctl, val);
511 print_sctl (val);
512 break;
513 default:
514 lwarn ("writeb %#x <- %#x\n", addr, val);
515 break;
516 }
517 }
518
519 IO_WRITE_PROTO (es1370_writew)
520 {
521 ES1370State *s = opaque;
522 addr = es1370_fixup (s, addr);
523 uint32_t shift, mask;
524 struct chan *d = &s->chan[0];
525
526 switch (addr) {
527 case ES1370_REG_CODEC:
528 dolog ("ignored codec write address %#x, data %#x\n",
529 (val >> 8) & 0xff, val & 0xff);
530 s->codec = val;
531 break;
532
533 case ES1370_REG_CONTROL:
534 case ES1370_REG_CONTROL + 2:
535 shift = (addr != ES1370_REG_CONTROL) << 4;
536 mask = 0xffff << shift;
537 val = (s->ctl & ~mask) | ((val & 0xffff) << shift);
538 es1370_update_voices (s, val, s->sctl);
539 print_ctl (val);
540 break;
541
542 case ES1370_REG_ADC_SCOUNT:
543 d++;
544 case ES1370_REG_DAC2_SCOUNT:
545 d++;
546 case ES1370_REG_DAC1_SCOUNT:
547 d->scount = (d->scount & ~0xffff) | (val & 0xffff);
548 break;
549
550 default:
551 lwarn ("writew %#x <- %#x\n", addr, val);
552 break;
553 }
554 }
555
556 IO_WRITE_PROTO (es1370_writel)
557 {
558 ES1370State *s = opaque;
559 struct chan *d = &s->chan[0];
560
561 addr = es1370_fixup (s, addr);
562
563 switch (addr) {
564 case ES1370_REG_CONTROL:
565 es1370_update_voices (s, val, s->sctl);
566 print_ctl (val);
567 break;
568
569 case ES1370_REG_MEMPAGE:
570 s->mempage = val & 0xf;
571 break;
572
573 case ES1370_REG_SERIAL_CONTROL:
574 es1370_maybe_lower_irq (s, val);
575 es1370_update_voices (s, s->ctl, val);
576 print_sctl (val);
577 break;
578
579 case ES1370_REG_ADC_SCOUNT:
580 d++;
581 case ES1370_REG_DAC2_SCOUNT:
582 d++;
583 case ES1370_REG_DAC1_SCOUNT:
584 d->scount = (val & 0xffff) | (d->scount & ~0xffff);
585 ldebug ("chan %d CURR_SAMP_CT %d, SAMP_CT %d\n",
586 d - &s->chan[0], val >> 16, (val & 0xffff));
587 break;
588
589 case ES1370_REG_ADC_FRAMEADR:
590 d++;
591 case ES1370_REG_DAC2_FRAMEADR:
592 d++;
593 case ES1370_REG_DAC1_FRAMEADR:
594 d->frame_addr = val;
595 ldebug ("chan %d frame address %#x\n", d - &s->chan[0], val);
596 break;
597
598 case ES1370_REG_PHANTOM_FRAMECNT:
599 lwarn ("writing to phantom frame count %#x\n", val);
600 break;
601 case ES1370_REG_PHANTOM_FRAMEADR:
602 lwarn ("writing to phantom frame address %#x\n", val);
603 break;
604
605 case ES1370_REG_ADC_FRAMECNT:
606 d++;
607 case ES1370_REG_DAC2_FRAMECNT:
608 d++;
609 case ES1370_REG_DAC1_FRAMECNT:
610 d->frame_cnt = val;
611 d->leftover = 0;
612 ldebug ("chan %d frame count %d, buffer size %d\n",
613 d - &s->chan[0], val >> 16, val & 0xffff);
614 break;
615
616 default:
617 lwarn ("writel %#x <- %#x\n", addr, val);
618 break;
619 }
620 }
621
622 IO_READ_PROTO (es1370_readb)
623 {
624 ES1370State *s = opaque;
625 uint32_t val;
626
627 addr = es1370_fixup (s, addr);
628
629 switch (addr) {
630 case 0x1b: /* Legacy */
631 lwarn ("Attempt to read from legacy register\n");
632 val = 5;
633 break;
634 case ES1370_REG_MEMPAGE:
635 val = s->mempage;
636 break;
637 case ES1370_REG_CONTROL + 0:
638 case ES1370_REG_CONTROL + 1:
639 case ES1370_REG_CONTROL + 2:
640 case ES1370_REG_CONTROL + 3:
641 val = s->ctl >> ((addr - ES1370_REG_CONTROL) << 3);
642 break;
643 case ES1370_REG_STATUS + 0:
644 case ES1370_REG_STATUS + 1:
645 case ES1370_REG_STATUS + 2:
646 case ES1370_REG_STATUS + 3:
647 val = s->status >> ((addr - ES1370_REG_STATUS) << 3);
648 break;
649 default:
650 val = ~0;
651 lwarn ("readb %#x -> %#x\n", addr, val);
652 break;
653 }
654 return val;
655 }
656
657 IO_READ_PROTO (es1370_readw)
658 {
659 ES1370State *s = opaque;
660 struct chan *d = &s->chan[0];
661 uint32_t val;
662
663 addr = es1370_fixup (s, addr);
664
665 switch (addr) {
666 case ES1370_REG_ADC_SCOUNT + 2:
667 d++;
668 case ES1370_REG_DAC2_SCOUNT + 2:
669 d++;
670 case ES1370_REG_DAC1_SCOUNT + 2:
671 val = d->scount >> 16;
672 break;
673
674 case ES1370_REG_ADC_FRAMECNT:
675 d++;
676 case ES1370_REG_DAC2_FRAMECNT:
677 d++;
678 case ES1370_REG_DAC1_FRAMECNT:
679 val = d->frame_cnt & 0xffff;
680 break;
681
682 case ES1370_REG_ADC_FRAMECNT + 2:
683 d++;
684 case ES1370_REG_DAC2_FRAMECNT + 2:
685 d++;
686 case ES1370_REG_DAC1_FRAMECNT + 2:
687 val = d->frame_cnt >> 16;
688 break;
689
690 default:
691 val = ~0;
692 lwarn ("readw %#x -> %#x\n", addr, val);
693 break;
694 }
695
696 return val;
697 }
698
699 IO_READ_PROTO (es1370_readl)
700 {
701 ES1370State *s = opaque;
702 uint32_t val;
703 struct chan *d = &s->chan[0];
704
705 addr = es1370_fixup (s, addr);
706
707 switch (addr) {
708 case ES1370_REG_CONTROL:
709 val = s->ctl;
710 break;
711 case ES1370_REG_STATUS:
712 val = s->status;
713 break;
714 case ES1370_REG_MEMPAGE:
715 val = s->mempage;
716 break;
717 case ES1370_REG_CODEC:
718 val = s->codec;
719 break;
720 case ES1370_REG_SERIAL_CONTROL:
721 val = s->sctl;
722 break;
723
724 case ES1370_REG_ADC_SCOUNT:
725 d++;
726 case ES1370_REG_DAC2_SCOUNT:
727 d++;
728 case ES1370_REG_DAC1_SCOUNT:
729 val = d->scount;
730 #ifdef DEBUG_ES1370
731 {
732 uint32_t curr_count = d->scount >> 16;
733 uint32_t count = d->scount & 0xffff;
734
735 curr_count <<= d->shift;
736 count <<= d->shift;
737 dolog ("read scount curr %d, total %d\n", curr_count, count);
738 }
739 #endif
740 break;
741
742 case ES1370_REG_ADC_FRAMECNT:
743 d++;
744 case ES1370_REG_DAC2_FRAMECNT:
745 d++;
746 case ES1370_REG_DAC1_FRAMECNT:
747 val = d->frame_cnt;
748 #ifdef DEBUG_ES1370
749 {
750 uint32_t size = ((d->frame_cnt & 0xffff) + 1) << 2;
751 uint32_t curr = ((d->frame_cnt >> 16) + 1) << 2;
752 if (curr > size)
753 dolog ("read framecnt curr %d, size %d %d\n", curr, size,
754 curr > size);
755 }
756 #endif
757 break;
758
759 case ES1370_REG_ADC_FRAMEADR:
760 d++;
761 case ES1370_REG_DAC2_FRAMEADR:
762 d++;
763 case ES1370_REG_DAC1_FRAMEADR:
764 val = d->frame_addr;
765 break;
766
767 case ES1370_REG_PHANTOM_FRAMECNT:
768 val = ~0U;
769 lwarn ("reading from phantom frame count\n");
770 break;
771 case ES1370_REG_PHANTOM_FRAMEADR:
772 val = ~0U;
773 lwarn ("reading from phantom frame address\n");
774 break;
775
776 default:
777 val = ~0U;
778 lwarn ("readl %#x -> %#x\n", addr, val);
779 break;
780 }
781 return val;
782 }
783
784
785 static void es1370_transfer_audio (ES1370State *s, struct chan *d, int loop_sel,
786 int max, int *irq)
787 {
788 uint8_t tmpbuf[4096];
789 uint32_t addr = d->frame_addr;
790 int sc = d->scount & 0xffff;
791 int csc = d->scount >> 16;
792 int csc_bytes = (csc + 1) << d->shift;
793 int cnt = d->frame_cnt >> 16;
794 int size = d->frame_cnt & 0xffff;
795 int left = ((size - cnt + 1) << 2) + d->leftover;
796 int transfered = 0;
797 int temp = audio_MIN (max, audio_MIN (left, csc_bytes));
798 int index = d - &s->chan[0];
799
800 addr += (cnt << 2) + d->leftover;
801
802 if (index == ADC_CHANNEL) {
803 while (temp) {
804 int acquired, to_copy;
805
806 to_copy = audio_MIN ((size_t) temp, sizeof (tmpbuf));
807 acquired = AUD_read (s->adc_voice, tmpbuf, to_copy);
808 if (!acquired)
809 break;
810
811 cpu_physical_memory_write (addr, tmpbuf, acquired);
812
813 temp -= acquired;
814 addr += acquired;
815 transfered += acquired;
816 }
817 }
818 else {
819 SWVoiceOut *voice = s->dac_voice[index];
820
821 while (temp) {
822 int copied, to_copy;
823
824 to_copy = audio_MIN ((size_t) temp, sizeof (tmpbuf));
825 cpu_physical_memory_read (addr, tmpbuf, to_copy);
826 copied = AUD_write (voice, tmpbuf, to_copy);
827 if (!copied)
828 break;
829 temp -= copied;
830 addr += copied;
831 transfered += copied;
832 }
833 }
834
835 if (csc_bytes == transfered) {
836 *irq = 1;
837 d->scount = sc | (sc << 16);
838 ldebug ("sc = %d, rate = %f\n",
839 (sc + 1) << d->shift,
840 (sc + 1) / (double) 44100);
841 }
842 else {
843 *irq = 0;
844 d->scount = sc | (((csc_bytes - transfered - 1) >> d->shift) << 16);
845 }
846
847 cnt += (transfered + d->leftover) >> 2;
848
849 if (s->sctl & loop_sel) {
850 /* Bah, how stupid is that having a 0 represent true value?
851 i just spent few hours on this shit */
852 AUD_log ("es1370: warning", "non looping mode\n");
853 }
854 else {
855 d->frame_cnt = size;
856
857 if ((uint32_t) cnt <= d->frame_cnt)
858 d->frame_cnt |= cnt << 16;
859 }
860
861 d->leftover = (transfered + d->leftover) & 3;
862 }
863
864 static void es1370_run_channel (ES1370State *s, size_t chan, int free_or_avail)
865 {
866 uint32_t new_status = s->status;
867 int max_bytes, irq;
868 struct chan *d = &s->chan[chan];
869 const struct chan_bits *b = &es1370_chan_bits[chan];
870
871 if (!(s->ctl & b->ctl_en) || (s->sctl & b->sctl_pause)) {
872 return;
873 }
874
875 max_bytes = free_or_avail;
876 max_bytes &= ~((1 << d->shift) - 1);
877 if (!max_bytes) {
878 return;
879 }
880
881 es1370_transfer_audio (s, d, b->sctl_loopsel, max_bytes, &irq);
882
883 if (irq) {
884 if (s->sctl & b->sctl_inten) {
885 new_status |= b->stat_int;
886 }
887 }
888
889 if (new_status != s->status) {
890 es1370_update_status (s, new_status);
891 }
892 }
893
894 static void es1370_dac1_callback (void *opaque, int free)
895 {
896 ES1370State *s = opaque;
897
898 es1370_run_channel (s, DAC1_CHANNEL, free);
899 }
900
901 static void es1370_dac2_callback (void *opaque, int free)
902 {
903 ES1370State *s = opaque;
904
905 es1370_run_channel (s, DAC2_CHANNEL, free);
906 }
907
908 static void es1370_adc_callback (void *opaque, int avail)
909 {
910 ES1370State *s = opaque;
911
912 es1370_run_channel (s, ADC_CHANNEL, avail);
913 }
914
915 static void es1370_map (PCIDevice *pci_dev, int region_num,
916 uint32_t addr, uint32_t size, int type)
917 {
918 PCIES1370State *d = (PCIES1370State *) pci_dev;
919 ES1370State *s = &d->es1370;
920
921 (void) region_num;
922 (void) size;
923 (void) type;
924
925 register_ioport_write (addr, 0x40 * 4, 1, es1370_writeb, s);
926 register_ioport_write (addr, 0x40 * 2, 2, es1370_writew, s);
927 register_ioport_write (addr, 0x40, 4, es1370_writel, s);
928
929 register_ioport_read (addr, 0x40 * 4, 1, es1370_readb, s);
930 register_ioport_read (addr, 0x40 * 2, 2, es1370_readw, s);
931 register_ioport_read (addr, 0x40, 4, es1370_readl, s);
932 }
933
934 static void es1370_save (QEMUFile *f, void *opaque)
935 {
936 ES1370State *s = opaque;
937 size_t i;
938
939 pci_device_save (s->pci_dev, f);
940 for (i = 0; i < NB_CHANNELS; ++i) {
941 struct chan *d = &s->chan[i];
942 qemu_put_be32s (f, &d->shift);
943 qemu_put_be32s (f, &d->leftover);
944 qemu_put_be32s (f, &d->scount);
945 qemu_put_be32s (f, &d->frame_addr);
946 qemu_put_be32s (f, &d->frame_cnt);
947 }
948 qemu_put_be32s (f, &s->ctl);
949 qemu_put_be32s (f, &s->status);
950 qemu_put_be32s (f, &s->mempage);
951 qemu_put_be32s (f, &s->codec);
952 qemu_put_be32s (f, &s->sctl);
953 }
954
955 static int es1370_load (QEMUFile *f, void *opaque, int version_id)
956 {
957 int ret;
958 uint32_t ctl, sctl;
959 ES1370State *s = opaque;
960 size_t i;
961
962 if (version_id != 2)
963 return -EINVAL;
964
965 ret = pci_device_load (s->pci_dev, f);
966 if (ret)
967 return ret;
968
969 for (i = 0; i < NB_CHANNELS; ++i) {
970 struct chan *d = &s->chan[i];
971 qemu_get_be32s (f, &d->shift);
972 qemu_get_be32s (f, &d->leftover);
973 qemu_get_be32s (f, &d->scount);
974 qemu_get_be32s (f, &d->frame_addr);
975 qemu_get_be32s (f, &d->frame_cnt);
976 if (i == ADC_CHANNEL) {
977 if (s->adc_voice) {
978 AUD_close_in (&s->card, s->adc_voice);
979 s->adc_voice = NULL;
980 }
981 }
982 else {
983 if (s->dac_voice[i]) {
984 AUD_close_out (&s->card, s->dac_voice[i]);
985 s->dac_voice[i] = NULL;
986 }
987 }
988 }
989
990 qemu_get_be32s (f, &ctl);
991 qemu_get_be32s (f, &s->status);
992 qemu_get_be32s (f, &s->mempage);
993 qemu_get_be32s (f, &s->codec);
994 qemu_get_be32s (f, &sctl);
995
996 s->ctl = 0;
997 s->sctl = 0;
998 es1370_update_voices (s, ctl, sctl);
999 return 0;
1000 }
1001
1002 static void es1370_on_reset (void *opaque)
1003 {
1004 ES1370State *s = opaque;
1005 es1370_reset (s);
1006 }
1007
1008 int es1370_init (PCIBus *bus, AudioState *audio)
1009 {
1010 PCIES1370State *d;
1011 ES1370State *s;
1012 uint8_t *c;
1013
1014 if (!bus) {
1015 dolog ("No PCI bus\n");
1016 return -1;
1017 }
1018
1019 if (!audio) {
1020 dolog ("No audio state\n");
1021 return -1;
1022 }
1023
1024 d = (PCIES1370State *) pci_register_device (bus, "ES1370",
1025 sizeof (PCIES1370State),
1026 -1, NULL, NULL);
1027
1028 if (!d) {
1029 AUD_log (NULL, "Failed to register PCI device for ES1370\n");
1030 return -1;
1031 }
1032
1033 c = d->dev.config;
1034 c[0x00] = 0x74;
1035 c[0x01] = 0x12;
1036 c[0x02] = 0x00;
1037 c[0x03] = 0x50;
1038 c[0x07] = 2 << 1;
1039 c[0x0a] = 0x01;
1040 c[0x0b] = 0x04;
1041
1042 #if 1
1043 c[0x2c] = 0x42;
1044 c[0x2d] = 0x49;
1045 c[0x2e] = 0x4c;
1046 c[0x2f] = 0x4c;
1047 #else
1048 c[0x2c] = 0x74;
1049 c[0x2d] = 0x12;
1050 c[0x2e] = 0x71;
1051 c[0x2f] = 0x13;
1052 c[0x34] = 0xdc;
1053 c[0x3c] = 10;
1054 c[0xdc] = 0x00;
1055 #endif
1056
1057 c[0x3d] = 1;
1058 c[0x3e] = 0x0c;
1059 c[0x3f] = 0x80;
1060
1061 s = &d->es1370;
1062 s->pci_dev = &d->dev;
1063
1064 pci_register_io_region (&d->dev, 0, 256, PCI_ADDRESS_SPACE_IO, es1370_map);
1065 register_savevm ("es1370", 0, 2, es1370_save, es1370_load, s);
1066 qemu_register_reset (es1370_on_reset, s);
1067
1068 AUD_register_card (audio, "es1370", &s->card);
1069 es1370_reset (s);
1070 return 0;
1071 }
Patches shipped by Fedora