sb16.c 34.9 KB
Newer Older
B
bellard 已提交
1 2
/*
 * QEMU Soundblaster 16 emulation
3 4 5
 *
 * Copyright (c) 2003-2005 Vassili Karpov (malc)
 *
B
bellard 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
 * 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.
 */
#include "vl.h"

B
bellard 已提交
26
#define LENOFA(a) ((int) (sizeof(a)/sizeof(a[0])))
B
bellard 已提交
27

B
bellard 已提交
28
#define dolog(...) AUD_log ("sb16", __VA_ARGS__)
B
bellard 已提交
29 30 31 32

/* #define DEBUG */
/* #define DEBUG_SB16_MOST */

B
bellard 已提交
33 34 35 36 37 38
#ifdef DEBUG
#define ldebug(...) dolog (__VA_ARGS__)
#else
#define ldebug(...)
#endif

B
bellard 已提交
39
#define IO_READ_PROTO(name)                             \
B
bellard 已提交
40
    uint32_t name (void *opaque, uint32_t nport)
B
bellard 已提交
41
#define IO_WRITE_PROTO(name)                                    \
B
bellard 已提交
42
    void name (void *opaque, uint32_t nport, uint32_t val)
B
bellard 已提交
43

B
bellard 已提交
44
static const char e3[] = "COPYRIGHT (C) CREATIVE TECHNOLOGY LTD, 1992.";
B
bellard 已提交
45

B
bellard 已提交
46 47 48 49 50 51 52
static struct {
    int ver_lo;
    int ver_hi;
    int irq;
    int dma;
    int hdma;
    int port;
B
bellard 已提交
53
} conf = {5, 4, 5, 1, 5, 0x220};
B
bellard 已提交
54

55
typedef struct SB16State {
B
bellard 已提交
56
    QEMUSoundCard card;
B
bellard 已提交
57 58 59 60 61 62
    int irq;
    int dma;
    int hdma;
    int port;
    int ver;

B
bellard 已提交
63 64 65 66 67
    int in_index;
    int out_data_len;
    int fmt_stereo;
    int fmt_signed;
    int fmt_bits;
B
bellard 已提交
68
    audfmt_e fmt;
B
bellard 已提交
69
    int dma_auto;
B
bellard 已提交
70
    int block_size;
B
bellard 已提交
71 72 73 74 75 76 77
    int fifo;
    int freq;
    int time_const;
    int speaker;
    int needed_bytes;
    int cmd;
    int use_hdma;
B
bellard 已提交
78 79
    int highspeed;
    int can_write;
B
bellard 已提交
80 81 82

    int v2x6;

B
bellard 已提交
83 84 85 86 87 88 89 90 91
    uint8_t csp_param;
    uint8_t csp_value;
    uint8_t csp_mode;
    uint8_t csp_regs[256];
    uint8_t csp_index;
    uint8_t csp_reg83[4];
    int csp_reg83r;
    int csp_reg83w;

B
bellard 已提交
92
    uint8_t in2_data[10];
B
bellard 已提交
93 94 95 96
    uint8_t out_data[50];
    uint8_t test_reg;
    uint8_t last_read_byte;
    int nzero;
B
bellard 已提交
97 98 99

    int left_till_irq;

B
bellard 已提交
100 101 102
    int dma_running;
    int bytes_per_second;
    int align;
103 104
    int audio_free;
    SWVoiceOut *voice;
B
bellard 已提交
105

106
    QEMUTimer *aux_ts;
107 108
    /* mixer state */
    int mixer_nreg;
B
bellard 已提交
109
    uint8_t mixer_regs[256];
110
} SB16State;
B
bellard 已提交
111

112 113
static void SB_audio_callback (void *opaque, int free);

B
bellard 已提交
114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148
static int magic_of_irq (int irq)
{
    switch (irq) {
    case 5:
        return 2;
    case 7:
        return 4;
    case 9:
        return 1;
    case 10:
        return 8;
    default:
        dolog ("bad irq %d\n", irq);
        return 2;
    }
}

static int irq_of_magic (int magic)
{
    switch (magic) {
    case 1:
        return 9;
    case 2:
        return 5;
    case 4:
        return 7;
    case 8:
        return 10;
    default:
        dolog ("bad irq magic %d\n", magic);
        return -1;
    }
}

#if 0
149 150
static void log_dsp (SB16State *dsp)
{
B
bellard 已提交
151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166
    ldebug ("%s:%s:%d:%s:dmasize=%d:freq=%d:const=%d:speaker=%d\n",
            dsp->fmt_stereo ? "Stereo" : "Mono",
            dsp->fmt_signed ? "Signed" : "Unsigned",
            dsp->fmt_bits,
            dsp->dma_auto ? "Auto" : "Single",
            dsp->block_size,
            dsp->freq,
            dsp->time_const,
            dsp->speaker);
}
#endif

static void speaker (SB16State *s, int on)
{
    s->speaker = on;
    /* AUD_enable (s->voice, on); */
B
bellard 已提交
167 168
}

B
bellard 已提交
169
static void control (SB16State *s, int hold)
B
bellard 已提交
170
{
B
bellard 已提交
171 172 173 174 175
    int dma = s->use_hdma ? s->hdma : s->dma;
    s->dma_running = hold;

    ldebug ("hold %d high %d dma %d\n", hold, s->use_hdma, dma);

B
bellard 已提交
176
    if (hold) {
B
bellard 已提交
177
        DMA_hold_DREQ (dma);
178
        AUD_set_active_out (s->voice, 1);
B
bellard 已提交
179 180
    }
    else {
B
bellard 已提交
181
        DMA_release_DREQ (dma);
182
        AUD_set_active_out (s->voice, 0);
B
bellard 已提交
183 184 185
    }
}

B
bellard 已提交
186
static void aux_timer (void *opaque)
B
bellard 已提交
187
{
B
bellard 已提交
188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210
    SB16State *s = opaque;
    s->can_write = 1;
    pic_set_irq (s->irq, 1);
}

#define DMA8_AUTO 1
#define DMA8_HIGH 2

