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