hw/audio/sb16.c

   1 /*
   2  * QEMU Soundblaster 16 emulation
   3  *
   4  * Copyright (c) 2003-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 #include "qemu/osdep.h"
  25 #include "hw/hw.h"
  26 #include "hw/audio/soundhw.h"
  27 #include "audio/audio.h"
  28 #include "hw/isa/isa.h"
  29 #include "hw/qdev.h"
  30 #include "qemu/timer.h"
  31 #include "qemu/host-utils.h"
  32
  33 #define dolog(...) AUD_log ("sb16", __VA_ARGS__)
  34
  35 /* #define DEBUG */
  36 /* #define DEBUG_SB16_MOST */
  37
  38 #ifdef DEBUG
  39 #define ldebug(...) dolog (__VA_ARGS__)
  40 #else
  41 #define ldebug(...)
  42 #endif
  43
  44 static const char e3[] = "COPYRIGHT (C) CREATIVE TECHNOLOGY LTD, 1992.";
  45
  46 #define TYPE_SB16 "sb16"
  47 #define SB16(obj) OBJECT_CHECK (SB16State, (obj), TYPE_SB16)
  48
  49 typedef struct SB16State {
  50     ISADevice parent_obj;
  51
  52     QEMUSoundCard card;
  53     qemu_irq pic;
  54     uint32_t irq;
  55     uint32_t dma;
  56     uint32_t hdma;
  57     uint32_t port;
  58     uint32_t ver;
  59     IsaDma *isa_dma;
  60     IsaDma *isa_hdma;
  61
  62     int in_index;
  63     int out_data_len;
  64     int fmt_stereo;
  65     int fmt_signed;
  66     int fmt_bits;
  67     audfmt_e fmt;
  68     int dma_auto;
  69     int block_size;
  70     int fifo;
  71     int freq;
  72     int time_const;
  73     int speaker;
  74     int needed_bytes;
  75     int cmd;
  76     int use_hdma;
  77     int highspeed;
  78     int can_write;
  79
  80     int v2x6;
  81
  82     uint8_t csp_param;
  83     uint8_t csp_value;
  84     uint8_t csp_mode;
  85     uint8_t csp_regs[256];
  86     uint8_t csp_index;
  87     uint8_t csp_reg83[4];
  88     int csp_reg83r;
  89     int csp_reg83w;
  90
  91     uint8_t in2_data[10];
  92     uint8_t out_data[50];
  93     uint8_t test_reg;
  94     uint8_t last_read_byte;
  95     int nzero;
  96
  97     int left_till_irq;
  98
  99     int dma_running;
 100     int bytes_per_second;
 101     int align;
 102     int audio_free;
 103     SWVoiceOut *voice;
 104
 105     QEMUTimer *aux_ts;
 106     /* mixer state */
 107     int mixer_nreg;
 108     uint8_t mixer_regs[256];
 109     PortioList portio_list;
 110 } SB16State;
 111
 112 static void SB_audio_callback (void *opaque, int free);
 113
 114 static int magic_of_irq (int irq)
 115 {
 116     switch (irq) {
 117     case 5:
 118         return 2;
 119     case 7:
 120         return 4;
 121     case 9:
 122         return 1;
 123     case 10:
 124         return 8;
 125     default:
 126         dolog ("bad irq %d\n", irq);
 127         return 2;
 128     }
 129 }
 130
 131 static int irq_of_magic (int magic)
 132 {
 133     switch (magic) {
 134     case 1:
 135         return 9;
 136     case 2:
 137         return 5;
 138     case 4:
 139         return 7;
 140     case 8:
 141         return 10;
 142     default:
 143         dolog ("bad irq magic %d\n", magic);
 144         return -1;
 145     }
 146 }
 147
 148 #if 0
 149 static void log_dsp (SB16State *dsp)
 150 {
 151     ldebug ("%s:%s:%d:%s:dmasize=%d:freq=%d:const=%d:speaker=%d\n",
 152             dsp->fmt_stereo ? "Stereo" : "Mono",
 153             dsp->fmt_signed ? "Signed" : "Unsigned",
 154             dsp->fmt_bits,
 155             dsp->dma_auto ? "Auto" : "Single",
 156             dsp->block_size,
 157             dsp->freq,
 158             dsp->time_const,
 159             dsp->speaker);
 160 }
 161 #endif
 162
 163 static void speaker (SB16State *s, int on)
 164 {
 165     s->speaker = on;
 166     /* AUD_enable (s->voice, on); */
 167 }
 168
 169 static void control (SB16State *s, int hold)
 170 {
 171     int dma = s->use_hdma ? s->hdma : s->dma;
 172     IsaDma *isa_dma = s->use_hdma ? s->isa_hdma : s->isa_dma;
 173     IsaDmaClass *k = ISADMA_GET_CLASS(isa_dma);
 174     s->dma_running = hold;
 175
 176     ldebug ("hold %d high %d dma %d\n", hold, s->use_hdma, dma);
 177
 178     if (hold) {
 179         k->hold_DREQ(isa_dma, dma);
 180         AUD_set_active_out (s->voice, 1);
 181     }
 182     else {
 183         k->release_DREQ(isa_dma, dma);
 184         AUD_set_active_out (s->voice, 0);
 185     }
 186 }
 187
 188 static void aux_timer (void *opaque)
 189 {
 190     SB16State *s = opaque;
 191     s->can_write = 1;
 192     qemu_irq_raise (s->pic);
 193 }
 194
 195 #define DMA8_AUTO 1
 196 #define DMA8_HIGH 2
 197
 198 static void continue_dma8 (SB16State *s)
 199 {
 200     if (s->freq > 0) {
 201         struct audsettings as;
 202
 203         s->audio_free = 0;
 204
 205         as.freq = s->freq;
 206         as.nchannels = 1 << s->fmt_stereo;
 207         as.fmt = s->fmt;
 208         as.endianness = 0;
 209
 210         s->voice = AUD_open_out (
 211             &s->card,
 212             s->voice,
 213             "sb16",
 214             s,
 215             SB_audio_callback,
 216             &as
 217             );
 218     }
 219
 220     control (s, 1);
 221 }
 222
 223 static void dma_cmd8 (SB16State *s, int mask, int dma_len)
 224 {
 225     s->fmt = AUD_FMT_U8;
 226     s->use_hdma = 0;
 227     s->fmt_bits = 8;
 228     s->fmt_signed = 0;
 229     s->fmt_stereo = (s->mixer_regs[0x0e] & 2) != 0;
 230     if (-1 == s->time_const) {
 231         if (s->freq <= 0)
 232             s->freq = 11025;
 233     }
 234     else {
 235         int tmp = (256 - s->time_const);
 236         s->freq = (1000000 + (tmp / 2)) / tmp;
 237     }
 238
 239     if (dma_len != -1) {
 240         s->block_size = dma_len << s->fmt_stereo;
 241     }
 242     else {
 243         /* This is apparently the only way to make both Act1/PL
 244            and SecondReality/FC work
 245
 246            Act1 sets block size via command 0x48 and it's an odd number
 247            SR does the same with even number
 248            Both use stereo, and Creatives own documentation states that
 249            0x48 sets block size in bytes less one.. go figure */
 250         s->block_size &= ~s->fmt_stereo;
 251     }
 252
 253     s->freq >>= s->fmt_stereo;
 254     s->left_till_irq = s->block_size;
 255     s->bytes_per_second = (s->freq << s->fmt_stereo);
 256     /* s->highspeed = (mask & DMA8_HIGH) != 0; */
 257     s->dma_auto = (mask & DMA8_AUTO) != 0;
 258     s->align = (1 << s->fmt_stereo) - 1;
 259
 260     if (s->block_size & s->align) {
 261         dolog ("warning: misaligned block size %d, alignment %d\n",
 262                s->block_size, s->align + 1);
 263     }
 264
 265     ldebug ("freq %d, stereo %d, sign %d, bits %d, "
 266             "dma %d, auto %d, fifo %d, high %d\n",
 267             s->freq, s->fmt_stereo, s->fmt_signed, s->fmt_bits,
 268             s->block_size, s->dma_auto, s->fifo, s->highspeed);
 269
 270     continue_dma8 (s);
 271     speaker (s, 1);
 272 }
 273
 274 static void dma_cmd (SB16State *s, uint8_t cmd, uint8_t d0, int dma_len)
 275 {
 276     s->use_hdma = cmd < 0xc0;
 277     s->fifo = (cmd >> 1) & 1;
 278     s->dma_auto = (cmd >> 2) & 1;
 279     s->fmt_signed = (d0 >> 4) & 1;
 280     s->fmt_stereo = (d0 >> 5) & 1;
 281
 282     switch (cmd >> 4) {
 283     case 11:
 284         s->fmt_bits = 16;
 285         break;
 286
 287     case 12:
 288         s->fmt_bits = 8;
 289         break;
 290     }
 291
 292     if (-1 != s->time_const) {
 293 #if 1
 294         int tmp = 256 - s->time_const;
 295         s->freq = (1000000 + (tmp / 2)) / tmp;
 296 #else
 297         /* s->freq = 1000000 / ((255 - s->time_const) << s->fmt_stereo); */
 298         s->freq = 1000000 / ((255 - s->time_const));
 299 #endif
 300         s->time_const = -1;
 301     }
 302
 303     s->block_size = dma_len + 1;
 304     s->block_size <<= (s->fmt_bits == 16);
 305     if (!s->dma_auto) {
 306         /* It is clear that for DOOM and auto-init this value
 307            shouldn't take stereo into account, while Miles Sound Systems
 308            setsound.exe with single transfer mode wouldn't work without it
 309            wonders of SB16 yet again */
 310         s->block_size <<= s->fmt_stereo;
 311     }
 312
 313     ldebug ("freq %d, stereo %d, sign %d, bits %d, "
 314             "dma %d, auto %d, fifo %d, high %d\n",
 315             s->freq, s->fmt_stereo, s->fmt_signed, s->fmt_bits,
 316             s->block_size, s->dma_auto, s->fifo, s->highspeed);
 317
 318     if (16 == s->fmt_bits) {
 319         if (s->fmt_signed) {
 320             s->fmt = AUD_FMT_S16;
 321         }
 322         else {
 323             s->fmt = AUD_FMT_U16;
 324         }
 325     }
 326     else {
 327         if (s->fmt_signed) {
 328             s->fmt = AUD_FMT_S8;
 329         }
 330         else {
 331             s->fmt = AUD_FMT_U8;
 332         }
 333     }
 334
 335     s->left_till_irq = s->block_size;
 336
 337     s->bytes_per_second = (s->freq << s->fmt_stereo) << (s->fmt_bits == 16);
 338     s->highspeed = 0;
 339     s->align = (1 << (s->fmt_stereo + (s->fmt_bits == 16))) - 1;
 340     if (s->block_size & s->align) {
 341         dolog ("warning: misaligned block size %d, alignment %d\n",
 342                s->block_size, s->align + 1);
 343     }
 344
 345     if (s->freq) {
 346         struct audsettings as;
 347
 348         s->audio_free = 0;
 349
 350         as.freq = s->freq;
 351         as.nchannels = 1 << s->fmt_stereo;
 352         as.fmt = s->fmt;
 353         as.endianness = 0;
 354
 355         s->voice = AUD_open_out (
 356             &s->card,
 357             s->voice,
 358             "sb16",
 359             s,
 360             SB_audio_callback,
 361             &as
 362             );
 363     }
 364
 365     control (s, 1);
 366     speaker (s, 1);
 367 }
 368
 369 static inline void dsp_out_data (SB16State *s, uint8_t val)
 370 {
 371     ldebug ("outdata %#x\n", val);
 372     if ((size_t) s->out_data_len < sizeof (s->out_data)) {
 373         s->out_data[s->out_data_len++] = val;
 374     }
 375 }
 376
 377 static inline uint8_t dsp_get_data (SB16State *s)
 378 {
 379     if (s->in_index) {
 380         return s->in2_data[--s->in_index];
 381     }
 382     else {
 383         dolog ("buffer underflow\n");
 384         return 0;
 385     }
 386 }
 387
 388 static void command (SB16State *s, uint8_t cmd)
 389 {
 390     ldebug ("command %#x\n", cmd);
 391
 392     if (cmd > 0xaf && cmd < 0xd0) {
 393         if (cmd & 8) {
 394             dolog ("ADC not yet supported (command %#x)\n", cmd);
 395         }
 396
 397         switch (cmd >> 4) {
 398         case 11:
 399         case 12:
 400             break;
 401         default:
 402             dolog ("%#x wrong bits\n", cmd);
 403         }
 404         s->needed_bytes = 3;
 405     }
 406     else {
 407         s->needed_bytes = 0;
 408
 409         switch (cmd) {
 410         case 0x03:
 411             dsp_out_data (s, 0x10); /* s->csp_param); */
 412             goto warn;
 413
 414         case 0x04:
 415             s->needed_bytes = 1;
 416             goto warn;
 417
 418         case 0x05:
 419             s->needed_bytes = 2;
 420             goto warn;
 421
 422         case 0x08:
 423             /* __asm__ ("int3"); */
 424             goto warn;
 425
 426         case 0x0e:
 427             s->needed_bytes = 2;
 428             goto warn;
 429
 430         case 0x09:
 431             dsp_out_data (s, 0xf8);
 432             goto warn;
 433
 434         case 0x0f:
 435             s->needed_bytes = 1;
 436             goto warn;
 437
 438         case 0x10:
 439             s->needed_bytes = 1;
 440             goto warn;
 441
 442         case 0x14:
 443             s->needed_bytes = 2;
 444             s->block_size = 0;
 445             break;
 446
 447         case 0x1c:              /* Auto-Initialize DMA DAC, 8-bit */
 448             dma_cmd8 (s, DMA8_AUTO, -1);
 449             break;
 450
 451         case 0x20:              /* Direct ADC, Juice/PL */
 452             dsp_out_data (s, 0xff);
 453             goto warn;
 454
 455         case 0x35:
 456             dolog ("0x35 - MIDI command not implemented\n");
 457             break;
 458
 459         case 0x40:
 460             s->freq = -1;
 461             s->time_const = -1;
 462             s->needed_bytes = 1;
 463             break;
 464
 465         case 0x41:
 466             s->freq = -1;
 467             s->time_const = -1;
 468             s->needed_bytes = 2;
 469             break;
 470
 471         case 0x42:
 472             s->freq = -1;
 473             s->time_const = -1;
 474             s->needed_bytes = 2;
 475             goto warn;
 476
 477         case 0x45:
 478             dsp_out_data (s, 0xaa);
 479             goto warn;
 480
 481         case 0x47:                /* Continue Auto-Initialize DMA 16bit */
 482             break;
 483
 484         case 0x48:
 485             s->needed_bytes = 2;
 486             break;
 487
 488         case 0x74:
 489             s->needed_bytes = 2; /* DMA DAC, 4-bit ADPCM */
 490             dolog ("0x75 - DMA DAC, 4-bit ADPCM not implemented\n");
 491             break;
 492
 493         case 0x75:              /* DMA DAC, 4-bit ADPCM Reference */
 494             s->needed_bytes = 2;
 495             dolog ("0x74 - DMA DAC, 4-bit ADPCM Reference not implemented\n");
 496             break;
 497
 498         case 0x76:              /* DMA DAC, 2.6-bit ADPCM */
 499             s->needed_bytes = 2;
 500             dolog ("0x74 - DMA DAC, 2.6-bit ADPCM not implemented\n");
 501             break;
 502
 503         case 0x77:              /* DMA DAC, 2.6-bit ADPCM Reference */
 504             s->needed_bytes = 2;
 505             dolog ("0x74 - DMA DAC, 2.6-bit ADPCM Reference not implemented\n");
 506             break;
 507
 508         case 0x7d:
 509             dolog ("0x7d - Autio-Initialize DMA DAC, 4-bit ADPCM Reference\n");
 510             dolog ("not implemented\n");
 511             break;
 512
 513         case 0x7f:
 514             dolog (
 515                 "0x7d - Autio-Initialize DMA DAC, 2.6-bit ADPCM Reference\n"
 516                 );
 517             dolog ("not implemented\n");
 518             break;
 519
 520         case 0x80:
 521             s->needed_bytes = 2;
 522             break;
 523
 524         case 0x90:
 525         case 0x91:
 526             dma_cmd8 (s, ((cmd & 1) == 0) | DMA8_HIGH, -1);
 527             break;
 528
 529         case 0xd0:              /* halt DMA operation. 8bit */
 530             control (s, 0);
 531             break;
 532
 533         case 0xd1:              /* speaker on */
 534             speaker (s, 1);
 535             break;
 536
 537         case 0xd3:              /* speaker off */
 538             speaker (s, 0);
 539             break;
 540
 541         case 0xd4:              /* continue DMA operation. 8bit */
 542             /* KQ6 (or maybe Sierras audblst.drv in general) resets
 543                the frequency between halt/continue */
 544             continue_dma8 (s);
 545             break;
 546
 547         case 0xd5:              /* halt DMA operation. 16bit */
 548             control (s, 0);
 549             break;
 550
 551         case 0xd6:              /* continue DMA operation. 16bit */
 552             control (s, 1);
 553             break;
 554
 555         case 0xd9:              /* exit auto-init DMA after this block. 16bit */
 556             s->dma_auto = 0;
 557             break;
 558
 559         case 0xda:              /* exit auto-init DMA after this block. 8bit */
 560             s->dma_auto = 0;
 561             break;
 562
 563         case 0xe0:              /* DSP identification */
 564             s->needed_bytes = 1;
 565             break;
 566
 567         case 0xe1:
 568             dsp_out_data (s, s->ver & 0xff);
 569             dsp_out_data (s, s->ver >> 8);
 570             break;
 571
 572         case 0xe2:
 573             s->needed_bytes = 1;
 574             goto warn;
 575
 576         case 0xe3:
 577             {
 578                 int i;
 579                 for (i = sizeof (e3) - 1; i >= 0; --i)
 580                     dsp_out_data (s, e3[i]);
 581             }
 582             break;
 583
 584         case 0xe4:              /* write test reg */
 585             s->needed_bytes = 1;
 586             break;
 587
 588         case 0xe7:
 589             dolog ("Attempt to probe for ESS (0xe7)?\n");
 590             break;
 591
 592         case 0xe8:              /* read test reg */
 593             dsp_out_data (s, s->test_reg);
 594             break;
 595
 596         case 0xf2:
 597         case 0xf3:
 598             dsp_out_data (s, 0xaa);
 599             s->mixer_regs[0x82] |= (cmd == 0xf2) ? 1 : 2;
 600             qemu_irq_raise (s->pic);
 601             break;
 602
 603         case 0xf9:
 604             s->needed_bytes = 1;
 605             goto warn;
 606
 607         case 0xfa:
 608             dsp_out_data (s, 0);
 609             goto warn;
 610
 611         case 0xfc:              /* FIXME */
 612             dsp_out_data (s, 0);
 613             goto warn;
 614
 615         default:
 616             dolog ("Unrecognized command %#x\n", cmd);
 617             break;
 618         }
 619     }
 620
 621     if (!s->needed_bytes) {
 622         ldebug ("\n");
 623     }
 624
 625  exit:
 626     if (!s->needed_bytes) {
 627         s->cmd = -1;
 628     }
 629     else {
 630         s->cmd = cmd;
 631     }
 632     return;
 633
 634  warn:
 635     dolog ("warning: command %#x,%d is not truly understood yet\n",
 636            cmd, s->needed_bytes);
 637     goto exit;
 638
 639 }
 640
 641 static uint16_t dsp_get_lohi (SB16State *s)
 642 {
 643     uint8_t hi = dsp_get_data (s);
 644     uint8_t lo = dsp_get_data (s);
 645     return (hi << 8) | lo;
 646 }
 647
 648 static uint16_t dsp_get_hilo (SB16State *s)
 649 {
 650     uint8_t lo = dsp_get_data (s);
 651     uint8_t hi = dsp_get_data (s);
 652     return (hi << 8) | lo;
 653 }
 654
 655 static void complete (SB16State *s)
 656 {
 657     int d0, d1, d2;
 658     ldebug ("complete command %#x, in_index %d, needed_bytes %d\n",
 659             s->cmd, s->in_index, s->needed_bytes);
 660
 661     if (s->cmd > 0xaf && s->cmd < 0xd0) {
 662         d2 = dsp_get_data (s);
 663         d1 = dsp_get_data (s);
 664         d0 = dsp_get_data (s);
 665
 666         if (s->cmd & 8) {
 667             dolog ("ADC params cmd = %#x d0 = %d, d1 = %d, d2 = %d\n",
 668                    s->cmd, d0, d1, d2);
 669         }
 670         else {
 671             ldebug ("cmd = %#x d0 = %d, d1 = %d, d2 = %d\n",
 672                     s->cmd, d0, d1, d2);
 673             dma_cmd (s, s->cmd, d0, d1 + (d2 << 8));
 674         }
 675     }
 676     else {
 677         switch (s->cmd) {
 678         case 0x04:
 679             s->csp_mode = dsp_get_data (s);
 680             s->csp_reg83r = 0;
 681             s->csp_reg83w = 0;
 682             ldebug ("CSP command 0x04: mode=%#x\n", s->csp_mode);
 683             break;
 684
 685         case 0x05:
 686             s->csp_param = dsp_get_data (s);
 687             s->csp_value = dsp_get_data (s);
 688             ldebug ("CSP command 0x05: param=%#x value=%#x\n",
 689                     s->csp_param,
 690                     s->csp_value);
 691             break;
 692
 693         case 0x0e:
 694             d0 = dsp_get_data (s);
 695             d1 = dsp_get_data (s);
 696             ldebug ("write CSP register %d <- %#x\n", d1, d0);
 697             if (d1 == 0x83) {
 698                 ldebug ("0x83[%d] <- %#x\n", s->csp_reg83r, d0);
 699                 s->csp_reg83[s->csp_reg83r % 4] = d0;
 700                 s->csp_reg83r += 1;
 701             }
 702             else {
 703                 s->csp_regs[d1] = d0;
 704             }
 705             break;
 706
 707         case 0x0f:
 708             d0 = dsp_get_data (s);
 709             ldebug ("read CSP register %#x -> %#x, mode=%#x\n",
 710                     d0, s->csp_regs[d0], s->csp_mode);
 711             if (d0 == 0x83) {
 712                 ldebug ("0x83[%d] -> %#x\n",
 713                         s->csp_reg83w,
 714                         s->csp_reg83[s->csp_reg83w % 4]);
 715                 dsp_out_data (s, s->csp_reg83[s->csp_reg83w % 4]);
 716                 s->csp_reg83w += 1;
 717             }
 718             else {
 719                 dsp_out_data (s, s->csp_regs[d0]);
 720             }
 721             break;
 722
 723         case 0x10:
 724             d0 = dsp_get_data (s);
 725             dolog ("cmd 0x10 d0=%#x\n", d0);
 726             break;
 727
 728         case 0x14:
 729             dma_cmd8 (s, 0, dsp_get_lohi (s) + 1);
 730             break;
 731
 732         case 0x40:
 733             s->time_const = dsp_get_data (s);
 734             ldebug ("set time const %d\n", s->time_const);
 735             break;
 736
 737         case 0x42:              /* FT2 sets output freq with this, go figure */
 738 #if 0
 739             dolog ("cmd 0x42 might not do what it think it should\n");
 740 #endif
 741         case 0x41:
 742             s->freq = dsp_get_hilo (s);
 743             ldebug ("set freq %d\n", s->freq);
 744             break;
 745
 746         case 0x48:
 747             s->block_size = dsp_get_lohi (s) + 1;
 748             ldebug ("set dma block len %d\n", s->block_size);
 749             break;
 750
 751         case 0x74:
 752         case 0x75:
 753         case 0x76:
 754         case 0x77:
 755             /* ADPCM stuff, ignore */
 756             break;
 757
 758         case 0x80:
 759             {
 760                 int freq, samples, bytes;
 761                 int64_t ticks;
 762
 763                 freq = s->freq > 0 ? s->freq : 11025;
 764                 samples = dsp_get_lohi (s) + 1;
 765                 bytes = samples << s->fmt_stereo << (s->fmt_bits == 16);
 766                 ticks = muldiv64(bytes, NANOSECONDS_PER_SECOND, freq);
 767                 if (ticks < NANOSECONDS_PER_SECOND / 1024) {
 768                     qemu_irq_raise (s->pic);
 769                 }
 770                 else {
 771                     if (s->aux_ts) {
 772                         timer_mod (
 773                             s->aux_ts,
 774                             qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + ticks
 775                             );
 776                     }
 777                 }
 778                 ldebug ("mix silence %d %d %" PRId64 "\n", samples, bytes, ticks);
 779             }
 780             break;
 781
 782         case 0xe0:
 783             d0 = dsp_get_data (s);
 784             s->out_data_len = 0;
 785             ldebug ("E0 data = %#x\n", d0);
 786             dsp_out_data (s, ~d0);
 787             break;
 788
 789         case 0xe2:
 790 #ifdef DEBUG
 791             d0 = dsp_get_data (s);
 792             dolog ("E2 = %#x\n", d0);
 793 #endif
 794             break;
 795
 796         case 0xe4:
 797             s->test_reg = dsp_get_data (s);
 798             break;
 799
 800         case 0xf9:
 801             d0 = dsp_get_data (s);
 802             ldebug ("command 0xf9 with %#x\n", d0);
 803             switch (d0) {
 804             case 0x0e:
 805                 dsp_out_data (s, 0xff);
 806                 break;
 807
 808             case 0x0f:
 809                 dsp_out_data (s, 0x07);
 810                 break;
 811
 812             case 0x37:
 813                 dsp_out_data (s, 0x38);
 814                 break;
 815
 816             default:
 817                 dsp_out_data (s, 0x00);
 818                 break;
 819             }
 820             break;
 821
 822         default:
 823             dolog ("complete: unrecognized command %#x\n", s->cmd);
 824             return;
 825         }
 826     }
 827
 828     ldebug ("\n");
 829     s->cmd = -1;
 830 }
 831
 832 static void legacy_reset (SB16State *s)
 833 {
 834     struct audsettings as;
 835
 836     s->freq = 11025;
 837     s->fmt_signed = 0;
 838     s->fmt_bits = 8;
 839     s->fmt_stereo = 0;
 840
 841     as.freq = s->freq;
 842     as.nchannels = 1;
 843     as.fmt = AUD_FMT_U8;
 844     as.endianness = 0;
 845
 846     s->voice = AUD_open_out (
 847         &s->card,
 848         s->voice,
 849         "sb16",
 850         s,
 851         SB_audio_callback,
 852         &as
 853         );
 854
 855     /* Not sure about that... */
 856     /* AUD_set_active_out (s->voice, 1); */
 857 }
 858
 859 static void reset (SB16State *s)
 860 {
 861     qemu_irq_lower (s->pic);
 862     if (s->dma_auto) {
 863         qemu_irq_raise (s->pic);
 864         qemu_irq_lower (s->pic);
 865     }
 866
 867     s->mixer_regs[0x82] = 0;
 868     s->dma_auto = 0;
 869     s->in_index = 0;
 870     s->out_data_len = 0;
 871     s->left_till_irq = 0;
 872     s->needed_bytes = 0;
 873     s->block_size = -1;
 874     s->nzero = 0;
 875     s->highspeed = 0;
 876     s->v2x6 = 0;
 877     s->cmd = -1;
 878
 879     dsp_out_data (s, 0xaa);
 880     speaker (s, 0);
 881     control (s, 0);
 882     legacy_reset (s);
 883 }
 884
 885 static void dsp_write(void *opaque, uint32_t nport, uint32_t val)
 886 {
 887     SB16State *s = opaque;
 888     int iport;
 889
 890     iport = nport - s->port;
 891
 892     ldebug ("write %#x <- %#x\n", nport, val);
 893     switch (iport) {
 894     case 0x06:
 895         switch (val) {
 896         case 0x00:
 897             if (s->v2x6 == 1) {
 898                 reset (s);
 899             }
 900             s->v2x6 = 0;
 901             break;
 902
 903         case 0x01:
 904         case 0x03:              /* FreeBSD kludge */
 905             s->v2x6 = 1;
 906             break;
 907
 908         case 0xc6:
 909             s->v2x6 = 0;        /* Prince of Persia, csp.sys, diagnose.exe */
 910             break;
 911
 912         case 0xb8:              /* Panic */
 913             reset (s);
 914             break;
 915
 916         case 0x39:
 917             dsp_out_data (s, 0x38);
 918             reset (s);
 919             s->v2x6 = 0x39;
 920             break;
 921
 922         default:
 923             s->v2x6 = val;
 924             break;
 925         }
 926         break;
 927
 928     case 0x0c:                  /* write data or command | write status */
 929 /*         if (s->highspeed) */
 930 /*             break; */
 931
 932         if (s->needed_bytes == 0) {
 933             command (s, val);
 934 #if 0
 935             if (0 == s->needed_bytes) {
 936                 log_dsp (s);
 937             }
 938 #endif
 939         }
 940         else {
 941             if (s->in_index == sizeof (s->in2_data)) {
 942                 dolog ("in data overrun\n");
 943             }
 944             else {
 945                 s->in2_data[s->in_index++] = val;
 946                 if (s->in_index == s->needed_bytes) {
 947                     s->needed_bytes = 0;
 948                     complete (s);
 949 #if 0
 950                     log_dsp (s);
 951 #endif
 952                 }
 953             }
 954         }
 955         break;
 956
 957     default:
 958         ldebug ("(nport=%#x, val=%#x)\n", nport, val);
 959         break;
 960     }
 961 }
 962
 963 static uint32_t dsp_read(void *opaque, uint32_t nport)
 964 {
 965     SB16State *s = opaque;
 966     int iport, retval, ack = 0;
 967
 968     iport = nport - s->port;
 969
 970     switch (iport) {
 971     case 0x06:                  /* reset */
 972         retval = 0xff;
 973         break;
 974
 975     case 0x0a:                  /* read data */
 976         if (s->out_data_len) {
 977             retval = s->out_data[--s->out_data_len];
 978             s->last_read_byte = retval;
 979         }
 980         else {
 981             if (s->cmd != -1) {
 982                 dolog ("empty output buffer for command %#x\n",
 983                        s->cmd);
 984             }
 985             retval = s->last_read_byte;
 986             /* goto error; */
 987         }
 988         break;
 989
 990     case 0x0c:                  /* 0 can write */
 991         retval = s->can_write ? 0 : 0x80;
 992         break;
 993
 994     case 0x0d:                  /* timer interrupt clear */
 995         /* dolog ("timer interrupt clear\n"); */
 996         retval = 0;
 997         break;
 998
 999     case 0x0e:                  /* data available status | irq 8 ack */
1000         retval = (!s->out_data_len || s->highspeed) ? 0 : 0x80;
1001         if (s->mixer_regs[0x82] & 1) {
1002             ack = 1;
1003             s->mixer_regs[0x82] &= ~1;
1004             qemu_irq_lower (s->pic);
1005         }
1006         break;
1007
1008     case 0x0f:                  /* irq 16 ack */
1009         retval = 0xff;
1010         if (s->mixer_regs[0x82] & 2) {
1011             ack = 1;
1012             s->mixer_regs[0x82] &= ~2;
1013             qemu_irq_lower (s->pic);
1014         }
1015         break;
1016
1017     default:
1018         goto error;
1019     }
1020
1021     if (!ack) {
1022         ldebug ("read %#x -> %#x\n", nport, retval);
1023     }
1024
1025     return retval;
1026
1027  error:
1028     dolog ("warning: dsp_read %#x error\n", nport);
1029     return 0xff;
1030 }
1031
1032 static void reset_mixer (SB16State *s)
1033 {
1034     int i;
1035
1036     memset (s->mixer_regs, 0xff, 0x7f);
1037     memset (s->mixer_regs + 0x83, 0xff, sizeof (s->mixer_regs) - 0x83);
1038
1039     s->mixer_regs[0x02] = 4;    /* master volume 3bits */
1040     s->mixer_regs[0x06] = 4;    /* MIDI volume 3bits */
1041     s->mixer_regs[0x08] = 0;    /* CD volume 3bits */
1042     s->mixer_regs[0x0a] = 0;    /* voice volume 2bits */
1043
1044     /* d5=input filt, d3=lowpass filt, d1,d2=input source */
1045     s->mixer_regs[0x0c] = 0;
1046
1047     /* d5=output filt, d1=stereo switch */
1048     s->mixer_regs[0x0e] = 0;
1049
1050     /* voice volume L d5,d7, R d1,d3 */
1051     s->mixer_regs[0x04] = (4 << 5) | (4 << 1);
1052     /* master ... */
1053     s->mixer_regs[0x22] = (4 << 5) | (4 << 1);
1054     /* MIDI ... */
1055     s->mixer_regs[0x26] = (4 << 5) | (4 << 1);
1056
1057     for (i = 0x30; i < 0x48; i++) {
1058         s->mixer_regs[i] = 0x20;
1059     }
1060 }
1061
1062 static void mixer_write_indexb(void *opaque, uint32_t nport, uint32_t val)
1063 {
1064     SB16State *s = opaque;
1065     (void) nport;
1066     s->mixer_nreg = val;
1067 }
1068
1069 static void mixer_write_datab(void *opaque, uint32_t nport, uint32_t val)
1070 {
1071     SB16State *s = opaque;
1072
1073     (void) nport;
1074     ldebug ("mixer_write [%#x] <- %#x\n", s->mixer_nreg, val);
1075
1076     switch (s->mixer_nreg) {
1077     case 0x00:
1078         reset_mixer (s);
1079         break;
1080
1081     case 0x80:
1082         {
1083             int irq = irq_of_magic (val);
1084             ldebug ("setting irq to %d (val=%#x)\n", irq, val);
1085             if (irq > 0) {
1086                 s->irq = irq;
1087             }
1088         }
1089         break;
1090
1091     case 0x81:
1092         {
1093             int dma, hdma;
1094
1095             dma = ctz32 (val & 0xf);
1096             hdma = ctz32 (val & 0xf0);
1097             if (dma != s->dma || hdma != s->hdma) {
1098                 dolog (
1099                     "attempt to change DMA "
1100                     "8bit %d(%d), 16bit %d(%d) (val=%#x)\n",
1101                     dma, s->dma, hdma, s->hdma, val);
1102             }
1103 #if 0
1104             s->dma = dma;
1105             s->hdma = hdma;
1106 #endif
1107         }
1108         break;
1109
1110     case 0x82:
1111         dolog ("attempt to write into IRQ status register (val=%#x)\n",
1112                val);
1113         return;
1114
1115     default:
1116         if (s->mixer_nreg >= 0x80) {
1117             ldebug ("attempt to write mixer[%#x] <- %#x\n", s->mixer_nreg, val);
1118         }
1119         break;
1120     }
1121
1122     s->mixer_regs[s->mixer_nreg] = val;
1123 }
1124
1125 static uint32_t mixer_read(void *opaque, uint32_t nport)
1126 {
1127     SB16State *s = opaque;
1128
1129     (void) nport;
1130 #ifndef DEBUG_SB16_MOST
1131     if (s->mixer_nreg != 0x82) {
1132         ldebug ("mixer_read[%#x] -> %#x\n",
1133                 s->mixer_nreg, s->mixer_regs[s->mixer_nreg]);
1134     }
1135 #else
1136     ldebug ("mixer_read[%#x] -> %#x\n",
1137             s->mixer_nreg, s->mixer_regs[s->mixer_nreg]);
1138 #endif
1139     return s->mixer_regs[s->mixer_nreg];
1140 }
1141
1142 static int write_audio (SB16State *s, int nchan, int dma_pos,
1143                         int dma_len, int len)
1144 {
1145     IsaDma *isa_dma = nchan == s->dma ? s->isa_dma : s->isa_hdma;
1146     IsaDmaClass *k = ISADMA_GET_CLASS(isa_dma);
1147     int temp, net;
1148     uint8_t tmpbuf[4096];
1149
1150     temp = len;
1151     net = 0;
1152
1153     while (temp) {
1154         int left = dma_len - dma_pos;
1155         int copied;
1156         size_t to_copy;
1157
1158         to_copy = audio_MIN (temp, left);
1159         if (to_copy > sizeof (tmpbuf)) {
1160             to_copy = sizeof (tmpbuf);
1161         }
1162
1163         copied = k->read_memory(isa_dma, nchan, tmpbuf, dma_pos, to_copy);
1164         copied = AUD_write (s->voice, tmpbuf, copied);
1165
1166         temp -= copied;
1167         dma_pos = (dma_pos + copied) % dma_len;
1168         net += copied;
1169
1170         if (!copied) {
1171             break;
1172         }
1173     }
1174
1175     return net;
1176 }
1177
1178 static int SB_read_DMA (void *opaque, int nchan, int dma_pos, int dma_len)
1179 {
1180     SB16State *s = opaque;
1181     int till, copy, written, free;
1182
1183     if (s->block_size <= 0) {
1184         dolog ("invalid block size=%d nchan=%d dma_pos=%d dma_len=%d\n",
1185                s->block_size, nchan, dma_pos, dma_len);
1186         return dma_pos;
1187     }
1188
1189     if (s->left_till_irq < 0) {
1190         s->left_till_irq = s->block_size;
1191     }
1192
1193     if (s->voice) {
1194         free = s->audio_free & ~s->align;
1195         if ((free <= 0) || !dma_len) {
1196             return dma_pos;
1197         }
1198     }
1199     else {
1200         free = dma_len;
1201     }
1202
1203     copy = free;
1204     till = s->left_till_irq;
1205
1206 #ifdef DEBUG_SB16_MOST
1207     dolog ("pos:%06d %d till:%d len:%d\n",
1208            dma_pos, free, till, dma_len);
1209 #endif
1210
1211     if (till <= copy) {
1212         if (s->dma_auto == 0) {
1213             copy = till;
1214         }
1215     }
1216
1217     written = write_audio (s, nchan, dma_pos, dma_len, copy);
1218     dma_pos = (dma_pos + written) % dma_len;
1219     s->left_till_irq -= written;
1220
1221     if (s->left_till_irq <= 0) {
1222         s->mixer_regs[0x82] |= (nchan & 4) ? 2 : 1;
1223         qemu_irq_raise (s->pic);
1224         if (s->dma_auto == 0) {
1225             control (s, 0);
1226             speaker (s, 0);
1227         }
1228     }
1229
1230 #ifdef DEBUG_SB16_MOST
1231     ldebug ("pos %5d free %5d size %5d till % 5d copy %5d written %5d size %5d\n",
1232             dma_pos, free, dma_len, s->left_till_irq, copy, written,
1233             s->block_size);
1234 #endif
1235
1236     while (s->left_till_irq <= 0) {
1237         s->left_till_irq = s->block_size + s->left_till_irq;
1238     }
1239
1240     return dma_pos;
1241 }
1242
1243 static void SB_audio_callback (void *opaque, int free)
1244 {
1245     SB16State *s = opaque;
1246     s->audio_free = free;
1247 }
1248
1249 static int sb16_post_load (void *opaque, int version_id)
1250 {
1251     SB16State *s = opaque;
1252
1253     if (s->voice) {
1254         AUD_close_out (&s->card, s->voice);
1255         s->voice = NULL;
1256     }
1257
1258     if (s->dma_running) {
1259         if (s->freq) {
1260             struct audsettings as;
1261
1262             s->audio_free = 0;
1263
1264             as.freq = s->freq;
1265             as.nchannels = 1 << s->fmt_stereo;
1266             as.fmt = s->fmt;
1267             as.endianness = 0;
1268
1269             s->voice = AUD_open_out (
1270                 &s->card,
1271                 s->voice,
1272                 "sb16",
1273                 s,
1274                 SB_audio_callback,
1275                 &as
1276                 );
1277         }
1278
1279         control (s, 1);
1280         speaker (s, s->speaker);
1281     }
1282     return 0;
1283 }
1284
1285 static const VMStateDescription vmstate_sb16 = {
1286     .name = "sb16",
1287     .version_id = 1,
1288     .minimum_version_id = 1,
1289     .post_load = sb16_post_load,
1290     .fields = (VMStateField[]) {
1291         VMSTATE_UINT32 (irq, SB16State),
1292         VMSTATE_UINT32 (dma, SB16State),
1293         VMSTATE_UINT32 (hdma, SB16State),
1294         VMSTATE_UINT32 (port, SB16State),
1295         VMSTATE_UINT32 (ver, SB16State),
1296         VMSTATE_INT32 (in_index, SB16State),
1297         VMSTATE_INT32 (out_data_len, SB16State),
1298         VMSTATE_INT32 (fmt_stereo, SB16State),
1299         VMSTATE_INT32 (fmt_signed, SB16State),
1300         VMSTATE_INT32 (fmt_bits, SB16State),
1301         VMSTATE_UINT32 (fmt, SB16State),
1302         VMSTATE_INT32 (dma_auto, SB16State),
1303         VMSTATE_INT32 (block_size, SB16State),
1304         VMSTATE_INT32 (fifo, SB16State),
1305         VMSTATE_INT32 (freq, SB16State),
1306         VMSTATE_INT32 (time_const, SB16State),
1307         VMSTATE_INT32 (speaker, SB16State),
1308         VMSTATE_INT32 (needed_bytes, SB16State),
1309         VMSTATE_INT32 (cmd, SB16State),
1310         VMSTATE_INT32 (use_hdma, SB16State),
1311         VMSTATE_INT32 (highspeed, SB16State),
1312         VMSTATE_INT32 (can_write, SB16State),
1313         VMSTATE_INT32 (v2x6, SB16State),
1314
1315         VMSTATE_UINT8 (csp_param, SB16State),
1316         VMSTATE_UINT8 (csp_value, SB16State),
1317         VMSTATE_UINT8 (csp_mode, SB16State),
1318         VMSTATE_UINT8 (csp_param, SB16State),
1319         VMSTATE_BUFFER (csp_regs, SB16State),
1320         VMSTATE_UINT8 (csp_index, SB16State),
1321         VMSTATE_BUFFER (csp_reg83, SB16State),
1322         VMSTATE_INT32 (csp_reg83r, SB16State),
1323         VMSTATE_INT32 (csp_reg83w, SB16State),
1324
1325         VMSTATE_BUFFER (in2_data, SB16State),
1326         VMSTATE_BUFFER (out_data, SB16State),
1327         VMSTATE_UINT8 (test_reg, SB16State),
1328         VMSTATE_UINT8 (last_read_byte, SB16State),
1329
1330         VMSTATE_INT32 (nzero, SB16State),
1331         VMSTATE_INT32 (left_till_irq, SB16State),
1332         VMSTATE_INT32 (dma_running, SB16State),
1333         VMSTATE_INT32 (bytes_per_second, SB16State),
1334         VMSTATE_INT32 (align, SB16State),
1335
1336         VMSTATE_INT32 (mixer_nreg, SB16State),
1337         VMSTATE_BUFFER (mixer_regs, SB16State),
1338
1339         VMSTATE_END_OF_LIST ()
1340     }
1341 };
1342
1343 static const MemoryRegionPortio sb16_ioport_list[] = {
1344     {  4, 1, 1, .write = mixer_write_indexb },
1345     {  5, 1, 1, .read = mixer_read, .write = mixer_write_datab },
1346     {  6, 1, 1, .read = dsp_read, .write = dsp_write },
1347     { 10, 1, 1, .read = dsp_read },
1348     { 12, 1, 1, .write = dsp_write },
1349     { 12, 4, 1, .read = dsp_read },
1350     PORTIO_END_OF_LIST (),
1351 };
1352
1353
1354 static void sb16_initfn (Object *obj)
1355 {
1356     SB16State *s = SB16 (obj);
1357
1358     s->cmd = -1;
1359 }
1360
1361 static void sb16_realizefn (DeviceState *dev, Error **errp)
1362 {
1363     ISADevice *isadev = ISA_DEVICE (dev);
1364     SB16State *s = SB16 (dev);
1365     IsaDmaClass *k;
1366
1367     isa_init_irq (isadev, &s->pic, s->irq);
1368
1369     s->mixer_regs[0x80] = magic_of_irq (s->irq);
1370     s->mixer_regs[0x81] = (1 << s->dma) | (1 << s->hdma);
1371     s->mixer_regs[0x82] = 2 << 5;
1372
1373     s->csp_regs[5] = 1;
1374     s->csp_regs[9] = 0xf8;
1375
1376     reset_mixer (s);
1377     s->aux_ts = timer_new_ns(QEMU_CLOCK_VIRTUAL, aux_timer, s);
1378     if (!s->aux_ts) {
1379         dolog ("warning: Could not create auxiliary timer\n");
1380     }
1381
1382     isa_register_portio_list(isadev, &s->portio_list, s->port,
1383                              sb16_ioport_list, s, "sb16");
1384
1385     s->isa_hdma = isa_get_dma(isa_bus_from_device(isadev), s->hdma);
1386     k = ISADMA_GET_CLASS(s->isa_hdma);
1387     k->register_channel(s->isa_hdma, s->hdma, SB_read_DMA, s);
1388
1389     s->isa_dma = isa_get_dma(isa_bus_from_device(isadev), s->dma);
1390     k = ISADMA_GET_CLASS(s->isa_dma);
1391     k->register_channel(s->isa_dma, s->dma, SB_read_DMA, s);
1392
1393     s->can_write = 1;
1394
1395     AUD_register_card ("sb16", &s->card);
1396 }
1397
1398 static int SB16_init (ISABus *bus)
1399 {
1400     isa_create_simple (bus, TYPE_SB16);
1401     return 0;
1402 }
1403
1404 static Property sb16_properties[] = {
1405     DEFINE_PROP_UINT32 ("version", SB16State, ver,  0x0405), /* 4.5 */
1406     DEFINE_PROP_UINT32 ("iobase",  SB16State, port, 0x220),
1407     DEFINE_PROP_UINT32 ("irq",     SB16State, irq,  5),
1408     DEFINE_PROP_UINT32 ("dma",     SB16State, dma,  1),
1409     DEFINE_PROP_UINT32 ("dma16",   SB16State, hdma, 5),
1410     DEFINE_PROP_END_OF_LIST (),
1411 };
1412
1413 static void sb16_class_initfn (ObjectClass *klass, void *data)
1414 {
1415     DeviceClass *dc = DEVICE_CLASS (klass);
1416
1417     dc->realize = sb16_realizefn;
1418     set_bit(DEVICE_CATEGORY_SOUND, dc->categories);
1419     dc->desc = "Creative Sound Blaster 16";
1420     dc->vmsd = &vmstate_sb16;
1421     dc->props = sb16_properties;
1422 }
1423
1424 static const TypeInfo sb16_info = {
1425     .name          = TYPE_SB16,
1426     .parent        = TYPE_ISA_DEVICE,
1427     .instance_size = sizeof (SB16State),
1428     .instance_init = sb16_initfn,
1429     .class_init    = sb16_class_initfn,
1430 };
1431
1432 static void sb16_register_types (void)
1433 {
1434     type_register_static (&sb16_info);
1435     isa_register_soundhw("sb16", "Creative Sound Blaster 16", SB16_init);
1436 }
1437
1438 type_init (sb16_register_types)