static void dma_cmd8 (SB16State *s, int mask, int dma_len)
{
    s->fmt = AUD_FMT_U8;
    s->use_hdma = 0;
    s->fmt_bits = 8;
    s->fmt_signed = 0;
    s->fmt_stereo = (s->mixer_regs[0x0e] & 2) != 0;
    if (-1 == s->time_const) {
        s->freq = 11025;
    }
    else {
        int tmp = (256 - s->time_const);
        s->freq = (1000000 + (tmp / 2)) / tmp;
    }

211
    if (dma_len != -1) {
B
bellard 已提交
212
        s->block_size = dma_len << s->fmt_stereo;
213
    }
B
bellard 已提交
214 215 216 217 218 219 220 221 222 223
    else {
        /* This is apparently the only way to make both Act1/PL
           and SecondReality/FC work

           Act1 sets block size via command 0x48 and it's an odd number
           SR does the same with even number
           Both use stereo, and Creatives own documentation states that
           0x48 sets block size in bytes less one.. go figure */
        s->block_size &= ~s->fmt_stereo;
    }
B
bellard 已提交
224 225 226 227 228 229 230 231

    s->freq >>= s->fmt_stereo;
    s->left_till_irq = s->block_size;
    s->bytes_per_second = (s->freq << s->fmt_stereo);
    /* s->highspeed = (mask & DMA8_HIGH) != 0; */
    s->dma_auto = (mask & DMA8_AUTO) != 0;
    s->align = (1 << s->fmt_stereo) - 1;

232 233 234 235
    if (s->block_size & s->align) {
        dolog ("warning: misaligned block size %d, alignment %d\n",
               s->block_size, s->align + 1);
    }
B
bellard 已提交
236

B
bellard 已提交
237 238 239 240 241
    ldebug ("freq %d, stereo %d, sign %d, bits %d, "
            "dma %d, auto %d, fifo %d, high %d\n",
            s->freq, s->fmt_stereo, s->fmt_signed, s->fmt_bits,
            s->block_size, s->dma_auto, s->fifo, s->highspeed);

242
    if (s->freq) {
B
bellard 已提交
243 244
        audsettings_t as;

245
        s->audio_free = 0;
B
bellard 已提交
246 247 248 249 250

        as.freq = s->freq;
        as.nchannels = 1 << s->fmt_stereo;
        as.fmt = s->fmt;

251
        s->voice = AUD_open_out (
B
bellard 已提交
252
            &s->card,
253 254 255 256
            s->voice,
            "sb16",
            s,
            SB_audio_callback,
B
bellard 已提交
257 258
            &as,
            0                   /* little endian */
259 260
            );
    }
B
bellard 已提交
261 262 263 264

    control (s, 1);
    speaker (s, 1);
}
B
bellard 已提交
265

B
bellard 已提交
266 267 268 269 270 271 272
static void dma_cmd (SB16State *s, uint8_t cmd, uint8_t d0, int dma_len)
{
    s->use_hdma = cmd < 0xc0;
    s->fifo = (cmd >> 1) & 1;
    s->dma_auto = (cmd >> 2) & 1;
    s->fmt_signed = (d0 >> 4) & 1;
    s->fmt_stereo = (d0 >> 5) & 1;
B
bellard 已提交
273 274 275

    switch (cmd >> 4) {
    case 11:
B
bellard 已提交
276
        s->fmt_bits = 16;
B
bellard 已提交
277 278 279
        break;

    case 12:
B
bellard 已提交
280
        s->fmt_bits = 8;
B
bellard 已提交
281 282 283
        break;
    }

B
bellard 已提交
284 285 286 287 288 289 290 291 292
    if (-1 != s->time_const) {
#if 1
        int tmp = 256 - s->time_const;
        s->freq = (1000000 + (tmp / 2)) / tmp;
#else
        /* s->freq = 1000000 / ((255 - s->time_const) << s->fmt_stereo); */
        s->freq = 1000000 / ((255 - s->time_const));
#endif
        s->time_const = -1;
B
bellard 已提交
293 294
    }

B
bellard 已提交
295 296
    s->block_size = dma_len + 1;
    s->block_size <<= (s->fmt_bits == 16);
B
bellard 已提交
297 298 299 300 301
    if (!s->dma_auto) {
        /* It is clear that for DOOM and auto-init this value
           shouldn't take stereo into account, while Miles Sound Systems
           setsound.exe with single transfer mode wouldn't work without it
           wonders of SB16 yet again */
B
bellard 已提交
302
        s->block_size <<= s->fmt_stereo;
B
bellard 已提交
303
    }
B
bellard 已提交
304

B
bellard 已提交
305 306 307 308
    ldebug ("freq %d, stereo %d, sign %d, bits %d, "
            "dma %d, auto %d, fifo %d, high %d\n",
            s->freq, s->fmt_stereo, s->fmt_signed, s->fmt_bits,
            s->block_size, s->dma_auto, s->fifo, s->highspeed);
B
bellard 已提交
309

B
bellard 已提交
310 311 312
    if (16 == s->fmt_bits) {
        if (s->fmt_signed) {
            s->fmt = AUD_FMT_S16;
B
bellard 已提交
313 314
        }
        else {
B
bellard 已提交
315
            s->fmt = AUD_FMT_U16;
B
bellard 已提交
316 317 318
        }
    }
    else {
B
bellard 已提交
319 320
        if (s->fmt_signed) {
            s->fmt = AUD_FMT_S8;
B
bellard 已提交
321 322
        }
        else {
B
bellard 已提交
323
            s->fmt = AUD_FMT_U8;
B
bellard 已提交
324 325 326
        }
    }

B
bellard 已提交
327
    s->left_till_irq = s->block_size;
B
bellard 已提交
328

B
bellard 已提交
329 330 331
    s->bytes_per_second = (s->freq << s->fmt_stereo) << (s->fmt_bits == 16);
    s->highspeed = 0;
    s->align = (1 << (s->fmt_stereo + (s->fmt_bits == 16))) - 1;
332 333 334 335
    if (s->block_size & s->align) {
        dolog ("warning: misaligned block size %d, alignment %d\n",
               s->block_size, s->align + 1);
    }
B
bellard 已提交
336

337
    if (s->freq) {
B
bellard 已提交
338 339
        audsettings_t as;

340
        s->audio_free = 0;
B
bellard 已提交
341 342 343 344 345

        as.freq = s->freq;
        as.nchannels = 1 << s->fmt_stereo;
        as.fmt = s->fmt;

346
        s->voice = AUD_open_out (
B
bellard 已提交
347
            &s->card,
348 349 350 351
            s->voice,
            "sb16",
            s,
            SB_audio_callback,
B
bellard 已提交
352 353
            &as,
            0                   /* little endian */
354 355
            );
    }
B
bellard 已提交
356

B
bellard 已提交
357 358
    control (s, 1);
    speaker (s, 1);
B
bellard 已提交
359 360
}

B
bellard 已提交
361
static inline void dsp_out_data (SB16State *s, uint8_t val)
B
bellard 已提交
362
{
B
bellard 已提交
363
    ldebug ("outdata %#x\n", val);
B
bellard 已提交
364
    if ((size_t) s->out_data_len < sizeof (s->out_data)) {
B
bellard 已提交
365
        s->out_data[s->out_data_len++] = val;
366
    }
B
bellard 已提交
367 368
}

B
bellard 已提交
369
static inline uint8_t dsp_get_data (SB16State *s)
B
bellard 已提交
370
{
371
    if (s->in_index) {
B
bellard 已提交
372
        return s->in2_data[--s->in_index];
373
    }
B
bellard 已提交
374 375
    else {
        dolog ("buffer underflow\n");
B
bellard 已提交
376
        return 0;
B
bellard 已提交
377
    }
B
bellard 已提交
378 379
}

