release/src-rt-6.x/linux/linux-2.6/sound/drivers/opl3/opl3_lib.c

   1 /*
   2  *  Copyright (c) by Jaroslav Kysela <perex@suse.cz>,
   3  *                   Hannu Savolainen 1993-1996,
   4  *                   Rob Hooft
   5  *
   6  *  Routines for control of AdLib FM cards (OPL2/OPL3/OPL4 chips)
   7  *
   8  *  Most if code is ported from OSS/Lite.
   9  *
  10  *   This program is free software; you can redistribute it and/or modify
  11  *   it under the terms of the GNU General Public License as published by
  12  *   the Free Software Foundation; either version 2 of the License, or
  13  *   (at your option) any later version.
  14  *
  15  *   This program is distributed in the hope that it will be useful,
  16  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  *   GNU General Public License for more details.
  19  *
  20  *   You should have received a copy of the GNU General Public License
  21  *   along with this program; if not, write to the Free Software
  22  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  23  *
  24  */
  25
  26 #include <sound/opl3.h>
  27 #include <asm/io.h>
  28 #include <linux/delay.h>
  29 #include <linux/init.h>
  30 #include <linux/slab.h>
  31 #include <linux/ioport.h>
  32 #include <sound/minors.h>
  33
  34 MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>, Hannu Savolainen 1993-1996, Rob Hooft");
  35 MODULE_DESCRIPTION("Routines for control of AdLib FM cards (OPL2/OPL3/OPL4 chips)");
  36 MODULE_LICENSE("GPL");
  37
  38 extern char snd_opl3_regmap[MAX_OPL2_VOICES][4];
  39
  40 static void snd_opl2_command(struct snd_opl3 * opl3, unsigned short cmd, unsigned char val)
  41 {
  42         unsigned long flags;
  43         unsigned long port;
  44
  45         /*
  46          * The original 2-OP synth requires a quite long delay
  47          * after writing to a register.
  48          */
  49
  50         port = (cmd & OPL3_RIGHT) ? opl3->r_port : opl3->l_port;
  51
  52         spin_lock_irqsave(&opl3->reg_lock, flags);
  53
  54         outb((unsigned char) cmd, port);
  55         udelay(10);
  56
  57         outb((unsigned char) val, port + 1);
  58         udelay(30);
  59
  60         spin_unlock_irqrestore(&opl3->reg_lock, flags);
  61 }
  62
  63 static void snd_opl3_command(struct snd_opl3 * opl3, unsigned short cmd, unsigned char val)
  64 {
  65         unsigned long flags;
  66         unsigned long port;
  67
  68         /*
  69          * The OPL-3 survives with just two INBs
  70          * after writing to a register.
  71          */
  72
  73         port = (cmd & OPL3_RIGHT) ? opl3->r_port : opl3->l_port;
  74
  75         spin_lock_irqsave(&opl3->reg_lock, flags);
  76
  77         outb((unsigned char) cmd, port);
  78         inb(opl3->l_port);
  79         inb(opl3->l_port);
  80
  81         outb((unsigned char) val, port + 1);
  82         inb(opl3->l_port);
  83         inb(opl3->l_port);
  84
  85         spin_unlock_irqrestore(&opl3->reg_lock, flags);
  86 }
  87
  88 static int snd_opl3_detect(struct snd_opl3 * opl3)
  89 {
  90         /*
  91          * This function returns 1 if the FM chip is present at the given I/O port
  92          * The detection algorithm plays with the timer built in the FM chip and
  93          * looks for a change in the status register.
  94          *
  95          * Note! The timers of the FM chip are not connected to AdLib (and compatible)
  96          * boards.
  97          *
  98          * Note2! The chip is initialized if detected.
  99          */
 100
 101         unsigned char stat1, stat2, signature;
 102
 103         /* Reset timers 1 and 2 */
 104         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_TIMER1_MASK | OPL3_TIMER2_MASK);
 105         /* Reset the IRQ of the FM chip */
 106         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_IRQ_RESET);
 107         signature = stat1 = inb(opl3->l_port);  /* Status register */
 108         if ((stat1 & 0xe0) != 0x00) {   /* Should be 0x00 */
 109                 snd_printd("OPL3: stat1 = 0x%x\n", stat1);
 110                 return -ENODEV;
 111         }
 112         /* Set timer1 to 0xff */
 113         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER1, 0xff);
 114         /* Unmask and start timer 1 */
 115         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_TIMER2_MASK | OPL3_TIMER1_START);
 116         /* Now we have to delay at least 80us */
 117         udelay(200);
 118         /* Read status after timers have expired */
 119         stat2 = inb(opl3->l_port);
 120         /* Stop the timers */
 121         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_TIMER1_MASK | OPL3_TIMER2_MASK);
 122         /* Reset the IRQ of the FM chip */
 123         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, OPL3_IRQ_RESET);
 124         if ((stat2 & 0xe0) != 0xc0) {   /* There is no YM3812 */
 125                 snd_printd("OPL3: stat2 = 0x%x\n", stat2);
 126                 return -ENODEV;
 127         }
 128
 129         /* If the toplevel code knows exactly the type of chip, don't try
 130            to detect it. */
 131         if (opl3->hardware != OPL3_HW_AUTO)
 132                 return 0;
 133
 134         /* There is a FM chip on this address. Detect the type (OPL2 to OPL4) */
 135         if (signature == 0x06) {        /* OPL2 */
 136                 opl3->hardware = OPL3_HW_OPL2;
 137         } else {
 138                 /*
 139                  * If we had an OPL4 chip, opl3->hardware would have been set
 140                  * by the OPL4 driver; so we can assume OPL3 here.
 141                  */
 142                 snd_assert(opl3->r_port != 0, return -ENODEV);
 143                 opl3->hardware = OPL3_HW_OPL3;
 144         }
 145         return 0;
 146 }
 147
 148 /*
 149  *  AdLib timers
 150  */
 151
 152 /*
 153  *  Timer 1 - 80us
 154  */
 155
 156 static int snd_opl3_timer1_start(struct snd_timer * timer)
 157 {
 158         unsigned long flags;
 159         unsigned char tmp;
 160         unsigned int ticks;
 161         struct snd_opl3 *opl3;
 162
 163         opl3 = snd_timer_chip(timer);
 164         spin_lock_irqsave(&opl3->timer_lock, flags);
 165         ticks = timer->sticks;
 166         tmp = (opl3->timer_enable | OPL3_TIMER1_START) & ~OPL3_TIMER1_MASK;
 167         opl3->timer_enable = tmp;
 168         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER1, 256 - ticks);  /* timer 1 count */
 169         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, tmp);   /* enable timer 1 IRQ */
 170         spin_unlock_irqrestore(&opl3->timer_lock, flags);
 171         return 0;
 172 }
 173
 174 static int snd_opl3_timer1_stop(struct snd_timer * timer)
 175 {
 176         unsigned long flags;
 177         unsigned char tmp;
 178         struct snd_opl3 *opl3;
 179
 180         opl3 = snd_timer_chip(timer);
 181         spin_lock_irqsave(&opl3->timer_lock, flags);
 182         tmp = (opl3->timer_enable | OPL3_TIMER1_MASK) & ~OPL3_TIMER1_START;
 183         opl3->timer_enable = tmp;
 184         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, tmp);   /* disable timer #1 */
 185         spin_unlock_irqrestore(&opl3->timer_lock, flags);
 186         return 0;
 187 }
 188
 189 /*
 190  *  Timer 2 - 320us
 191  */
 192
 193 static int snd_opl3_timer2_start(struct snd_timer * timer)
 194 {
 195         unsigned long flags;
 196         unsigned char tmp;
 197         unsigned int ticks;
 198         struct snd_opl3 *opl3;
 199
 200         opl3 = snd_timer_chip(timer);
 201         spin_lock_irqsave(&opl3->timer_lock, flags);
 202         ticks = timer->sticks;
 203         tmp = (opl3->timer_enable | OPL3_TIMER2_START) & ~OPL3_TIMER2_MASK;
 204         opl3->timer_enable = tmp;
 205         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER2, 256 - ticks);  /* timer 1 count */
 206         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, tmp);   /* enable timer 1 IRQ */
 207         spin_unlock_irqrestore(&opl3->timer_lock, flags);
 208         return 0;
 209 }
 210
 211 static int snd_opl3_timer2_stop(struct snd_timer * timer)
 212 {
 213         unsigned long flags;
 214         unsigned char tmp;
 215         struct snd_opl3 *opl3;
 216
 217         opl3 = snd_timer_chip(timer);
 218         spin_lock_irqsave(&opl3->timer_lock, flags);
 219         tmp = (opl3->timer_enable | OPL3_TIMER2_MASK) & ~OPL3_TIMER2_START;
 220         opl3->timer_enable = tmp;
 221         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TIMER_CONTROL, tmp);   /* disable timer #1 */
 222         spin_unlock_irqrestore(&opl3->timer_lock, flags);
 223         return 0;
 224 }
 225
 226 /*
 227
 228  */
 229
 230 static struct snd_timer_hardware snd_opl3_timer1 =
 231 {
 232         .flags =        SNDRV_TIMER_HW_STOP,
 233         .resolution =   80000,
 234         .ticks =        256,
 235         .start =        snd_opl3_timer1_start,
 236         .stop =         snd_opl3_timer1_stop,
 237 };
 238
 239 static struct snd_timer_hardware snd_opl3_timer2 =
 240 {
 241         .flags =        SNDRV_TIMER_HW_STOP,
 242         .resolution =   320000,
 243         .ticks =        256,
 244         .start =        snd_opl3_timer2_start,
 245         .stop =         snd_opl3_timer2_stop,
 246 };
 247
 248 static int snd_opl3_timer1_init(struct snd_opl3 * opl3, int timer_no)
 249 {
 250         struct snd_timer *timer = NULL;
 251         struct snd_timer_id tid;
 252         int err;
 253
 254         tid.dev_class = SNDRV_TIMER_CLASS_CARD;
 255         tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
 256         tid.card = opl3->card->number;
 257         tid.device = timer_no;
 258         tid.subdevice = 0;
 259         if ((err = snd_timer_new(opl3->card, "AdLib timer #1", &tid, &timer)) >= 0) {
 260                 strcpy(timer->name, "AdLib timer #1");
 261                 timer->private_data = opl3;
 262                 timer->hw = snd_opl3_timer1;
 263         }
 264         opl3->timer1 = timer;
 265         return err;
 266 }
 267
 268 static int snd_opl3_timer2_init(struct snd_opl3 * opl3, int timer_no)
 269 {
 270         struct snd_timer *timer = NULL;
 271         struct snd_timer_id tid;
 272         int err;
 273
 274         tid.dev_class = SNDRV_TIMER_CLASS_CARD;
 275         tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
 276         tid.card = opl3->card->number;
 277         tid.device = timer_no;
 278         tid.subdevice = 0;
 279         if ((err = snd_timer_new(opl3->card, "AdLib timer #2", &tid, &timer)) >= 0) {
 280                 strcpy(timer->name, "AdLib timer #2");
 281                 timer->private_data = opl3;
 282                 timer->hw = snd_opl3_timer2;
 283         }
 284         opl3->timer2 = timer;
 285         return err;
 286 }
 287
 288 /*
 289
 290  */
 291
 292 void snd_opl3_interrupt(struct snd_hwdep * hw)
 293 {
 294         unsigned char status;
 295         struct snd_opl3 *opl3;
 296         struct snd_timer *timer;
 297
 298         if (hw == NULL)
 299                 return;
 300
 301         opl3 = hw->private_data;
 302         status = inb(opl3->l_port);
 303 #if 0
 304         snd_printk("AdLib IRQ status = 0x%x\n", status);
 305 #endif
 306         if (!(status & 0x80))
 307                 return;
 308
 309         if (status & 0x40) {
 310                 timer = opl3->timer1;
 311                 snd_timer_interrupt(timer, timer->sticks);
 312         }
 313         if (status & 0x20) {
 314                 timer = opl3->timer2;
 315                 snd_timer_interrupt(timer, timer->sticks);
 316         }
 317 }
 318
 319 EXPORT_SYMBOL(snd_opl3_interrupt);
 320
 321 /*
 322
 323  */
 324
 325 static int snd_opl3_free(struct snd_opl3 *opl3)
 326 {
 327         snd_assert(opl3 != NULL, return -ENXIO);
 328         if (opl3->private_free)
 329                 opl3->private_free(opl3);
 330         release_and_free_resource(opl3->res_l_port);
 331         release_and_free_resource(opl3->res_r_port);
 332         kfree(opl3);
 333         return 0;
 334 }
 335
 336 static int snd_opl3_dev_free(struct snd_device *device)
 337 {
 338         struct snd_opl3 *opl3 = device->device_data;
 339         return snd_opl3_free(opl3);
 340 }
 341
 342 int snd_opl3_new(struct snd_card *card,
 343                  unsigned short hardware,
 344                  struct snd_opl3 **ropl3)
 345 {
 346         static struct snd_device_ops ops = {
 347                 .dev_free = snd_opl3_dev_free,
 348         };
 349         struct snd_opl3 *opl3;
 350         int err;
 351
 352         *ropl3 = NULL;
 353         opl3 = kzalloc(sizeof(*opl3), GFP_KERNEL);
 354         if (opl3 == NULL) {
 355                 snd_printk(KERN_ERR "opl3: cannot allocate\n");
 356                 return -ENOMEM;
 357         }
 358
 359         opl3->card = card;
 360         opl3->hardware = hardware;
 361         spin_lock_init(&opl3->reg_lock);
 362         spin_lock_init(&opl3->timer_lock);
 363         mutex_init(&opl3->access_mutex);
 364
 365         if ((err = snd_device_new(card, SNDRV_DEV_CODEC, opl3, &ops)) < 0) {
 366                 snd_opl3_free(opl3);
 367                 return err;
 368         }
 369
 370         *ropl3 = opl3;
 371         return 0;
 372 }
 373
 374 EXPORT_SYMBOL(snd_opl3_new);
 375
 376 int snd_opl3_init(struct snd_opl3 *opl3)
 377 {
 378         if (! opl3->command) {
 379                 printk(KERN_ERR "snd_opl3_init: command not defined!\n");
 380                 return -EINVAL;
 381         }
 382
 383         opl3->command(opl3, OPL3_LEFT | OPL3_REG_TEST, OPL3_ENABLE_WAVE_SELECT);
 384         /* Melodic mode */
 385         opl3->command(opl3, OPL3_LEFT | OPL3_REG_PERCUSSION, 0x00);
 386
 387         switch (opl3->hardware & OPL3_HW_MASK) {
 388         case OPL3_HW_OPL2:
 389                 opl3->max_voices = MAX_OPL2_VOICES;
 390                 break;
 391         case OPL3_HW_OPL3:
 392         case OPL3_HW_OPL4:
 393                 opl3->max_voices = MAX_OPL3_VOICES;
 394                 /* Enter OPL3 mode */
 395                 opl3->command(opl3, OPL3_RIGHT | OPL3_REG_MODE, OPL3_OPL3_ENABLE);
 396         }
 397         return 0;
 398 }
 399
 400 EXPORT_SYMBOL(snd_opl3_init);
 401
 402 int snd_opl3_create(struct snd_card *card,
 403                     unsigned long l_port,
 404                     unsigned long r_port,
 405                     unsigned short hardware,
 406                     int integrated,
 407                     struct snd_opl3 ** ropl3)
 408 {
 409         struct snd_opl3 *opl3;
 410         int err;
 411
 412         *ropl3 = NULL;
 413         if ((err = snd_opl3_new(card, hardware, &opl3)) < 0)
 414                 return err;
 415         if (! integrated) {
 416                 if ((opl3->res_l_port = request_region(l_port, 2, "OPL2/3 (left)")) == NULL) {
 417                         snd_printk(KERN_ERR "opl3: can't grab left port 0x%lx\n", l_port);
 418                         snd_device_free(card, opl3);
 419                         return -EBUSY;
 420                 }
 421                 if (r_port != 0 &&
 422                     (opl3->res_r_port = request_region(r_port, 2, "OPL2/3 (right)")) == NULL) {
 423                         snd_printk(KERN_ERR "opl3: can't grab right port 0x%lx\n", r_port);
 424                         snd_device_free(card, opl3);
 425                         return -EBUSY;
 426                 }
 427         }
 428         opl3->l_port = l_port;
 429         opl3->r_port = r_port;
 430
 431         switch (opl3->hardware) {
 432         /* some hardware doesn't support timers */
 433         case OPL3_HW_OPL3_SV:
 434         case OPL3_HW_OPL3_CS:
 435         case OPL3_HW_OPL3_FM801:
 436                 opl3->command = &snd_opl3_command;
 437                 break;
 438         default:
 439                 opl3->command = &snd_opl2_command;
 440                 if ((err = snd_opl3_detect(opl3)) < 0) {
 441                         snd_printd("OPL2/3 chip not detected at 0x%lx/0x%lx\n",
 442                                    opl3->l_port, opl3->r_port);
 443                         snd_device_free(card, opl3);
 444                         return err;
 445                 }
 446                 /* detect routine returns correct hardware type */
 447                 switch (opl3->hardware & OPL3_HW_MASK) {
 448                 case OPL3_HW_OPL3:
 449                 case OPL3_HW_OPL4:
 450                         opl3->command = &snd_opl3_command;
 451                 }
 452         }
 453
 454         snd_opl3_init(opl3);
 455
 456         *ropl3 = opl3;
 457         return 0;
 458 }
 459
 460 EXPORT_SYMBOL(snd_opl3_create);
 461
 462 int snd_opl3_timer_new(struct snd_opl3 * opl3, int timer1_dev, int timer2_dev)
 463 {
 464         int err;
 465
 466         if (timer1_dev >= 0)
 467                 if ((err = snd_opl3_timer1_init(opl3, timer1_dev)) < 0)
 468                         return err;
 469         if (timer2_dev >= 0) {
 470                 if ((err = snd_opl3_timer2_init(opl3, timer2_dev)) < 0) {
 471                         snd_device_free(opl3->card, opl3->timer1);
 472                         opl3->timer1 = NULL;
 473                         return err;
 474                 }
 475         }
 476         return 0;
 477 }
 478
 479 EXPORT_SYMBOL(snd_opl3_timer_new);
 480
 481 int snd_opl3_hwdep_new(struct snd_opl3 * opl3,
 482                        int device, int seq_device,
 483                        struct snd_hwdep ** rhwdep)
 484 {
 485         struct snd_hwdep *hw;
 486         struct snd_card *card = opl3->card;
 487         int err;
 488
 489         if (rhwdep)
 490                 *rhwdep = NULL;
 491
 492         /* create hardware dependent device (direct FM) */
 493
 494         if ((err = snd_hwdep_new(card, "OPL2/OPL3", device, &hw)) < 0) {
 495                 snd_device_free(card, opl3);
 496                 return err;
 497         }
 498         hw->private_data = opl3;
 499 #ifdef CONFIG_SND_OSSEMUL
 500         if (device == 0) {
 501                 hw->oss_type = SNDRV_OSS_DEVICE_TYPE_DMFM;
 502                 sprintf(hw->oss_dev, "dmfm%i", card->number);
 503         }
 504 #endif
 505         strcpy(hw->name, hw->id);
 506         switch (opl3->hardware & OPL3_HW_MASK) {
 507         case OPL3_HW_OPL2:
 508                 strcpy(hw->name, "OPL2 FM");
 509                 hw->iface = SNDRV_HWDEP_IFACE_OPL2;
 510                 break;
 511         case OPL3_HW_OPL3:
 512                 strcpy(hw->name, "OPL3 FM");
 513                 hw->iface = SNDRV_HWDEP_IFACE_OPL3;
 514                 break;
 515         case OPL3_HW_OPL4:
 516                 strcpy(hw->name, "OPL4 FM");
 517                 hw->iface = SNDRV_HWDEP_IFACE_OPL4;
 518                 break;
 519         }
 520
 521         /* operators - only ioctl */
 522         hw->ops.open = snd_opl3_open;
 523         hw->ops.ioctl = snd_opl3_ioctl;
 524         hw->ops.release = snd_opl3_release;
 525
 526         opl3->seq_dev_num = seq_device;
 527 #if defined(CONFIG_SND_SEQUENCER) || (defined(MODULE) && defined(CONFIG_SND_SEQUENCER_MODULE))
 528         if (snd_seq_device_new(card, seq_device, SNDRV_SEQ_DEV_ID_OPL3,
 529                                sizeof(struct snd_opl3 *), &opl3->seq_dev) >= 0) {
 530                 strcpy(opl3->seq_dev->name, hw->name);
 531                 *(struct snd_opl3 **)SNDRV_SEQ_DEVICE_ARGPTR(opl3->seq_dev) = opl3;
 532         }
 533 #endif
 534         if (rhwdep)
 535                 *rhwdep = hw;
 536         return 0;
 537 }
 538
 539 EXPORT_SYMBOL(snd_opl3_hwdep_new);
 540
 541 /*
 542  *  INIT part
 543  */
 544
 545 static int __init alsa_opl3_init(void)
 546 {
 547         return 0;
 548 }
 549
 550 static void __exit alsa_opl3_exit(void)
 551 {
 552 }
 553
 554 module_init(alsa_opl3_init)
 555 module_exit(alsa_opl3_exit)