sound/oss/opl3.c

   1 /*
   2  * sound/opl3.c
   3  *
   4  * A low level driver for Yamaha YM3812 and OPL-3 -chips
   5  *
   6  *
   7  * Copyright (C) by Hannu Savolainen 1993-1997
   8  *
   9  * OSS/Free for Linux is distributed under the GNU GENERAL PUBLIC LICENSE (GPL)
  10  * Version 2 (June 1991). See the "COPYING" file distributed with this software
  11  * for more info.
  12  *
  13  *
  14  * Changes
  15  *      Thomas Sailer           ioctl code reworked (vmalloc/vfree removed)
  16  *      Alan Cox                modularisation, fixed sound_mem allocs.
  17  *      Christoph Hellwig       Adapted to module_init/module_exit
  18  *      Arnaldo C. de Melo      get rid of check_region, use request_region for
  19  *                              OPL4, release it on exit, some cleanups.
  20  *
  21  * Status
  22  *      Believed to work. Badly needs rewriting a bit to support multiple
  23  *      OPL3 devices.
  24  */
  25
  26 #include <linux/init.h>
  27 #include <linux/module.h>
  28 #include <linux/delay.h>
  29
  30 /*
  31  * Major improvements to the FM handling 30AUG92 by Rob Hooft,
  32  * hooft@chem.ruu.nl
  33  */
  34
  35 #include "sound_config.h"
  36
  37 #include "opl3.h"
  38 #include "opl3_hw.h"
  39
  40 #define MAX_VOICE       18
  41 #define OFFS_4OP        11
  42
  43 struct voice_info
  44 {
  45         unsigned char   keyon_byte;
  46         long            bender;
  47         long            bender_range;
  48         unsigned long   orig_freq;
  49         unsigned long   current_freq;
  50         int             volume;
  51         int             mode;
  52         int             panning;        /* 0xffff means not set */
  53 };
  54
  55 typedef struct opl_devinfo
  56 {
  57         int             base;
  58         int             left_io, right_io;
  59         int             nr_voice;
  60         int             lv_map[MAX_VOICE];
  61
  62         struct voice_info voc[MAX_VOICE];
  63         struct voice_alloc_info *v_alloc;
  64         struct channel_info *chn_info;
  65
  66         struct sbi_instrument i_map[SBFM_MAXINSTR];
  67         struct sbi_instrument *act_i[MAX_VOICE];
  68
  69         struct synth_info fm_info;
  70
  71         int             busy;
  72         int             model;
  73         unsigned char   cmask;
  74
  75         int             is_opl4;
  76         int            *osp;
  77 } opl_devinfo;
  78
  79 static struct opl_devinfo *devc = NULL;
  80
  81 static int      detected_model;
  82
  83 static int      store_instr(int instr_no, struct sbi_instrument *instr);
  84 static void     freq_to_fnum(int freq, int *block, int *fnum);
  85 static void     opl3_command(int io_addr, unsigned int addr, unsigned int val);
  86 static int      opl3_kill_note(int dev, int voice, int note, int velocity);
  87
  88 static void enter_4op_mode(void)
  89 {
  90         int i;
  91         static int v4op[MAX_VOICE] = {
  92                 0, 1, 2, 9, 10, 11, 6, 7, 8, 15, 16, 17
  93         };
  94
  95         devc->cmask = 0x3f;     /* Connect all possible 4 OP voice operators */
  96         opl3_command(devc->right_io, CONNECTION_SELECT_REGISTER, 0x3f);
  97
  98         for (i = 0; i < 3; i++)
  99                 pv_map[i].voice_mode = 4;
 100         for (i = 3; i < 6; i++)
 101                 pv_map[i].voice_mode = 0;
 102
 103         for (i = 9; i < 12; i++)
 104                 pv_map[i].voice_mode = 4;
 105         for (i = 12; i < 15; i++)
 106                 pv_map[i].voice_mode = 0;
 107
 108         for (i = 0; i < 12; i++)
 109                 devc->lv_map[i] = v4op[i];
 110         devc->v_alloc->max_voice = devc->nr_voice = 12;
 111 }
 112
 113 static int opl3_ioctl(int dev, unsigned int cmd, void __user * arg)
 114 {
 115         struct sbi_instrument ins;
 116
 117         switch (cmd) {
 118                 case SNDCTL_FM_LOAD_INSTR:
 119                         printk(KERN_WARNING "Warning: Obsolete ioctl(SNDCTL_FM_LOAD_INSTR) used. Fix the program.\n");
 120                         if (copy_from_user(&ins, arg, sizeof(ins)))
 121                                 return -EFAULT;
 122                         if (ins.channel < 0 || ins.channel >= SBFM_MAXINSTR) {
 123                                 printk(KERN_WARNING "FM Error: Invalid instrument number %d\n", ins.channel);
 124                                 return -EINVAL;
 125                         }
 126                         return store_instr(ins.channel, &ins);
 127
 128                 case SNDCTL_SYNTH_INFO:
 129                         devc->fm_info.nr_voices = (devc->nr_voice == 12) ? 6 : devc->nr_voice;
 130                         if (copy_to_user(arg, &devc->fm_info, sizeof(devc->fm_info)))
 131                                 return -EFAULT;
 132                         return 0;
 133
 134                 case SNDCTL_SYNTH_MEMAVL:
 135                         return 0x7fffffff;
 136
 137                 case SNDCTL_FM_4OP_ENABLE:
 138                         if (devc->model == 2)
 139                                 enter_4op_mode();
 140                         return 0;
 141
 142                 default:
 143                         return -EINVAL;
 144         }
 145 }
 146
 147 int opl3_detect(int ioaddr, int *osp)
 148 {
 149         /*
 150          * This function returns 1 if the FM chip is present at the given I/O port
 151          * The detection algorithm plays with the timer built in the FM chip and
 152          * looks for a change in the status register.
 153          *
 154          * Note! The timers of the FM chip are not connected to AdLib (and compatible)
 155          * boards.
 156          *
 157          * Note2! The chip is initialized if detected.
 158          */
 159
 160         unsigned char stat1, signature;
 161         int i;
 162
 163         if (devc != NULL)
 164         {
 165                 printk(KERN_ERR "opl3: Only one OPL3 supported.\n");
 166                 return 0;
 167         }
 168
 169         devc = (struct opl_devinfo *)kmalloc(sizeof(*devc), GFP_KERNEL);
 170
 171         if (devc == NULL)
 172         {
 173                 printk(KERN_ERR "opl3: Can't allocate memory for the device control "
 174                         "structure \n ");
 175                 return 0;
 176         }
 177
 178         memset(devc, 0, sizeof(*devc));
 179         strcpy(devc->fm_info.name, "OPL2");
 180
 181         if (!request_region(ioaddr, 4, devc->fm_info.name)) {
 182                 printk(KERN_WARNING "opl3: I/O port 0x%x already in use\n", ioaddr);
 183                 goto cleanup_devc;
 184         }
 185
 186         devc->osp = osp;
 187         devc->base = ioaddr;
 188
 189         /* Reset timers 1 and 2 */
 190         opl3_command(ioaddr, TIMER_CONTROL_REGISTER, TIMER1_MASK | TIMER2_MASK);
 191
 192         /* Reset the IRQ of the FM chip */
 193         opl3_command(ioaddr, TIMER_CONTROL_REGISTER, IRQ_RESET);
 194
 195         signature = stat1 = inb(ioaddr);        /* Status register */
 196
 197         if (signature != 0x00 && signature != 0x06 && signature != 0x02 &&
 198                 signature != 0x0f)
 199         {
 200                 MDB(printk(KERN_INFO "OPL3 not detected %x\n", signature));
 201                 goto cleanup_region;
 202         }
 203
 204         if (signature == 0x06)          /* OPL2 */
 205         {
 206                 detected_model = 2;
 207         }
 208         else if (signature == 0x00 || signature == 0x0f)        /* OPL3 or OPL4 */
 209         {
 210                 unsigned char tmp;
 211
 212                 detected_model = 3;
 213
 214                 /*
 215                  * Detect availability of OPL4 (_experimental_). Works probably
 216                  * only after a cold boot. In addition the OPL4 port
 217                  * of the chip may not be connected to the PC bus at all.
 218                  */
 219
 220                 opl3_command(ioaddr + 2, OPL3_MODE_REGISTER, 0x00);
 221                 opl3_command(ioaddr + 2, OPL3_MODE_REGISTER, OPL3_ENABLE | OPL4_ENABLE);
 222
 223                 if ((tmp = inb(ioaddr)) == 0x02)        /* Have a OPL4 */
 224                 {
 225                         detected_model = 4;
 226                 }
 227
 228                 if (request_region(ioaddr - 8, 2, "OPL4"))      /* OPL4 port was free */
 229                 {
 230                         int tmp;
 231
 232                         outb((0x02), ioaddr - 8);       /* Select OPL4 ID register */
 233                         udelay(10);
 234                         tmp = inb(ioaddr - 7);          /* Read it */
 235                         udelay(10);
 236
 237                         if (tmp == 0x20)        /* OPL4 should return 0x20 here */
 238                         {
 239                                 detected_model = 4;
 240                                 outb((0xF8), ioaddr - 8);       /* Select OPL4 FM mixer control */
 241                                 udelay(10);
 242                                 outb((0x1B), ioaddr - 7);       /* Write value */
 243                                 udelay(10);
 244                         }
 245                         else
 246                         { /* release OPL4 port */
 247                                 release_region(ioaddr - 8, 2);
 248                                 detected_model = 3;
 249                         }
 250                 }
 251                 opl3_command(ioaddr + 2, OPL3_MODE_REGISTER, 0);
 252         }
 253         for (i = 0; i < 9; i++)
 254                 opl3_command(ioaddr, KEYON_BLOCK + i, 0);       /*
 255                                                                  * Note off
 256                                                                  */
 257
 258         opl3_command(ioaddr, TEST_REGISTER, ENABLE_WAVE_SELECT);
 259         opl3_command(ioaddr, PERCOSSION_REGISTER, 0x00);        /*
 260                                                                  * Melodic mode.
 261                                                                  */
 262         return 1;
 263 cleanup_region:
 264         release_region(ioaddr, 4);
 265 cleanup_devc:
 266         kfree(devc);
 267         devc = NULL;
 268         return 0;
 269 }
 270
 271 static int opl3_kill_note  (int devno, int voice, int note, int velocity)
 272 {
 273          struct physical_voice_info *map;
 274
 275          if (voice < 0 || voice >= devc->nr_voice)
 276                  return 0;
 277
 278          devc->v_alloc->map[voice] = 0;
 279
 280          map = &pv_map[devc->lv_map[voice]];
 281          DEB(printk("Kill note %d\n", voice));
 282
 283          if (map->voice_mode == 0)
 284                  return 0;
 285
 286          opl3_command(map->ioaddr, KEYON_BLOCK + map->voice_num, devc->voc[voice].keyon_byte & ~0x20);
 287          devc->voc[voice].keyon_byte = 0;
 288          devc->voc[voice].bender = 0;
 289          devc->voc[voice].volume = 64;
 290          devc->voc[voice].panning = 0xffff;     /* Not set */
 291          devc->voc[voice].bender_range = 200;
 292          devc->voc[voice].orig_freq = 0;
 293          devc->voc[voice].current_freq = 0;
 294          devc->voc[voice].mode = 0;
 295          return 0;
 296 }
 297
 298 #define HIHAT                   0
 299 #define CYMBAL                  1
 300 #define TOMTOM                  2
 301 #define SNARE                   3
 302 #define BDRUM                   4
 303 #define UNDEFINED               TOMTOM
 304 #define DEFAULT                 TOMTOM
 305
 306 static int store_instr(int instr_no, struct sbi_instrument *instr)
 307 {
 308         if (instr->key != FM_PATCH && (instr->key != OPL3_PATCH || devc->model != 2))
 309                 printk(KERN_WARNING "FM warning: Invalid patch format field (key) 0x%x\n", instr->key);
 310         memcpy((char *) &(devc->i_map[instr_no]), (char *) instr, sizeof(*instr));
 311         return 0;
 312 }
 313
 314 static int opl3_set_instr  (int dev, int voice, int instr_no)
 315 {
 316         if (voice < 0 || voice >= devc->nr_voice)
 317                 return 0;
 318         if (instr_no < 0 || instr_no >= SBFM_MAXINSTR)
 319                 instr_no = 0;   /* Acoustic piano (usually) */
 320
 321         devc->act_i[voice] = &devc->i_map[instr_no];
 322         return 0;
 323 }
 324
 325 /*
 326  * The next table looks magical, but it certainly is not. Its values have
 327  * been calculated as table[i]=8*log(i/64)/log(2) with an obvious exception
 328  * for i=0. This log-table converts a linear volume-scaling (0..127) to a
 329  * logarithmic scaling as present in the FM-synthesizer chips. so :    Volume
 330  * 64 =  0 db = relative volume  0 and:    Volume 32 = -6 db = relative
 331  * volume -8 it was implemented as a table because it is only 128 bytes and
 332  * it saves a lot of log() calculations. (RH)
 333  */
 334
 335 static char fm_volume_table[128] =
 336 {
 337         -64, -48, -40, -35, -32, -29, -27, -26,
 338         -24, -23, -21, -20, -19, -18, -18, -17,
 339         -16, -15, -15, -14, -13, -13, -12, -12,
 340         -11, -11, -10, -10, -10, -9, -9, -8,
 341         -8, -8, -7, -7, -7, -6, -6, -6,
 342         -5, -5, -5, -5, -4, -4, -4, -4,
 343         -3, -3, -3, -3, -2, -2, -2, -2,
 344         -2, -1, -1, -1, -1, 0, 0, 0,
 345         0, 0, 0, 1, 1, 1, 1, 1,
 346         1, 2, 2, 2, 2, 2, 2, 2,
 347         3, 3, 3, 3, 3, 3, 3, 4,
 348         4, 4, 4, 4, 4, 4, 4, 5,
 349         5, 5, 5, 5, 5, 5, 5, 5,
 350         6, 6, 6, 6, 6, 6, 6, 6,
 351         6, 7, 7, 7, 7, 7, 7, 7,
 352         7, 7, 7, 8, 8, 8, 8, 8
 353 };
 354
 355 static void calc_vol(unsigned char *regbyte, int volume, int main_vol)
 356 {
 357         int level = (~*regbyte & 0x3f);
 358
 359         if (main_vol > 127)
 360                 main_vol = 127;
 361         volume = (volume * main_vol) / 127;
 362
 363         if (level)
 364                 level += fm_volume_table[volume];
 365
 366         if (level > 0x3f)
 367                 level = 0x3f;
 368         if (level < 0)
 369                 level = 0;
 370
 371         *regbyte = (*regbyte & 0xc0) | (~level & 0x3f);
 372 }
 373
 374 static void set_voice_volume(int voice, int volume, int main_vol)
 375 {
 376         unsigned char vol1, vol2, vol3, vol4;
 377         struct sbi_instrument *instr;
 378         struct physical_voice_info *map;
 379
 380         if (voice < 0 || voice >= devc->nr_voice)
 381                 return;
 382
 383         map = &pv_map[devc->lv_map[voice]];
 384         instr = devc->act_i[voice];
 385
 386         if (!instr)
 387                 instr = &devc->i_map[0];
 388
 389         if (instr->channel < 0)
 390                 return;
 391
 392         if (devc->voc[voice].mode == 0)
 393                 return;
 394
 395         if (devc->voc[voice].mode == 2)
 396         {
 397                 vol1 = instr->operators[2];
 398                 vol2 = instr->operators[3];
 399                 if ((instr->operators[10] & 0x01))
 400                 {
 401                         calc_vol(&vol1, volume, main_vol);
 402                         calc_vol(&vol2, volume, main_vol);
 403                 }
 404                 else
 405                 {
 406                         calc_vol(&vol2, volume, main_vol);
 407                 }
 408                 opl3_command(map->ioaddr, KSL_LEVEL + map->op[0], vol1);
 409                 opl3_command(map->ioaddr, KSL_LEVEL + map->op[1], vol2);
 410         }
 411         else
 412         {       /*
 413                  * 4 OP voice
 414                  */
 415                 int connection;
 416
 417                 vol1 = instr->operators[2];
 418                 vol2 = instr->operators[3];
 419                 vol3 = instr->operators[OFFS_4OP + 2];
 420                 vol4 = instr->operators[OFFS_4OP + 3];
 421
 422                 /*
 423                  * The connection method for 4 OP devc->voc is defined by the rightmost
 424                  * bits at the offsets 10 and 10+OFFS_4OP
 425                  */
 426
 427                 connection = ((instr->operators[10] & 0x01) << 1) | (instr->operators[10 + OFFS_4OP] & 0x01);
 428
 429                 switch (connection)
 430                 {
 431                         case 0:
 432                                 calc_vol(&vol4, volume, main_vol);
 433                                 break;
 434
 435                         case 1:
 436                                 calc_vol(&vol2, volume, main_vol);
 437                                 calc_vol(&vol4, volume, main_vol);
 438                                 break;
 439
 440                         case 2:
 441                                 calc_vol(&vol1, volume, main_vol);
 442                                 calc_vol(&vol4, volume, main_vol);
 443                                 break;
 444
 445                         case 3:
 446                                 calc_vol(&vol1, volume, main_vol);
 447                                 calc_vol(&vol3, volume, main_vol);
 448                                 calc_vol(&vol4, volume, main_vol);
 449                                 break;
 450
 451                         default:
 452                                 ;
 453                 }
 454                 opl3_command(map->ioaddr, KSL_LEVEL + map->op[0], vol1);
 455                 opl3_command(map->ioaddr, KSL_LEVEL + map->op[1], vol2);
 456                 opl3_command(map->ioaddr, KSL_LEVEL + map->op[2], vol3);
 457                 opl3_command(map->ioaddr, KSL_LEVEL + map->op[3], vol4);
 458         }
 459 }
 460
 461 static int opl3_start_note (int dev, int voice, int note, int volume)
 462 {
 463         unsigned char data, fpc;
 464         int block, fnum, freq, voice_mode, pan;
 465         struct sbi_instrument *instr;
 466         struct physical_voice_info *map;
 467
 468         if (voice < 0 || voice >= devc->nr_voice)
 469                 return 0;
 470
 471         map = &pv_map[devc->lv_map[voice]];
 472         pan = devc->voc[voice].panning;
 473
 474         if (map->voice_mode == 0)
 475                 return 0;
 476
 477         if (note == 255)        /*
 478                                  * Just change the volume
 479                                  */
 480         {
 481                 set_voice_volume(voice, volume, devc->voc[voice].volume);
 482                 return 0;
 483         }
 484
 485         /*
 486          * Kill previous note before playing
 487          */
 488
 489         opl3_command(map->ioaddr, KSL_LEVEL + map->op[1], 0xff);        /*
 490                                                                          * Carrier
 491                                                                          * volume to
 492                                                                          * min
 493                                                                          */
 494         opl3_command(map->ioaddr, KSL_LEVEL + map->op[0], 0xff);        /*
 495                                                                          * Modulator
 496                                                                          * volume to
 497                                                                          */
 498
 499         if (map->voice_mode == 4)
 500         {
 501                 opl3_command(map->ioaddr, KSL_LEVEL + map->op[2], 0xff);
 502                 opl3_command(map->ioaddr, KSL_LEVEL + map->op[3], 0xff);
 503         }
 504
 505         opl3_command(map->ioaddr, KEYON_BLOCK + map->voice_num, 0x00);  /*
 506                                                                          * Note
 507                                                                          * off
 508                                                                          */
 509
 510         instr = devc->act_i[voice];
 511
 512         if (!instr)
 513                 instr = &devc->i_map[0];
 514
 515         if (instr->channel < 0)
 516         {
 517                 printk(KERN_WARNING "opl3: Initializing voice %d with undefined instrument\n", voice);
 518                 return 0;
 519         }
 520
 521         if (map->voice_mode == 2 && instr->key == OPL3_PATCH)
 522                 return 0;       /*
 523                                  * Cannot play
 524                                  */
 525
 526         voice_mode = map->voice_mode;
 527
 528         if (voice_mode == 4)
 529         {
 530                 int voice_shift;
 531
 532                 voice_shift = (map->ioaddr == devc->left_io) ? 0 : 3;
 533                 voice_shift += map->voice_num;
 534
 535                 if (instr->key != OPL3_PATCH)   /*
 536                                                  * Just 2 OP patch
 537                                                  */
 538                 {
 539                         voice_mode = 2;
 540                         devc->cmask &= ~(1 << voice_shift);
 541                 }
 542                 else
 543                 {
 544                         devc->cmask |= (1 << voice_shift);
 545                 }
 546
 547                 opl3_command(devc->right_io, CONNECTION_SELECT_REGISTER, devc->cmask);
 548         }
 549
 550         /*
 551          * Set Sound Characteristics
 552          */
 553
 554         opl3_command(map->ioaddr, AM_VIB + map->op[0], instr->operators[0]);
 555         opl3_command(map->ioaddr, AM_VIB + map->op[1], instr->operators[1]);
 556
 557         /*
 558          * Set Attack/Decay
 559          */
 560
 561         opl3_command(map->ioaddr, ATTACK_DECAY + map->op[0], instr->operators[4]);
 562         opl3_command(map->ioaddr, ATTACK_DECAY + map->op[1], instr->operators[5]);
 563
 564         /*
 565          * Set Sustain/Release
 566          */
 567
 568         opl3_command(map->ioaddr, SUSTAIN_RELEASE + map->op[0], instr->operators[6]);
 569         opl3_command(map->ioaddr, SUSTAIN_RELEASE + map->op[1], instr->operators[7]);
 570
 571         /*
 572          * Set Wave Select
 573          */
 574
 575         opl3_command(map->ioaddr, WAVE_SELECT + map->op[0], instr->operators[8]);
 576         opl3_command(map->ioaddr, WAVE_SELECT + map->op[1], instr->operators[9]);
 577
 578         /*
 579          * Set Feedback/Connection
 580          */
 581
 582         fpc = instr->operators[10];
 583
 584         if (pan != 0xffff)
 585         {
 586                 fpc &= ~STEREO_BITS;
 587                 if (pan < -64)
 588                         fpc |= VOICE_TO_LEFT;
 589                 else
 590                         if (pan > 64)
 591                                 fpc |= VOICE_TO_RIGHT;
 592                         else
 593                                 fpc |= (VOICE_TO_LEFT | VOICE_TO_RIGHT);
 594         }
 595
 596         if (!(fpc & 0x30))
 597                 fpc |= 0x30;    /*
 598                                  * Ensure that at least one chn is enabled
 599                                  */
 600         opl3_command(map->ioaddr, FEEDBACK_CONNECTION + map->voice_num, fpc);
 601
 602         /*
 603          * If the voice is a 4 OP one, initialize the operators 3 and 4 also
 604          */
 605
 606         if (voice_mode == 4)
 607         {
 608                 /*
 609                  * Set Sound Characteristics
 610                  */
 611
 612                 opl3_command(map->ioaddr, AM_VIB + map->op[2], instr->operators[OFFS_4OP + 0]);
 613                 opl3_command(map->ioaddr, AM_VIB + map->op[3], instr->operators[OFFS_4OP + 1]);
 614
 615                 /*
 616                  * Set Attack/Decay
 617                  */
 618
 619                 opl3_command(map->ioaddr, ATTACK_DECAY + map->op[2], instr->operators[OFFS_4OP + 4]);
 620                 opl3_command(map->ioaddr, ATTACK_DECAY + map->op[3], instr->operators[OFFS_4OP + 5]);
 621
 622                 /*
 623                  * Set Sustain/Release
 624                  */
 625
 626                 opl3_command(map->ioaddr, SUSTAIN_RELEASE + map->op[2], instr->operators[OFFS_4OP + 6]);
 627                 opl3_command(map->ioaddr, SUSTAIN_RELEASE + map->op[3], instr->operators[OFFS_4OP + 7]);
 628
 629                 /*
 630                  * Set Wave Select
 631                  */
 632
 633                 opl3_command(map->ioaddr, WAVE_SELECT + map->op[2], instr->operators[OFFS_4OP + 8]);
 634                 opl3_command(map->ioaddr, WAVE_SELECT + map->op[3], instr->operators[OFFS_4OP + 9]);
 635
 636                 /*
 637                  * Set Feedback/Connection
 638                  */
 639
 640                 fpc = instr->operators[OFFS_4OP + 10];
 641                 if (!(fpc & 0x30))
 642                          fpc |= 0x30;   /*
 643                                          * Ensure that at least one chn is enabled
 644                                          */
 645                 opl3_command(map->ioaddr, FEEDBACK_CONNECTION + map->voice_num + 3, fpc);
 646         }
 647
 648         devc->voc[voice].mode = voice_mode;
 649         set_voice_volume(voice, volume, devc->voc[voice].volume);
 650
 651         freq = devc->voc[voice].orig_freq = note_to_freq(note) / 1000;
 652
 653         /*
 654          * Since the pitch bender may have been set before playing the note, we
 655          * have to calculate the bending now.
 656          */
 657
 658         freq = compute_finetune(devc->voc[voice].orig_freq, devc->voc[voice].bender, devc->voc[voice].bender_range, 0);
 659         devc->voc[voice].current_freq = freq;
 660
 661         freq_to_fnum(freq, &block, &fnum);
 662
 663         /*
 664          * Play note
 665          */
 666
 667         data = fnum & 0xff;     /*
 668                                  * Least significant bits of fnumber
 669                                  */
 670         opl3_command(map->ioaddr, FNUM_LOW + map->voice_num, data);
 671
 672         data = 0x20 | ((block & 0x7) << 2) | ((fnum >> 8) & 0x3);
 673                  devc->voc[voice].keyon_byte = data;
 674         opl3_command(map->ioaddr, KEYON_BLOCK + map->voice_num, data);
 675         if (voice_mode == 4)
 676                 opl3_command(map->ioaddr, KEYON_BLOCK + map->voice_num + 3, data);
 677
 678         return 0;
 679 }
 680
 681 static void freq_to_fnum    (int freq, int *block, int *fnum)
 682 {
 683         int f, octave;
 684
 685         /*
 686          * Converts the note frequency to block and fnum values for the FM chip
 687          */
 688         /*
 689          * First try to compute the block -value (octave) where the note belongs
 690          */
 691
 692         f = freq;
 693
 694         octave = 5;
 695
 696         if (f == 0)
 697                 octave = 0;
 698         else if (f < 261)
 699         {
 700                 while (f < 261)
 701                 {
 702                         octave--;
 703                         f <<= 1;
 704                 }
 705         }
 706         else if (f > 493)
 707         {
 708                 while (f > 493)
 709                 {
 710                          octave++;
 711                          f >>= 1;
 712                 }
 713         }
 714
 715         if (octave > 7)
 716                 octave = 7;
 717
 718         *fnum = freq * (1 << (20 - octave)) / 49716;
 719         *block = octave;
 720 }
 721
 722 static void opl3_command    (int io_addr, unsigned int addr, unsigned int val)
 723 {
 724          int i;
 725
 726         /*
 727          * The original 2-OP synth requires a quite long delay after writing to a
 728          * register. The OPL-3 survives with just two INBs
 729          */
 730
 731         outb(((unsigned char) (addr & 0xff)), io_addr);
 732
 733         if (devc->model != 2)
 734                 udelay(10);
 735         else
 736                 for (i = 0; i < 2; i++)
 737                         inb(io_addr);
 738
 739         outb(((unsigned char) (val & 0xff)), io_addr + 1);
 740
 741         if (devc->model != 2)
 742                 udelay(30);
 743         else
 744                 for (i = 0; i < 2; i++)
 745                         inb(io_addr);
 746 }
 747
 748 static void opl3_reset(int devno)
 749 {
 750         int i;
 751
 752         for (i = 0; i < 18; i++)
 753                 devc->lv_map[i] = i;
 754
 755         for (i = 0; i < devc->nr_voice; i++)
 756         {
 757                 opl3_command(pv_map[devc->lv_map[i]].ioaddr,
 758                         KSL_LEVEL + pv_map[devc->lv_map[i]].op[0], 0xff);
 759
 760                 opl3_command(pv_map[devc->lv_map[i]].ioaddr,
 761                         KSL_LEVEL + pv_map[devc->lv_map[i]].op[1], 0xff);
 762
 763                 if (pv_map[devc->lv_map[i]].voice_mode == 4)
 764                 {
 765                         opl3_command(pv_map[devc->lv_map[i]].ioaddr,
 766                                 KSL_LEVEL + pv_map[devc->lv_map[i]].op[2], 0xff);
 767
 768                         opl3_command(pv_map[devc->lv_map[i]].ioaddr,
 769                                 KSL_LEVEL + pv_map[devc->lv_map[i]].op[3], 0xff);
 770                 }
 771
 772                 opl3_kill_note(devno, i, 0, 64);
 773         }
 774
 775         if (devc->model == 2)
 776         {
 777                 devc->v_alloc->max_voice = devc->nr_voice = 18;
 778
 779                 for (i = 0; i < 18; i++)
 780                         pv_map[i].voice_mode = 2;
 781
 782         }
 783 }
 784
 785 static int opl3_open(int dev, int mode)
 786 {
 787         int i;
 788
 789         if (devc->busy)
 790                 return -EBUSY;
 791         devc->busy = 1;
 792
 793         devc->v_alloc->max_voice = devc->nr_voice = (devc->model == 2) ? 18 : 9;
 794         devc->v_alloc->timestamp = 0;
 795
 796         for (i = 0; i < 18; i++)
 797         {
 798                 devc->v_alloc->map[i] = 0;
 799                 devc->v_alloc->alloc_times[i] = 0;
 800         }
 801
 802         devc->cmask = 0x00;     /*
 803                                  * Just 2 OP mode
 804                                  */
 805         if (devc->model == 2)
 806                 opl3_command(devc->right_io, CONNECTION_SELECT_REGISTER, devc->cmask);
 807         return 0;
 808 }
 809
 810 static void opl3_close(int dev)
 811 {
 812         devc->busy = 0;
 813         devc->v_alloc->max_voice = devc->nr_voice = (devc->model == 2) ? 18 : 9;
 814
 815         devc->fm_info.nr_drums = 0;
 816         devc->fm_info.perc_mode = 0;
 817
 818         opl3_reset(dev);
 819 }
 820
 821 static void opl3_hw_control(int dev, unsigned char *event)
 822 {
 823 }
 824
 825 static int opl3_load_patch(int dev, int format, const char __user *addr,
 826                 int offs, int count, int pmgr_flag)
 827 {
 828         struct sbi_instrument ins;
 829
 830         if (count <sizeof(ins))
 831         {
 832                 printk(KERN_WARNING "FM Error: Patch record too short\n");
 833                 return -EINVAL;
 834         }
 835
 836         /*
 837          * What the fuck is going on here?  We leave junk in the beginning
 838          * of ins and then check the field pretty close to that beginning?
 839          */
 840         if(copy_from_user(&((char *) &ins)[offs], addr + offs, sizeof(ins) - offs))
 841                 return -EFAULT;
 842
 843         if (ins.channel < 0 || ins.channel >= SBFM_MAXINSTR)
 844         {
 845                 printk(KERN_WARNING "FM Error: Invalid instrument number %d\n", ins.channel);
 846                 return -EINVAL;
 847         }
 848         ins.key = format;
 849
 850         return store_instr(ins.channel, &ins);
 851 }
 852
 853 static void opl3_panning(int dev, int voice, int value)
 854 {
 855         devc->voc[voice].panning = value;
 856 }
 857
 858 static void opl3_volume_method(int dev, int mode)
 859 {
 860 }
 861
 862 #define SET_VIBRATO(cell) { \
 863         tmp = instr->operators[(cell-1)+(((cell-1)/2)*OFFS_4OP)]; \
 864         if (pressure > 110) \
 865                 tmp |= 0x40;            /* Vibrato on */ \
 866         opl3_command (map->ioaddr, AM_VIB + map->op[cell-1], tmp);}
 867
 868 static void opl3_aftertouch(int dev, int voice, int pressure)
 869 {
 870         int tmp;
 871         struct sbi_instrument *instr;
 872         struct physical_voice_info *map;
 873
 874         if (voice < 0 || voice >= devc->nr_voice)
 875                 return;
 876
 877         map = &pv_map[devc->lv_map[voice]];
 878
 879         DEB(printk("Aftertouch %d\n", voice));
 880
 881         if (map->voice_mode == 0)
 882                 return;
 883
 884         /*
 885          * Adjust the amount of vibrato depending the pressure
 886          */
 887
 888         instr = devc->act_i[voice];
 889
 890         if (!instr)
 891                 instr = &devc->i_map[0];
 892
 893         if (devc->voc[voice].mode == 4)
 894         {
 895                 int connection = ((instr->operators[10] & 0x01) << 1) | (instr->operators[10 + OFFS_4OP] & 0x01);
 896
 897                 switch (connection)
 898                 {
 899                         case 0:
 900                                 SET_VIBRATO(4);
 901                                 break;
 902
 903                         case 1:
 904                                 SET_VIBRATO(2);
 905                                 SET_VIBRATO(4);
 906                                 break;
 907
 908                         case 2:
 909                                 SET_VIBRATO(1);
 910                                 SET_VIBRATO(4);
 911                                 break;
 912
 913                         case 3:
 914                                 SET_VIBRATO(1);
 915                                 SET_VIBRATO(3);
 916                                 SET_VIBRATO(4);
 917                                 break;
 918
 919                 }
 920                 /*
 921                  * Not implemented yet
 922                  */
 923         }
 924         else
 925         {
 926                 SET_VIBRATO(1);
 927
 928                 if ((instr->operators[10] & 0x01))      /*
 929                                                          * Additive synthesis
 930                                                          */
 931                         SET_VIBRATO(2);
 932         }
 933 }
 934
 935 #undef SET_VIBRATO
 936
 937 static void bend_pitch(int dev, int voice, int value)
 938 {
 939         unsigned char data;
 940         int block, fnum, freq;
 941         struct physical_voice_info *map;
 942
 943         map = &pv_map[devc->lv_map[voice]];
 944
 945         if (map->voice_mode == 0)
 946                 return;
 947
 948         devc->voc[voice].bender = value;
 949         if (!value)
 950                 return;
 951         if (!(devc->voc[voice].keyon_byte & 0x20))
 952                 return; /*
 953                          * Not keyed on
 954                          */
 955
 956         freq = compute_finetune(devc->voc[voice].orig_freq, devc->voc[voice].bender, devc->voc[voice].bender_range, 0);
 957         devc->voc[voice].current_freq = freq;
 958
 959         freq_to_fnum(freq, &block, &fnum);
 960
 961         data = fnum & 0xff;     /*
 962                                  * Least significant bits of fnumber
 963                                  */
 964         opl3_command(map->ioaddr, FNUM_LOW + map->voice_num, data);
 965
 966         data = 0x20 | ((block & 0x7) << 2) | ((fnum >> 8) & 0x3);
 967         devc->voc[voice].keyon_byte = data;
 968         opl3_command(map->ioaddr, KEYON_BLOCK + map->voice_num, data);
 969 }
 970
 971 static void opl3_controller (int dev, int voice, int ctrl_num, int value)
 972 {
 973         if (voice < 0 || voice >= devc->nr_voice)
 974                 return;
 975
 976         switch (ctrl_num)
 977         {
 978                 case CTRL_PITCH_BENDER:
 979                         bend_pitch(dev, voice, value);
 980                         break;
 981
 982                 case CTRL_PITCH_BENDER_RANGE:
 983                         devc->voc[voice].bender_range = value;
 984                         break;
 985
 986                 case CTL_MAIN_VOLUME:
 987                         devc->voc[voice].volume = value / 128;
 988                         break;
 989
 990                 case CTL_PAN:
 991                         devc->voc[voice].panning = (value * 2) - 128;
 992                         break;
 993         }
 994 }
 995
 996 static void opl3_bender(int dev, int voice, int value)
 997 {
 998         if (voice < 0 || voice >= devc->nr_voice)
 999                 return;
1000
1001         bend_pitch(dev, voice, value - 8192);
1002 }
1003
1004 static int opl3_alloc_voice(int dev, int chn, int note, struct voice_alloc_info *alloc)
1005 {
1006         int i, p, best, first, avail, best_time = 0x7fffffff;
1007         struct sbi_instrument *instr;
1008         int is4op;
1009         int instr_no;
1010
1011         if (chn < 0 || chn > 15)
1012                 instr_no = 0;
1013         else
1014                 instr_no = devc->chn_info[chn].pgm_num;
1015
1016         instr = &devc->i_map[instr_no];
1017         if (instr->channel < 0 ||       /* Instrument not loaded */
1018                 devc->nr_voice != 12)   /* Not in 4 OP mode */
1019                 is4op = 0;
1020         else if (devc->nr_voice == 12)  /* 4 OP mode */
1021                 is4op = (instr->key == OPL3_PATCH);
1022         else
1023                 is4op = 0;
1024
1025         if (is4op)
1026         {
1027                 first = p = 0;
1028                 avail = 6;
1029         }
1030         else
1031         {
1032                 if (devc->nr_voice == 12)       /* 4 OP mode. Use the '2 OP only' operators first */
1033                         first = p = 6;
1034                 else
1035                         first = p = 0;
1036                 avail = devc->nr_voice;
1037         }
1038
1039         /*
1040          *    Now try to find a free voice
1041          */
1042         best = first;
1043
1044         for (i = 0; i < avail; i++)
1045         {
1046                 if (alloc->map[p] == 0)
1047                 {
1048                         return p;
1049                 }
1050                 if (alloc->alloc_times[p] < best_time)          /* Find oldest playing note */
1051                 {
1052                         best_time = alloc->alloc_times[p];
1053                         best = p;
1054                 }
1055                 p = (p + 1) % avail;
1056         }
1057
1058         /*
1059          *    Insert some kind of priority mechanism here.
1060          */
1061
1062         if (best < 0)
1063                 best = 0;
1064         if (best > devc->nr_voice)
1065                 best -= devc->nr_voice;
1066
1067         return best;    /* All devc->voc in use. Select the first one. */
1068 }
1069
1070 static void opl3_setup_voice(int dev, int voice, int chn)
1071 {
1072         struct channel_info *info =
1073         &synth_devs[dev]->chn_info[chn];
1074
1075         opl3_set_instr(dev, voice, info->pgm_num);
1076
1077         devc->voc[voice].bender = 0;
1078         devc->voc[voice].bender_range = info->bender_range;
1079         devc->voc[voice].volume = info->controllers[CTL_MAIN_VOLUME];
1080         devc->voc[voice].panning = (info->controllers[CTL_PAN] * 2) - 128;
1081 }
1082
1083 static struct synth_operations opl3_operations =
1084 {
1085         .owner          = THIS_MODULE,
1086         .id             = "OPL",
1087         .info           = NULL,
1088         .midi_dev       = 0,
1089         .synth_type     = SYNTH_TYPE_FM,
1090         .synth_subtype  = FM_TYPE_ADLIB,
1091         .open           = opl3_open,
1092         .close          = opl3_close,
1093         .ioctl          = opl3_ioctl,
1094         .kill_note      = opl3_kill_note,
1095         .start_note     = opl3_start_note,
1096         .set_instr      = opl3_set_instr,
1097         .reset          = opl3_reset,
1098         .hw_control     = opl3_hw_control,
1099         .load_patch     = opl3_load_patch,
1100         .aftertouch     = opl3_aftertouch,
1101         .controller     = opl3_controller,
1102         .panning        = opl3_panning,
1103         .volume_method  = opl3_volume_method,
1104         .bender         = opl3_bender,
1105         .alloc_voice    = opl3_alloc_voice,
1106         .setup_voice    = opl3_setup_voice
1107 };
1108
1109 int opl3_init(int ioaddr, int *osp, struct module *owner)
1110 {
1111         int i;
1112         int me;
1113
1114         if (devc == NULL)
1115         {
1116                 printk(KERN_ERR "opl3: Device control structure not initialized.\n");
1117                 return -1;
1118         }
1119
1120         if ((me = sound_alloc_synthdev()) == -1)
1121         {
1122                 printk(KERN_WARNING "opl3: Too many synthesizers\n");
1123                 return -1;
1124         }
1125
1126         devc->nr_voice = 9;
1127
1128         devc->fm_info.device = 0;
1129         devc->fm_info.synth_type = SYNTH_TYPE_FM;
1130         devc->fm_info.synth_subtype = FM_TYPE_ADLIB;
1131         devc->fm_info.perc_mode = 0;
1132         devc->fm_info.nr_voices = 9;
1133         devc->fm_info.nr_drums = 0;
1134         devc->fm_info.instr_bank_size = SBFM_MAXINSTR;
1135         devc->fm_info.capabilities = 0;
1136         devc->left_io = ioaddr;
1137         devc->right_io = ioaddr + 2;
1138
1139         if (detected_model <= 2)
1140                 devc->model = 1;
1141         else
1142         {
1143                 devc->model = 2;
1144                 if (detected_model == 4)
1145                         devc->is_opl4 = 1;
1146         }
1147
1148         opl3_operations.info = &devc->fm_info;
1149
1150         synth_devs[me] = &opl3_operations;
1151
1152         if (owner)
1153                 synth_devs[me]->owner = owner;
1154
1155         sequencer_init();
1156         devc->v_alloc = &opl3_operations.alloc;
1157         devc->chn_info = &opl3_operations.chn_info[0];
1158
1159         if (devc->model == 2)
1160         {
1161                 if (devc->is_opl4)
1162                         strcpy(devc->fm_info.name, "Yamaha OPL4/OPL3 FM");
1163                 else
1164                         strcpy(devc->fm_info.name, "Yamaha OPL3");
1165
1166                 devc->v_alloc->max_voice = devc->nr_voice = 18;
1167                 devc->fm_info.nr_drums = 0;
1168                 devc->fm_info.synth_subtype = FM_TYPE_OPL3;
1169                 devc->fm_info.capabilities |= SYNTH_CAP_OPL3;
1170
1171                 for (i = 0; i < 18; i++)
1172                 {
1173                         if (pv_map[i].ioaddr == USE_LEFT)
1174                                 pv_map[i].ioaddr = devc->left_io;
1175                         else
1176                                 pv_map[i].ioaddr = devc->right_io;
1177                 }
1178                 opl3_command(devc->right_io, OPL3_MODE_REGISTER, OPL3_ENABLE);
1179                 opl3_command(devc->right_io, CONNECTION_SELECT_REGISTER, 0x00);
1180         }
1181         else
1182         {
1183                 strcpy(devc->fm_info.name, "Yamaha OPL2");
1184                 devc->v_alloc->max_voice = devc->nr_voice = 9;
1185                 devc->fm_info.nr_drums = 0;
1186
1187                 for (i = 0; i < 18; i++)
1188                         pv_map[i].ioaddr = devc->left_io;
1189         };
1190         conf_printf2(devc->fm_info.name, ioaddr, 0, -1, -1);
1191
1192         for (i = 0; i < SBFM_MAXINSTR; i++)
1193                 devc->i_map[i].channel = -1;
1194
1195         return me;
1196 }
1197
1198 EXPORT_SYMBOL(opl3_init);
1199 EXPORT_SYMBOL(opl3_detect);
1200
1201 static int me;
1202
1203 static int io = -1;
1204
1205 module_param(io, int, 0);
1206
1207 static int __init init_opl3 (void)
1208 {
1209         printk(KERN_INFO "YM3812 and OPL-3 driver Copyright (C) by Hannu Savolainen, Rob Hooft 1993-1996\n");
1210
1211         if (io != -1)   /* User loading pure OPL3 module */
1212         {
1213                 if (!opl3_detect(io, NULL))
1214                 {
1215                         return -ENODEV;
1216                 }
1217
1218                 me = opl3_init(io, NULL, THIS_MODULE);
1219         }
1220
1221         return 0;
1222 }
1223
1224 static void __exit cleanup_opl3(void)
1225 {
1226         if (devc && io != -1)
1227         {
1228                 if (devc->base) {
1229                         release_region(devc->base,4);
1230                         if (devc->is_opl4)
1231                                 release_region(devc->base - 8, 2);
1232                 }
1233                 kfree(devc);
1234                 devc = NULL;
1235                 sound_unload_synthdev(me);
1236         }
1237 }
1238
1239 module_init(init_opl3);
1240 module_exit(cleanup_opl3);
1241
1242 #ifndef MODULE
1243 static int __init setup_opl3(char *str)
1244 {
1245         /* io  */
1246         int ints[2];
1247
1248         str = get_options(str, ARRAY_SIZE(ints), ints);
1249
1250         io = ints[1];
1251
1252         return 1;
1253 }
1254
1255 __setup("opl3=", setup_opl3);
1256 #endif
1257 MODULE_LICENSE("GPL");