B
bellard 已提交
380
static void command (SB16State *s, uint8_t cmd)
B
bellard 已提交
381
{
B
bellard 已提交
382
    ldebug ("command %#x\n", cmd);
B
bellard 已提交
383 384

    if (cmd > 0xaf && cmd < 0xd0) {
B
bellard 已提交
385 386 387
        if (cmd & 8) {
            dolog ("ADC not yet supported (command %#x)\n", cmd);
        }
B
bellard 已提交
388 389 390 391 392 393

        switch (cmd >> 4) {
        case 11:
        case 12:
            break;
        default:
B
bellard 已提交
394
            dolog ("%#x wrong bits\n", cmd);
B
bellard 已提交
395
        }
B
bellard 已提交
396
        s->needed_bytes = 3;
B
bellard 已提交
397 398
    }
    else {
399 400
        s->needed_bytes = 0;

B
bellard 已提交
401
        switch (cmd) {
B
bellard 已提交
402
        case 0x03:
B
bellard 已提交
403 404 405
            dsp_out_data (s, 0x10); /* s->csp_param); */
            goto warn;

B
bellard 已提交
406
        case 0x04:
B
bellard 已提交
407 408
            s->needed_bytes = 1;
            goto warn;
B
bellard 已提交
409 410

        case 0x05:
B
bellard 已提交
411 412 413 414 415 416
            s->needed_bytes = 2;
            goto warn;

        case 0x08:
            /* __asm__ ("int3"); */
            goto warn;
B
bellard 已提交
417

B
bellard 已提交
418
        case 0x0e:
B
bellard 已提交
419 420 421 422 423 424
            s->needed_bytes = 2;
            goto warn;

        case 0x09:
            dsp_out_data (s, 0xf8);
            goto warn;
B
bellard 已提交
425 426

        case 0x0f:
B
bellard 已提交
427 428
            s->needed_bytes = 1;
            goto warn;
B
bellard 已提交
429

B
bellard 已提交
430
        case 0x10:
B
bellard 已提交
431 432
            s->needed_bytes = 1;
            goto warn;
B
bellard 已提交
433 434

        case 0x14:
B
bellard 已提交
435 436
            s->needed_bytes = 2;
            s->block_size = 0;
B
bellard 已提交
437 438
            break;

B
bellard 已提交
439 440 441 442
        case 0x1c:              /* Auto-Initialize DMA DAC, 8-bit */
            control (s, 1);
            break;

B
bellard 已提交
443 444 445
        case 0x20:              /* Direct ADC, Juice/PL */
            dsp_out_data (s, 0xff);
            goto warn;
B
bellard 已提交
446 447

        case 0x35:
448
            dolog ("0x35 - MIDI command not implemented\n");
B
bellard 已提交
449 450 451
            break;

        case 0x40:
B
bellard 已提交
452 453 454
            s->freq = -1;
            s->time_const = -1;
            s->needed_bytes = 1;
B
bellard 已提交
455 456 457
            break;

        case 0x41:
B
bellard 已提交
458 459 460
            s->freq = -1;
            s->time_const = -1;
            s->needed_bytes = 2;
B
bellard 已提交
461 462
            break;

B
bellard 已提交
463 464 465 466 467 468
        case 0x42:
            s->freq = -1;
            s->time_const = -1;
            s->needed_bytes = 2;
            goto warn;

B
bellard 已提交
469
        case 0x45:
B
bellard 已提交
470 471 472
            dsp_out_data (s, 0xaa);
            goto warn;

B
bellard 已提交
473 474 475 476
        case 0x47:                /* Continue Auto-Initialize DMA 16bit */
            break;

        case 0x48:
B
bellard 已提交
477
            s->needed_bytes = 2;
B
bellard 已提交
478 479
            break;

480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511
        case 0x74:
            s->needed_bytes = 2; /* DMA DAC, 4-bit ADPCM */
            dolog ("0x75 - DMA DAC, 4-bit ADPCM not implemented\n");
            break;

        case 0x75:              /* DMA DAC, 4-bit ADPCM Reference */
            s->needed_bytes = 2;
            dolog ("0x74 - DMA DAC, 4-bit ADPCM Reference not implemented\n");
            break;

        case 0x76:              /* DMA DAC, 2.6-bit ADPCM */
            s->needed_bytes = 2;
            dolog ("0x74 - DMA DAC, 2.6-bit ADPCM not implemented\n");
            break;

        case 0x77:              /* DMA DAC, 2.6-bit ADPCM Reference */
            s->needed_bytes = 2;
            dolog ("0x74 - DMA DAC, 2.6-bit ADPCM Reference not implemented\n");
            break;

        case 0x7d:
            dolog ("0x7d - Autio-Initialize DMA DAC, 4-bit ADPCM Reference\n");
            dolog ("not implemented\n");
            break;

        case 0x7f:
            dolog (
                "0x7d - Autio-Initialize DMA DAC, 2.6-bit ADPCM Reference\n"
                );
            dolog ("not implemented\n");
            break;

B
bellard 已提交
512
        case 0x80:
B
bellard 已提交
513
            s->needed_bytes = 2;
B
bellard 已提交
514 515 516 517
            break;

        case 0x90:
        case 0x91:
B
bellard 已提交
518 519
            dma_cmd8 (s, ((cmd & 1) == 0) | DMA8_HIGH, -1);
            break;
B
bellard 已提交
520

B
bellard 已提交
521 522 523
        case 0xd0:              /* halt DMA operation. 8bit */
            control (s, 0);
            break;
B
bellard 已提交
524

B
bellard 已提交
525 526
        case 0xd1:              /* speaker on */
            speaker (s, 1);
B
bellard 已提交
527 528
            break;

B
bellard 已提交
529 530 531
        case 0xd3:              /* speaker off */
            speaker (s, 0);
            break;
B
bellard 已提交
532

B
bellard 已提交
533 534
        case 0xd4:              /* continue DMA operation. 8bit */
            control (s, 1);
B
bellard 已提交
535 536
            break;

B
bellard 已提交
537 538
        case 0xd5:              /* halt DMA operation. 16bit */
            control (s, 0);
B
bellard 已提交
539 540
            break;

B
bellard 已提交
541 542
        case 0xd6:              /* continue DMA operation. 16bit */
            control (s, 1);
B
bellard 已提交
543 544
            break;

B
bellard 已提交
545 546 547
        case 0xd9:              /* exit auto-init DMA after this block. 16bit */
            s->dma_auto = 0;
            break;
B
bellard 已提交
548

B
bellard 已提交
549 550
        case 0xda:              /* exit auto-init DMA after this block. 8bit */
            s->dma_auto = 0;
B
bellard 已提交
551 552
            break;

553
        case 0xe0:              /* DSP identification */
B
bellard 已提交
554
            s->needed_bytes = 1;
555
            break;
B
bellard 已提交
556 557

        case 0xe1:
B
bellard 已提交
558 559 560 561 562 563 564
            dsp_out_data (s, s->ver & 0xff);
            dsp_out_data (s, s->ver >> 8);
            break;

        case 0xe2:
            s->needed_bytes = 1;
            goto warn;
B
bellard 已提交
565

B
bellard 已提交
566 567 568
        case 0xe3:
            {
                int i;
B
bellard 已提交
569 570
                for (i = sizeof (e3) - 1; i >= 0; --i)
                    dsp_out_data (s, e3[i]);
B
bellard 已提交
571
            }
B
bellard 已提交
572
            break;
B
bellard 已提交
573

B
bellard 已提交
574
        case 0xe4:              /* write test reg */
B
bellard 已提交
575
            s->needed_bytes = 1;
B
bellard 已提交
576 577
            break;

B
bellard 已提交
578 579
        case 0xe7:
            dolog ("Attempt to probe for ESS (0xe7)?\n");
580
            break;
B
bellard 已提交
581

B
bellard 已提交
582
        case 0xe8:              /* read test reg */
B
bellard 已提交
583
            dsp_out_data (s, s->test_reg);
B
bellard 已提交
584 585
            break;

B
bellard 已提交
586
        case 0xf2:
B
bellard 已提交
587 588 589 590 591
        case 0xf3:
            dsp_out_data (s, 0xaa);
            s->mixer_regs[0x82] |= (cmd == 0xf2) ? 1 : 2;
            pic_set_irq (s->irq, 1);
            break;
B
bellard 已提交
592

B
bellard 已提交
593
        case 0xf9:
B
bellard 已提交
594 595
            s->needed_bytes = 1;
            goto warn;
B
bellard 已提交
596 597

        case 0xfa:
B
bellard 已提交
598 599
            dsp_out_data (s, 0);
            goto warn;
B
bellard 已提交
600 601

        case 0xfc:              /* FIXME */
B
bellard 已提交
602 603
            dsp_out_data (s, 0);
            goto warn;
B
bellard 已提交
604

B
bellard 已提交
605
        default:
606 607
            dolog ("Unrecognized command %#x\n", cmd);
            break;
B
bellard 已提交
608 609
        }
    }
B
bellard 已提交
610

611
    if (!s->needed_bytes) {
B
bellard 已提交
612
        ldebug ("\n");
613 614 615 616 617 618 619 620 621
    }

 exit:
    if (!s->needed_bytes) {
        s->cmd = -1;
    }
    else {
        s->cmd = cmd;
    }
B
bellard 已提交
622 623
    return;

B
bellard 已提交
624
 warn:
B
comment  
bellard 已提交
625
    dolog ("warning: command %#x,%d is not truly understood yet\n",
B
bellard 已提交
626
           cmd, s->needed_bytes);
627 628
    goto exit;

B
bellard 已提交
629 630
}

B
bellard 已提交
631 632 633 634 635 636 637 638 639 640 641 642 643 644 645
static uint16_t dsp_get_lohi (SB16State *s)
{
    uint8_t hi = dsp_get_data (s);
    uint8_t lo = dsp_get_data (s);
    return (hi << 8) | lo;
}

static uint16_t dsp_get_hilo (SB16State *s)
{
    uint8_t lo = dsp_get_data (s);
    uint8_t hi = dsp_get_data (s);
    return (hi << 8) | lo;
}

static void complete (SB16State *s)
B
bellard 已提交
646
{
B
bellard 已提交
647
    int d0, d1, d2;
B
bellard 已提交
648 649
    ldebug ("complete command %#x, in_index %d, needed_bytes %d\n",
            s->cmd, s->in_index, s->needed_bytes);
B
bellard 已提交
650

B
bellard 已提交
651 652 653 654
    if (s->cmd > 0xaf && s->cmd < 0xd0) {
        d2 = dsp_get_data (s);
        d1 = dsp_get_data (s);
        d0 = dsp_get_data (s);
B
bellard 已提交
655

B
bellard 已提交
656 657 658 659 660 661 662 663 664
        if (s->cmd & 8) {
            dolog ("ADC params cmd = %#x d0 = %d, d1 = %d, d2 = %d\n",
                   s->cmd, d0, d1, d2);
        }
        else {
            ldebug ("cmd = %#x d0 = %d, d1 = %d, d2 = %d\n",
                    s->cmd, d0, d1, d2);
            dma_cmd (s, s->cmd, d0, d1 + (d2 << 8));
        }
B
bellard 已提交
665 666
    }
    else {
B
bellard 已提交
667
        switch (s->cmd) {
B
bellard 已提交
668
        case 0x04:
B
bellard 已提交
669 670 671 672
            s->csp_mode = dsp_get_data (s);
            s->csp_reg83r = 0;
            s->csp_reg83w = 0;
            ldebug ("CSP command 0x04: mode=%#x\n", s->csp_mode);
B
bellard 已提交
673 674
            break;

B
bellard 已提交
675 676 677 678 679 680
        case 0x05:
            s->csp_param = dsp_get_data (s);
            s->csp_value = dsp_get_data (s);
            ldebug ("CSP command 0x05: param=%#x value=%#x\n",
                    s->csp_param,
                    s->csp_value);
B
bellard 已提交
681
            break;
B
bellard 已提交
682

B
bellard 已提交
683
        case 0x0e:
B
bellard 已提交
684 685 686 687 688 689 690 691
            d0 = dsp_get_data (s);
            d1 = dsp_get_data (s);
            ldebug ("write CSP register %d <- %#x\n", d1, d0);
            if (d1 == 0x83) {
                ldebug ("0x83[%d] <- %#x\n", s->csp_reg83r, d0);
                s->csp_reg83[s->csp_reg83r % 4] = d0;
                s->csp_reg83r += 1;
            }
692
            else {
B
bellard 已提交
693
                s->csp_regs[d1] = d0;
694
            }
B
bellard 已提交
695 696
            break;

B
bellard 已提交
697 698 699 700 701 702 703 704 705 706 707
        case 0x0f:
            d0 = dsp_get_data (s);
            ldebug ("read CSP register %#x -> %#x, mode=%#x\n",
                    d0, s->csp_regs[d0], s->csp_mode);
            if (d0 == 0x83) {
                ldebug ("0x83[%d] -> %#x\n",
                        s->csp_reg83w,
                        s->csp_reg83[s->csp_reg83w % 4]);
                dsp_out_data (s, s->csp_reg83[s->csp_reg83w % 4]);
                s->csp_reg83w += 1;
            }
708
            else {
B
bellard 已提交
709
                dsp_out_data (s, s->csp_regs[d0]);
710
            }
B
bellard 已提交
711
            break;
B
bellard 已提交
712

B
bellard 已提交
713 714 715 716
        case 0x10:
            d0 = dsp_get_data (s);
            dolog ("cmd 0x10 d0=%#x\n", d0);
            break;
B
bellard 已提交
717

B
bellard 已提交
718
        case 0x14:
B
bellard 已提交
719
            dma_cmd8 (s, 0, dsp_get_lohi (s) + 1);
B
bellard 已提交
720
            break;
B
bellard 已提交
721 722

        case 0x40:
B
bellard 已提交
723 724
            s->time_const = dsp_get_data (s);
            ldebug ("set time const %d\n", s->time_const);
B
bellard 已提交
725 726
            break;

B
bellard 已提交
727
        case 0x42:              /* FT2 sets output freq with this, go figure */
728
#if 0
B
bellard 已提交
729
            dolog ("cmd 0x42 might not do what it think it should\n");
730
#endif
B
bellard 已提交
731 732 733
        case 0x41:
            s->freq = dsp_get_hilo (s);
            ldebug ("set freq %d\n", s->freq);
B
bellard 已提交
734 735 736
            break;

        case 0x48:
B
bellard 已提交
737
            s->block_size = dsp_get_lohi (s) + 1;
B
bellard 已提交
738 739 740
            ldebug ("set dma block len %d\n", s->block_size);
            break;

741 742 743 744 745 746 747
        case 0x74:
        case 0x75:
        case 0x76:
        case 0x77:
            /* ADPCM stuff, ignore */
            break;

B
bellard 已提交
748 749
        case 0x80:
            {
B
bellard 已提交
750
                int freq, samples, bytes;
B
bellard 已提交
751 752
                int64_t ticks;

B
bellard 已提交
753 754
                freq = s->freq > 0 ? s->freq : 11025;
                samples = dsp_get_lohi (s) + 1;
B
bellard 已提交
755
                bytes = samples << s->fmt_stereo << (s->fmt_bits == 16);
B
bellard 已提交
756
                ticks = (bytes * ticks_per_sec) / freq;
757
                if (ticks < ticks_per_sec / 1024) {
B
bellard 已提交
758
                    pic_set_irq (s->irq, 1);
759 760 761 762 763 764 765 766 767
                }
                else {
                    if (s->aux_ts) {
                        qemu_mod_timer (
                            s->aux_ts,
                            qemu_get_clock (vm_clock) + ticks
                            );
                    }
                }
B
bellard 已提交
768 769
                ldebug ("mix silence %d %d %lld\n", samples, bytes, ticks);
            }
B
bellard 已提交
770 771 772
            break;

        case 0xe0:
B
bellard 已提交
773 774 775
            d0 = dsp_get_data (s);
            s->out_data_len = 0;
            ldebug ("E0 data = %#x\n", d0);
776
            dsp_out_data (s, ~d0);
B
bellard 已提交
777 778
            break;

B
bellard 已提交
779 780
        case 0xe2:
            d0 = dsp_get_data (s);
B
bellard 已提交
781
            ldebug ("E2 = %#x\n", d0);
B
bellard 已提交
782 783
            break;

B
bellard 已提交
784 785 786
        case 0xe4:
            s->test_reg = dsp_get_data (s);
            break;
B
bellard 已提交
787 788

        case 0xf9:
B
bellard 已提交
789 790
            d0 = dsp_get_data (s);
            ldebug ("command 0xf9 with %#x\n", d0);
B
bellard 已提交
791
            switch (d0) {
B
bellard 已提交
792 793 794 795 796 797 798 799
            case 0x0e:
                dsp_out_data (s, 0xff);
                break;

            case 0x0f:
                dsp_out_data (s, 0x07);
                break;

B
bellard 已提交
800
            case 0x37:
B
bellard 已提交
801 802 803
                dsp_out_data (s, 0x38);
                break;

B
bellard 已提交
804
            default:
B
bellard 已提交
805 806
                dsp_out_data (s, 0x00);
                break;
B
bellard 已提交
807
            }
B
bellard 已提交
808 809 810
            break;

        default:
B
bellard 已提交
811
            dolog ("complete: unrecognized command %#x\n", s->cmd);
812
            return;
B
bellard 已提交
813 814 815
        }
    }

B
bellard 已提交
816 817
    ldebug ("\n");
    s->cmd = -1;
B
bellard 已提交
818 819 820
    return;
}

B
bellard 已提交
821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838
static void reset (SB16State *s)
{
    pic_set_irq (s->irq, 0);
    if (s->dma_auto) {
        pic_set_irq (s->irq, 1);
        pic_set_irq (s->irq, 0);
    }

    s->mixer_regs[0x82] = 0;
    s->dma_auto = 0;
    s->in_index = 0;
    s->out_data_len = 0;
    s->left_till_irq = 0;
    s->needed_bytes = 0;
    s->block_size = -1;
    s->nzero = 0;
    s->highspeed = 0;
    s->v2x6 = 0;
839
    s->cmd = -1;
B
bellard 已提交
840 841 842 843 844 845

    dsp_out_data(s, 0xaa);
    speaker (s, 0);
    control (s, 0);
}

B
bellard 已提交
846 847
static IO_WRITE_PROTO (dsp_write)
{
B
bellard 已提交
848
    SB16State *s = opaque;
B
bellard 已提交
849 850
    int iport;

B
bellard 已提交
851
    iport = nport - s->port;
B
bellard 已提交
852

B
bellard 已提交
853
    ldebug ("write %#x <- %#x\n", nport, val);
B
bellard 已提交
854
    switch (iport) {
B
bellard 已提交
855 856 857 858 859 860 861 862 863
    case 0x06:
        switch (val) {
        case 0x00:
            if (s->v2x6 == 1) {
                if (0 && s->highspeed) {
                    s->highspeed = 0;
                    pic_set_irq (s->irq, 0);
                    control (s, 0);
                }
864
                else {
B
bellard 已提交
865
                    reset (s);
866
                }
B
bellard 已提交
867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892
            }
            s->v2x6 = 0;
            break;

        case 0x01:
        case 0x03:              /* FreeBSD kludge */
            s->v2x6 = 1;
            break;

        case 0xc6:
            s->v2x6 = 0;        /* Prince of Persia, csp.sys, diagnose.exe */
            break;

        case 0xb8:              /* Panic */
            reset (s);
            break;

        case 0x39:
            dsp_out_data (s, 0x38);
            reset (s);
            s->v2x6 = 0x39;
            break;

        default:
            s->v2x6 = val;
            break;
B
bellard 已提交
893 894 895
        }
        break;

B
bellard 已提交
896 897 898 899 900 901 902 903 904
    case 0x0c:                  /* write data or command | write status */
/*         if (s->highspeed) */
/*             break; */

        if (0 == s->needed_bytes) {
            command (s, val);
#if 0
            if (0 == s->needed_bytes) {
                log_dsp (s);
B
bellard 已提交
905
            }
B
bellard 已提交
906
#endif
B
bellard 已提交
907 908
        }
        else {
B
bellard 已提交
909
            if (s->in_index == sizeof (s->in2_data)) {
B
bellard 已提交
910 911 912
                dolog ("in data overrun\n");
            }
            else {
B
bellard 已提交
913 914 915 916 917 918 919 920
                s->in2_data[s->in_index++] = val;
                if (s->in_index == s->needed_bytes) {
                    s->needed_bytes = 0;
                    complete (s);
#if 0
                    log_dsp (s);
#endif
                }
B
bellard 已提交
921 922 923 924 925
            }
        }
        break;

    default:
B
bellard 已提交
926
        ldebug ("(nport=%#x, val=%#x)\n", nport, val);
927
        break;
B
bellard 已提交
928 929 930 931 932
    }
}

static IO_READ_PROTO (dsp_read)
{
B
bellard 已提交
933 934
    SB16State *s = opaque;
    int iport, retval, ack = 0;
B
bellard 已提交
935

B
bellard 已提交
936
    iport = nport - s->port;
B
bellard 已提交
937 938

    switch (iport) {
B
bellard 已提交
939 940
    case 0x06:                  /* reset */
        retval = 0xff;
B
bellard 已提交
941
        break;
B
bellard 已提交
942

B
bellard 已提交
943 944 945 946 947 948
    case 0x0a:                  /* read data */
        if (s->out_data_len) {
            retval = s->out_data[--s->out_data_len];
            s->last_read_byte = retval;
        }
        else {
949 950 951 952
            if (s->cmd != -1) {
                dolog ("empty output buffer for command %#x\n",
                       s->cmd);
            }
B
bellard 已提交
953
            retval = s->last_read_byte;
B
bellard 已提交
954
            /* goto error; */
B
bellard 已提交
955 956 957
        }
        break;

B
bellard 已提交
958 959
    case 0x0c:                  /* 0 can write */
        retval = s->can_write ? 0 : 0x80;
B
bellard 已提交
960 961
        break;

B
bellard 已提交
962 963 964 965
    case 0x0d:                  /* timer interrupt clear */
        /* dolog ("timer interrupt clear\n"); */
        retval = 0;
        break;
B
bellard 已提交
966

B
bellard 已提交
967 968 969 970 971 972 973
    case 0x0e:                  /* data available status | irq 8 ack */
        retval = (!s->out_data_len || s->highspeed) ? 0 : 0x80;
        if (s->mixer_regs[0x82] & 1) {
            ack = 1;
            s->mixer_regs[0x82] &= 1;
            pic_set_irq (s->irq, 0);
        }
B
bellard 已提交
974 975
        break;

B
bellard 已提交
976
    case 0x0f:                  /* irq 16 ack */
B
bellard 已提交
977
        retval = 0xff;
B
bellard 已提交
978 979 980 981 982
        if (s->mixer_regs[0x82] & 2) {
            ack = 1;
            s->mixer_regs[0x82] &= 2;
            pic_set_irq (s->irq, 0);
        }
B
bellard 已提交
983 984 985 986 987 988
        break;

    default:
        goto error;
    }

989
    if (!ack) {
B
bellard 已提交
990
        ldebug ("read %#x -> %#x\n", nport, retval);
991
    }
B
bellard 已提交
992 993 994 995

    return retval;

 error:
996
    dolog ("warning: dsp_read %#x error\n", nport);
B
bellard 已提交
997
    return 0xff;
B
bellard 已提交
998 999
}

B
bellard 已提交
1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029
static void reset_mixer (SB16State *s)
{
    int i;

    memset (s->mixer_regs, 0xff, 0x7f);
    memset (s->mixer_regs + 0x83, 0xff, sizeof (s->mixer_regs) - 0x83);

    s->mixer_regs[0x02] = 4;    /* master volume 3bits */
    s->mixer_regs[0x06] = 4;    /* MIDI volume 3bits */
    s->mixer_regs[0x08] = 0;    /* CD volume 3bits */
    s->mixer_regs[0x0a] = 0;    /* voice volume 2bits */

    /* d5=input filt, d3=lowpass filt, d1,d2=input source */
    s->mixer_regs[0x0c] = 0;

    /* d5=output filt, d1=stereo switch */
    s->mixer_regs[0x0e] = 0;

    /* voice volume L d5,d7, R d1,d3 */
    s->mixer_regs[0x04] = (4 << 5) | (4 << 1);
    /* master ... */
    s->mixer_regs[0x22] = (4 << 5) | (4 << 1);
    /* MIDI ... */
    s->mixer_regs[0x26] = (4 << 5) | (4 << 1);

    for (i = 0x30; i < 0x48; i++) {
        s->mixer_regs[i] = 0x20;
    }
}

B
bellard 已提交
1030 1031
static IO_WRITE_PROTO(mixer_write_indexb)
{
B
bellard 已提交
1032
    SB16State *s = opaque;
B
bellard 已提交
1033
    (void) nport;
B
bellard 已提交
1034
    s->mixer_nreg = val;
B
bellard 已提交
1035 1036 1037 1038
}

static IO_WRITE_PROTO(mixer_write_datab)
{
B
bellard 已提交
1039 1040
    SB16State *s = opaque;

B
bellard 已提交
1041
    (void) nport;
B
bellard 已提交
1042
    ldebug ("mixer_write [%#x] <- %#x\n", s->mixer_nreg, val);
B
bellard 已提交
1043

B
bellard 已提交
1044
    switch (s->mixer_nreg) {
B
bellard 已提交
1045
    case 0x00:
B
bellard 已提交
1046
        reset_mixer (s);
B
bellard 已提交
1047 1048 1049
        break;

    case 0x80:
B
bellard 已提交
1050 1051 1052
        {
            int irq = irq_of_magic (val);
            ldebug ("setting irq to %d (val=%#x)\n", irq, val);
1053
            if (irq > 0) {
B
bellard 已提交
1054
                s->irq = irq;
1055
            }
B
bellard 已提交
1056
        }
B
bellard 已提交
1057
        break;
B
bellard 已提交
1058

B
bellard 已提交
1059 1060 1061
    case 0x81:
        {
            int dma, hdma;
B
bellard 已提交
1062

B
bellard 已提交
1063 1064
            dma = lsbindex (val & 0xf);
            hdma = lsbindex (val & 0xf0);
1065 1066 1067 1068 1069 1070
            if (dma != s->dma || hdma != s->hdma) {
                dolog (
                    "attempt to change DMA "
                    "8bit %d(%d), 16bit %d(%d) (val=%#x)\n",
                    dma, s->dma, hdma, s->hdma, val);
            }
B
bellard 已提交
1071 1072 1073 1074 1075 1076
#if 0
            s->dma = dma;
            s->hdma = hdma;
#endif
        }
        break;
B
bellard 已提交
1077

B
bellard 已提交
1078 1079 1080 1081
    case 0x82:
        dolog ("attempt to write into IRQ status register (val=%#x)\n",
               val);
        return;
B
bellard 已提交
1082

B
bellard 已提交
1083
    default:
1084 1085 1086
        if (s->mixer_nreg >= 0x80) {
            ldebug ("attempt to write mixer[%#x] <- %#x\n", s->mixer_nreg, val);
        }
B
bellard 已提交
1087 1088 1089 1090
        break;
    }

    s->mixer_regs[s->mixer_nreg] = val;
B
bellard 已提交
1091 1092
}

B
bellard 已提交
1093 1094
static IO_WRITE_PROTO(mixer_write_indexw)
{
B
bellard 已提交
1095 1096
    mixer_write_indexb (opaque, nport, val & 0xff);
    mixer_write_datab (opaque, nport, (val >> 8) & 0xff);
B
bellard 已提交
1097 1098 1099 1100
}

static IO_READ_PROTO(mixer_read)
{
B
bellard 已提交
1101
    SB16State *s = opaque;
B
bellard 已提交
1102 1103

    (void) nport;
B
bellard 已提交
1104
#ifndef DEBUG_SB16_MOST
1105 1106 1107 1108 1109
    if (s->mixer_nreg != 0x82) {
        ldebug ("mixer_read[%#x] -> %#x\n",
                s->mixer_nreg, s->mixer_regs[s->mixer_nreg]);
    }
#else
B
bellard 已提交
1110 1111
    ldebug ("mixer_read[%#x] -> %#x\n",
            s->mixer_nreg, s->mixer_regs[s->mixer_nreg]);
1112
#endif
B
bellard 已提交
1113
    return s->mixer_regs[s->mixer_nreg];
B
bellard 已提交
1114 1115
}

B
bellard 已提交
1116 1117
static int write_audio (SB16State *s, int nchan, int dma_pos,
                        int dma_len, int len)
B
bellard 已提交
1118 1119
{
    int temp, net;
1120
    uint8_t tmpbuf[4096];
B
bellard 已提交
1121

B
bellard 已提交
1122
    temp = len;
B
bellard 已提交
1123 1124 1125
    net = 0;

    while (temp) {
B
bellard 已提交
1126
        int left = dma_len - dma_pos;
B
bellard 已提交
1127 1128
        int copied;
        size_t to_copy;
B
bellard 已提交
1129

B
bellard 已提交
1130
        to_copy = audio_MIN (temp, left);
B
bellard 已提交
1131 1132
        if (to_copy > sizeof (tmpbuf)) {
            to_copy = sizeof (tmpbuf);
1133
        }
B
bellard 已提交
1134

B
bellard 已提交
1135 1136
        copied = DMA_read_memory (nchan, tmpbuf, dma_pos, to_copy);
        copied = AUD_write (s->voice, tmpbuf, copied);
B
bellard 已提交
1137

B
bellard 已提交
1138 1139
        temp -= copied;
        dma_pos = (dma_pos + copied) % dma_len;
B
bellard 已提交
1140 1141
        net += copied;

1142
        if (!copied) {
B
bellard 已提交
1143
            break;
1144
        }
B
bellard 已提交
1145 1146 1147 1148 1149
    }

    return net;
}

B
bellard 已提交
1150
static int SB_read_DMA (void *opaque, int nchan, int dma_pos, int dma_len)
B
bellard 已提交
1151
{
B
bellard 已提交
1152
    SB16State *s = opaque;
1153
    int till, copy, written, free;
B
bellard 已提交
1154

B
bellard 已提交
1155 1156
    if (s->left_till_irq < 0) {
        s->left_till_irq = s->block_size;
B
bellard 已提交
1157 1158
    }

1159 1160 1161 1162 1163 1164 1165 1166
    if (s->voice) {
        free = s->audio_free & ~s->align;
        if ((free <= 0) || !dma_len) {
            return dma_pos;
        }
    }
    else {
        free = dma_len;
B
bellard 已提交
1167 1168
    }

B
bellard 已提交
1169 1170
    copy = free;
    till = s->left_till_irq;
B
bellard 已提交
1171

B
bellard 已提交
1172
#ifdef DEBUG_SB16_MOST
1173 1174
    dolog ("pos:%06d %d till:%d len:%d\n",
           dma_pos, free, till, dma_len);
B
bellard 已提交
1175 1176
#endif

B
bellard 已提交
1177
    if (till <= copy) {
B
bellard 已提交
1178
        if (0 == s->dma_auto) {
B
bellard 已提交
1179 1180 1181 1182
            copy = till;
        }
    }

B
bellard 已提交
1183 1184 1185
    written = write_audio (s, nchan, dma_pos, dma_len, copy);
    dma_pos = (dma_pos + written) % dma_len;
    s->left_till_irq -= written;
B
bellard 已提交
1186

B
bellard 已提交
1187 1188 1189 1190 1191 1192
    if (s->left_till_irq <= 0) {
        s->mixer_regs[0x82] |= (nchan & 4) ? 2 : 1;
        pic_set_irq (s->irq, 1);
        if (0 == s->dma_auto) {
            control (s, 0);
            speaker (s, 0);
B
bellard 已提交
1193 1194 1195
        }
    }

B
bellard 已提交
1196
#ifdef DEBUG_SB16_MOST
B
bellard 已提交
1197 1198 1199
    ldebug ("pos %5d free %5d size %5d till % 5d copy %5d written %5d size %5d\n",
            dma_pos, free, dma_len, s->left_till_irq, copy, written,
            s->block_size);
B
bellard 已提交
1200
#endif
B
bellard 已提交
1201

B
bellard 已提交
1202 1203
    while (s->left_till_irq <= 0) {
        s->left_till_irq = s->block_size + s->left_till_irq;
B
bellard 已提交
1204 1205
    }

B
bellard 已提交
1206
    return dma_pos;
B
bellard 已提交
1207 1208
}

1209
static void SB_audio_callback (void *opaque, int free)
B
bellard 已提交
1210
{
B
bellard 已提交
1211
    SB16State *s = opaque;
1212
    s->audio_free = free;
B
bellard 已提交
1213 1214
}

B
bellard 已提交
1215
static void SB_save (QEMUFile *f, void *opaque)
B
bellard 已提交
1216
{
B
bellard 已提交
1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265
    SB16State *s = opaque;

    qemu_put_be32s (f, &s->irq);
    qemu_put_be32s (f, &s->dma);
    qemu_put_be32s (f, &s->hdma);
    qemu_put_be32s (f, &s->port);
    qemu_put_be32s (f, &s->ver);
    qemu_put_be32s (f, &s->in_index);
    qemu_put_be32s (f, &s->out_data_len);
    qemu_put_be32s (f, &s->fmt_stereo);
    qemu_put_be32s (f, &s->fmt_signed);
    qemu_put_be32s (f, &s->fmt_bits);
    qemu_put_be32s (f, &s->fmt);
    qemu_put_be32s (f, &s->dma_auto);
    qemu_put_be32s (f, &s->block_size);
    qemu_put_be32s (f, &s->fifo);
    qemu_put_be32s (f, &s->freq);
    qemu_put_be32s (f, &s->time_const);
    qemu_put_be32s (f, &s->speaker);
    qemu_put_be32s (f, &s->needed_bytes);
    qemu_put_be32s (f, &s->cmd);
    qemu_put_be32s (f, &s->use_hdma);
    qemu_put_be32s (f, &s->highspeed);
    qemu_put_be32s (f, &s->can_write);
    qemu_put_be32s (f, &s->v2x6);

    qemu_put_8s (f, &s->csp_param);
    qemu_put_8s (f, &s->csp_value);
    qemu_put_8s (f, &s->csp_mode);
    qemu_put_8s (f, &s->csp_param);
    qemu_put_buffer (f, s->csp_regs, 256);
    qemu_put_8s (f, &s->csp_index);
    qemu_put_buffer (f, s->csp_reg83, 4);
    qemu_put_be32s (f, &s->csp_reg83r);
    qemu_put_be32s (f, &s->csp_reg83w);

    qemu_put_buffer (f, s->in2_data, sizeof (s->in2_data));
    qemu_put_buffer (f, s->out_data, sizeof (s->out_data));
    qemu_put_8s (f, &s->test_reg);
    qemu_put_8s (f, &s->last_read_byte);

    qemu_put_be32s (f, &s->nzero);
    qemu_put_be32s (f, &s->left_till_irq);
    qemu_put_be32s (f, &s->dma_running);
    qemu_put_be32s (f, &s->bytes_per_second);
    qemu_put_be32s (f, &s->align);

    qemu_put_be32s (f, &s->mixer_nreg);
    qemu_put_buffer (f, s->mixer_regs, 256);
B
bellard 已提交
1266 1267
}

B
bellard 已提交
1268
static int SB_load (QEMUFile *f, void *opaque, int version_id)
B
bellard 已提交
1269
{
B
bellard 已提交
1270 1271
    SB16State *s = opaque;

1272
    if (version_id != 1) {
B
bellard 已提交
1273
        return -EINVAL;
1274
    }
B
bellard 已提交
1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323

    qemu_get_be32s (f, &s->irq);
    qemu_get_be32s (f, &s->dma);
    qemu_get_be32s (f, &s->hdma);
    qemu_get_be32s (f, &s->port);
    qemu_get_be32s (f, &s->ver);
    qemu_get_be32s (f, &s->in_index);
    qemu_get_be32s (f, &s->out_data_len);
    qemu_get_be32s (f, &s->fmt_stereo);
    qemu_get_be32s (f, &s->fmt_signed);
    qemu_get_be32s (f, &s->fmt_bits);
    qemu_get_be32s (f, &s->fmt);
    qemu_get_be32s (f, &s->dma_auto);
    qemu_get_be32s (f, &s->block_size);
    qemu_get_be32s (f, &s->fifo);
    qemu_get_be32s (f, &s->freq);
    qemu_get_be32s (f, &s->time_const);
    qemu_get_be32s (f, &s->speaker);
    qemu_get_be32s (f, &s->needed_bytes);
    qemu_get_be32s (f, &s->cmd);
    qemu_get_be32s (f, &s->use_hdma);
    qemu_get_be32s (f, &s->highspeed);
    qemu_get_be32s (f, &s->can_write);
    qemu_get_be32s (f, &s->v2x6);

    qemu_get_8s (f, &s->csp_param);
    qemu_get_8s (f, &s->csp_value);
    qemu_get_8s (f, &s->csp_mode);
    qemu_get_8s (f, &s->csp_param);
    qemu_get_buffer (f, s->csp_regs, 256);
    qemu_get_8s (f, &s->csp_index);
    qemu_get_buffer (f, s->csp_reg83, 4);
    qemu_get_be32s (f, &s->csp_reg83r);
    qemu_get_be32s (f, &s->csp_reg83w);

    qemu_get_buffer (f, s->in2_data, sizeof (s->in2_data));
    qemu_get_buffer (f, s->out_data, sizeof (s->out_data));
    qemu_get_8s (f, &s->test_reg);
    qemu_get_8s (f, &s->last_read_byte);

    qemu_get_be32s (f, &s->nzero);
    qemu_get_be32s (f, &s->left_till_irq);
    qemu_get_be32s (f, &s->dma_running);
    qemu_get_be32s (f, &s->bytes_per_second);
    qemu_get_be32s (f, &s->align);

    qemu_get_be32s (f, &s->mixer_nreg);
    qemu_get_buffer (f, s->mixer_regs, 256);

B
bellard 已提交
1324
    if (s->voice) {
B
bellard 已提交
1325
        AUD_close_out (&s->card, s->voice);
B
bellard 已提交
1326 1327
        s->voice = NULL;
    }
B
bellard 已提交
1328 1329

    if (s->dma_running) {
1330
        if (s->freq) {
B
bellard 已提交
1331 1332
            audsettings_t as;

1333
            s->audio_free = 0;
B
bellard 已提交
1334 1335 1336 1337 1338

            as.freq = s->freq;
            as.nchannels = 1 << s->fmt_stereo;
            as.fmt = s->fmt;

1339
            s->voice = AUD_open_out (
B
bellard 已提交
1340
                &s->card,
1341 1342 1343 1344
                s->voice,
                "sb16",
                s,
                SB_audio_callback,
B
bellard 已提交
1345 1346
                &as,
                0               /* little endian */
1347 1348
                );
        }
B
bellard 已提交
1349 1350 1351

        control (s, 1);
        speaker (s, s->speaker);
B
bellard 已提交
1352
    }
B
bellard 已提交
1353
    return 0;
B
bellard 已提交
1354 1355
}

B
bellard 已提交
1356
int SB16_init (AudioState *audio)
B
bellard 已提交
1357
{
B
bellard 已提交
1358
    SB16State *s;
B
bellard 已提交
1359 1360 1361 1362
    int i;
    static const uint8_t dsp_write_ports[] = {0x6, 0xc};
    static const uint8_t dsp_read_ports[] = {0x6, 0xa, 0xc, 0xd, 0xe, 0xf};

B
bellard 已提交
1363 1364 1365 1366 1367 1368 1369
    if (!audio) {
        dolog ("No audio state\n");
        return -1;
    }

    s = qemu_mallocz (sizeof (*s));
    if (!s) {
B
bellard 已提交
1370
        dolog ("Could not allocate memory for SB16 (%zu bytes)\n",
B
bellard 已提交
1371 1372 1373 1374
               sizeof (*s));
        return -1;
    }

1375
    s->cmd = -1;
B
bellard 已提交
1376 1377 1378 1379 1380
    s->irq = conf.irq;
    s->dma = conf.dma;
    s->hdma = conf.hdma;
    s->port = conf.port;
    s->ver = conf.ver_lo | (conf.ver_hi << 8);
B
bellard 已提交
1381

B
bellard 已提交
1382 1383 1384 1385 1386 1387 1388 1389 1390
    s->mixer_regs[0x80] = magic_of_irq (s->irq);
    s->mixer_regs[0x81] = (1 << s->dma) | (1 << s->hdma);
    s->mixer_regs[0x82] = 2 << 5;

    s->csp_regs[5] = 1;
    s->csp_regs[9] = 0xf8;

    reset_mixer (s);
    s->aux_ts = qemu_new_timer (vm_clock, aux_timer, s);
1391
    if (!s->aux_ts) {
B
bellard 已提交
1392
        dolog ("warning: Could not create auxiliary timer\n");
1393
    }
B
bellard 已提交
1394 1395

    for (i = 0; i < LENOFA (dsp_write_ports); i++) {
B
bellard 已提交
1396
        register_ioport_write (s->port + dsp_write_ports[i], 1, 1, dsp_write, s);
B
bellard 已提交
1397 1398 1399
    }

    for (i = 0; i < LENOFA (dsp_read_ports); i++) {
B
bellard 已提交
1400
        register_ioport_read (s->port + dsp_read_ports[i], 1, 1, dsp_read, s);
B
bellard 已提交
1401 1402
    }

B
bellard 已提交
1403 1404 1405 1406
    register_ioport_write (s->port + 0x4, 1, 1, mixer_write_indexb, s);
    register_ioport_write (s->port + 0x4, 1, 2, mixer_write_indexw, s);
    register_ioport_read (s->port + 0x5, 1, 1, mixer_read, s);
    register_ioport_write (s->port + 0x5, 1, 1, mixer_write_datab, s);
B
bellard 已提交
1407

B
bellard 已提交
1408 1409 1410
    DMA_register_channel (s->hdma, SB_read_DMA, s);
    DMA_register_channel (s->dma, SB_read_DMA, s);
    s->can_write = 1;
B
bellard 已提交
1411

B
bellard 已提交
1412
    register_savevm ("sb16", 0, 1, SB_save, SB_load, s);
B
bellard 已提交
1413 1414
    AUD_register_card (audio, "sb16", &s->card);
    return 0;
B
bellard 已提交
1415
}