sound/oss/mpu401.c

   1 /*
   2  * sound/mpu401.c
   3  *
   4  * The low level driver for Roland MPU-401 compatible Midi cards.
   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  * Thomas Sailer        ioctl code reworked (vmalloc/vfree removed)
  15  * Alan Cox             modularisation, use normal request_irq, use dev_id
  16  * Bartlomiej Zolnierkiewicz    removed some __init to allow using many drivers
  17  * Chris Rankin         Update the module-usage counter for the coprocessor
  18  * Zwane Mwaikambo      Changed attach/unload resource freeing
  19  */
  20
  21 #include <linux/module.h>
  22 #include <linux/init.h>
  23 #include <linux/interrupt.h>
  24 #include <linux/spinlock.h>
  25 #define USE_SEQ_MACROS
  26 #define USE_SIMPLE_MACROS
  27
  28 #include "sound_config.h"
  29
  30 #include "coproc.h"
  31 #include "mpu401.h"
  32
  33 static int      timer_mode = TMR_INTERNAL, timer_caps = TMR_INTERNAL;
  34
  35 struct mpu_config
  36 {
  37         int             base;   /*
  38                                  * I/O base
  39                                  */
  40         int             irq;
  41         int             opened; /*
  42                                  * Open mode
  43                                  */
  44         int             devno;
  45         int             synthno;
  46         int             uart_mode;
  47         int             initialized;
  48         int             mode;
  49 #define MODE_MIDI       1
  50 #define MODE_SYNTH      2
  51         unsigned char   version, revision;
  52         unsigned int    capabilities;
  53 #define MPU_CAP_INTLG   0x10000000
  54 #define MPU_CAP_SYNC    0x00000010
  55 #define MPU_CAP_FSK     0x00000020
  56 #define MPU_CAP_CLS     0x00000040
  57 #define MPU_CAP_SMPTE   0x00000080
  58 #define MPU_CAP_2PORT   0x00000001
  59         int             timer_flag;
  60
  61 #define MBUF_MAX        10
  62 #define BUFTEST(dc) if (dc->m_ptr >= MBUF_MAX || dc->m_ptr < 0) \
  63         {printk( "MPU: Invalid buffer pointer %d/%d, s=%d\n",  dc->m_ptr,  dc->m_left,  dc->m_state);dc->m_ptr--;}
  64           int             m_busy;
  65           unsigned char   m_buf[MBUF_MAX];
  66           int             m_ptr;
  67           int             m_state;
  68           int             m_left;
  69           unsigned char   last_status;
  70           void            (*inputintr) (int dev, unsigned char data);
  71           int             shared_irq;
  72           int            *osp;
  73           spinlock_t    lock;
  74   };
  75
  76 #define DATAPORT(base)   (base)
  77 #define COMDPORT(base)   (base+1)
  78 #define STATPORT(base)   (base+1)
  79
  80
  81 static void mpu401_close(int dev);
  82
  83 static inline int mpu401_status(struct mpu_config *devc)
  84 {
  85         return inb(STATPORT(devc->base));
  86 }
  87
  88 #define input_avail(devc)               (!(mpu401_status(devc)&INPUT_AVAIL))
  89 #define output_ready(devc)              (!(mpu401_status(devc)&OUTPUT_READY))
  90
  91 static inline void write_command(struct mpu_config *devc, unsigned char cmd)
  92 {
  93         outb(cmd, COMDPORT(devc->base));
  94 }
  95
  96 static inline int read_data(struct mpu_config *devc)
  97 {
  98         return inb(DATAPORT(devc->base));
  99 }
 100
 101 static inline void write_data(struct mpu_config *devc, unsigned char byte)
 102 {
 103         outb(byte, DATAPORT(devc->base));
 104 }
 105
 106 #define OUTPUT_READY    0x40
 107 #define INPUT_AVAIL     0x80
 108 #define MPU_ACK         0xFE
 109 #define MPU_RESET       0xFF
 110 #define UART_MODE_ON    0x3F
 111
 112 static struct mpu_config dev_conf[MAX_MIDI_DEV];
 113
 114 static int n_mpu_devs;
 115
 116 static int reset_mpu401(struct mpu_config *devc);
 117 static void set_uart_mode(int dev, struct mpu_config *devc, int arg);
 118
 119 static int mpu_timer_init(int midi_dev);
 120 static void mpu_timer_interrupt(void);
 121 static void timer_ext_event(struct mpu_config *devc, int event, int parm);
 122
 123 static struct synth_info mpu_synth_info_proto = {
 124         "MPU-401 MIDI interface",
 125         0,
 126         SYNTH_TYPE_MIDI,
 127         MIDI_TYPE_MPU401,
 128         0, 128,
 129         0, 128,
 130         SYNTH_CAP_INPUT
 131 };
 132
 133 static struct synth_info mpu_synth_info[MAX_MIDI_DEV];
 134
 135 /*
 136  * States for the input scanner
 137  */
 138
 139 #define ST_INIT                 0       /* Ready for timing byte or msg */
 140 #define ST_TIMED                1       /* Leading timing byte rcvd */
 141 #define ST_DATABYTE             2       /* Waiting for (nr_left) data bytes */
 142
 143 #define ST_SYSMSG               100     /* System message (sysx etc). */
 144 #define ST_SYSEX                101     /* System exclusive msg */
 145 #define ST_MTC                  102     /* Midi Time Code (MTC) qframe msg */
 146 #define ST_SONGSEL              103     /* Song select */
 147 #define ST_SONGPOS              104     /* Song position pointer */
 148
 149 static unsigned char len_tab[] =        /* # of data bytes following a status
 150                                          */
 151 {
 152         2,                      /* 8x */
 153         2,                      /* 9x */
 154         2,                      /* Ax */
 155         2,                      /* Bx */
 156         1,                      /* Cx */
 157         1,                      /* Dx */
 158         2,                      /* Ex */
 159         0                       /* Fx */
 160 };
 161
 162 #define STORE(cmd) \
 163 { \
 164         int len; \
 165         unsigned char obuf[8]; \
 166         cmd; \
 167         seq_input_event(obuf, len); \
 168 }
 169
 170 #define _seqbuf obuf
 171 #define _seqbufptr 0
 172 #define _SEQ_ADVBUF(x) len=x
 173
 174 static int mpu_input_scanner(struct mpu_config *devc, unsigned char midic)
 175 {
 176
 177         switch (devc->m_state)
 178         {
 179                 case ST_INIT:
 180                         switch (midic)
 181                         {
 182                                 case 0xf8:
 183                                 /* Timer overflow */
 184                                         break;
 185
 186                                 case 0xfc:
 187                                         printk("<all end>");
 188                                         break;
 189
 190                                 case 0xfd:
 191                                         if (devc->timer_flag)
 192                                                 mpu_timer_interrupt();
 193                                         break;
 194
 195                                 case 0xfe:
 196                                         return MPU_ACK;
 197
 198                                 case 0xf0:
 199                                 case 0xf1:
 200                                 case 0xf2:
 201                                 case 0xf3:
 202                                 case 0xf4:
 203                                 case 0xf5:
 204                                 case 0xf6:
 205                                 case 0xf7:
 206                                         printk("<Trk data rq #%d>", midic & 0x0f);
 207                                         break;
 208
 209                                 case 0xf9:
 210                                         printk("<conductor rq>");
 211                                         break;
 212
 213                                 case 0xff:
 214                                         devc->m_state = ST_SYSMSG;
 215                                         break;
 216
 217                                 default:
 218                                         if (midic <= 0xef)
 219                                         {
 220                                                 /* printk( "mpu time: %d ",  midic); */
 221                                                 devc->m_state = ST_TIMED;
 222                                         }
 223                                         else
 224                                                 printk("<MPU: Unknown event %02x> ", midic);
 225                         }
 226                         break;
 227
 228                 case ST_TIMED:
 229                         {
 230                                 int msg = ((int) (midic & 0xf0) >> 4);
 231
 232                                 devc->m_state = ST_DATABYTE;
 233
 234                                 if (msg < 8)    /* Data byte */
 235                                 {
 236                                         /* printk( "midi msg (running status) "); */
 237                                         msg = ((int) (devc->last_status & 0xf0) >> 4);
 238                                         msg -= 8;
 239                                         devc->m_left = len_tab[msg] - 1;
 240
 241                                         devc->m_ptr = 2;
 242                                         devc->m_buf[0] = devc->last_status;
 243                                         devc->m_buf[1] = midic;
 244
 245                                         if (devc->m_left <= 0)
 246                                         {
 247                                                 devc->m_state = ST_INIT;
 248                                                 do_midi_msg(devc->synthno, devc->m_buf, devc->m_ptr);
 249                                                 devc->m_ptr = 0;
 250                                         }
 251                                 }
 252                                 else if (msg == 0xf)    /* MPU MARK */
 253                                 {
 254                                         devc->m_state = ST_INIT;
 255
 256                                         switch (midic)
 257                                         {
 258                                                 case 0xf8:
 259                                                         /* printk( "NOP "); */
 260                                                         break;
 261
 262                                                 case 0xf9:
 263                                                         /* printk( "meas end "); */
 264                                                         break;
 265
 266                                                 case 0xfc:
 267                                                         /* printk( "data end "); */
 268                                                         break;
 269
 270                                                 default:
 271                                                         printk("Unknown MPU mark %02x\n", midic);
 272                                         }
 273                                 }
 274                                 else
 275                                 {
 276                                         devc->last_status = midic;
 277                                         /* printk( "midi msg "); */
 278                                         msg -= 8;
 279                                         devc->m_left = len_tab[msg];
 280
 281                                         devc->m_ptr = 1;
 282                                         devc->m_buf[0] = midic;
 283
 284                                         if (devc->m_left <= 0)
 285                                         {
 286                                                 devc->m_state = ST_INIT;
 287                                                 do_midi_msg(devc->synthno, devc->m_buf, devc->m_ptr);
 288                                                 devc->m_ptr = 0;
 289                                         }
 290                                 }
 291                         }
 292                         break;
 293
 294                 case ST_SYSMSG:
 295                         switch (midic)
 296                         {
 297                                 case 0xf0:
 298                                         printk("<SYX>");
 299                                         devc->m_state = ST_SYSEX;
 300                                         break;
 301
 302                                 case 0xf1:
 303                                         devc->m_state = ST_MTC;
 304                                         break;
 305
 306                                 case 0xf2:
 307                                         devc->m_state = ST_SONGPOS;
 308                                         devc->m_ptr = 0;
 309                                         break;
 310
 311                                 case 0xf3:
 312                                         devc->m_state = ST_SONGSEL;
 313                                         break;
 314
 315                                 case 0xf6:
 316                                         /* printk( "tune_request\n"); */
 317                                         devc->m_state = ST_INIT;
 318
 319                                         /*
 320                                          *    Real time messages
 321                                          */
 322                                 case 0xf8:
 323                                         /* midi clock */
 324                                         devc->m_state = ST_INIT;
 325                                         timer_ext_event(devc, TMR_CLOCK, 0);
 326                                         break;
 327
 328                                 case 0xfA:
 329                                         devc->m_state = ST_INIT;
 330                                         timer_ext_event(devc, TMR_START, 0);
 331                                         break;
 332
 333                                 case 0xFB:
 334                                         devc->m_state = ST_INIT;
 335                                         timer_ext_event(devc, TMR_CONTINUE, 0);
 336                                         break;
 337
 338                                 case 0xFC:
 339                                         devc->m_state = ST_INIT;
 340                                         timer_ext_event(devc, TMR_STOP, 0);
 341                                         break;
 342
 343                                 case 0xFE:
 344                                         /* active sensing */
 345                                         devc->m_state = ST_INIT;
 346                                         break;
 347
 348                                 case 0xff:
 349                                         /* printk( "midi hard reset"); */
 350                                         devc->m_state = ST_INIT;
 351                                         break;
 352
 353                                 default:
 354                                         printk("unknown MIDI sysmsg %0x\n", midic);
 355                                         devc->m_state = ST_INIT;
 356                         }
 357                         break;
 358
 359                 case ST_MTC:
 360                         devc->m_state = ST_INIT;
 361                         printk("MTC frame %x02\n", midic);
 362                         break;
 363
 364                 case ST_SYSEX:
 365                         if (midic == 0xf7)
 366                         {
 367                                 printk("<EOX>");
 368                                 devc->m_state = ST_INIT;
 369                         }
 370                         else
 371                                 printk("%02x ", midic);
 372                         break;
 373
 374                 case ST_SONGPOS:
 375                         BUFTEST(devc);
 376                         devc->m_buf[devc->m_ptr++] = midic;
 377                         if (devc->m_ptr == 2)
 378                         {
 379                                 devc->m_state = ST_INIT;
 380                                 devc->m_ptr = 0;
 381                                 timer_ext_event(devc, TMR_SPP,
 382                                         ((devc->m_buf[1] & 0x7f) << 7) |
 383                                         (devc->m_buf[0] & 0x7f));
 384                         }
 385                         break;
 386
 387                 case ST_DATABYTE:
 388                         BUFTEST(devc);
 389                         devc->m_buf[devc->m_ptr++] = midic;
 390                         if ((--devc->m_left) <= 0)
 391                         {
 392                                 devc->m_state = ST_INIT;
 393                                 do_midi_msg(devc->synthno, devc->m_buf, devc->m_ptr);
 394                                 devc->m_ptr = 0;
 395                         }
 396                         break;
 397
 398                 default:
 399                         printk("Bad state %d ", devc->m_state);
 400                         devc->m_state = ST_INIT;
 401         }
 402         return 1;
 403 }
 404
 405 static void mpu401_input_loop(struct mpu_config *devc)
 406 {
 407         unsigned long flags;
 408         int busy;
 409         int n;
 410
 411         spin_lock_irqsave(&devc->lock,flags);
 412         busy = devc->m_busy;
 413         devc->m_busy = 1;
 414         spin_unlock_irqrestore(&devc->lock,flags);
 415
 416         if (busy)               /* Already inside the scanner */
 417                 return;
 418
 419         n = 50;
 420
 421         while (input_avail(devc) && n-- > 0)
 422         {
 423                 unsigned char c = read_data(devc);
 424
 425                 if (devc->mode == MODE_SYNTH)
 426                 {
 427                         mpu_input_scanner(devc, c);
 428                 }
 429                 else if (devc->opened & OPEN_READ && devc->inputintr != NULL)
 430                         devc->inputintr(devc->devno, c);
 431         }
 432         devc->m_busy = 0;
 433 }
 434
 435 int intchk_mpu401(void *dev_id)
 436 {
 437         struct mpu_config *devc;
 438         int dev = (int) dev_id;
 439
 440         devc = &dev_conf[dev];
 441         return input_avail(devc);
 442 }
 443
 444 irqreturn_t mpuintr(int irq, void *dev_id, struct pt_regs *dummy)
 445 {
 446         struct mpu_config *devc;
 447         int dev = (int) dev_id;
 448         int handled = 0;
 449
 450         devc = &dev_conf[dev];
 451
 452         if (input_avail(devc))
 453         {
 454                 handled = 1;
 455                 if (devc->base != 0 && (devc->opened & OPEN_READ || devc->mode == MODE_SYNTH))
 456                         mpu401_input_loop(devc);
 457                 else
 458                 {
 459                         /* Dummy read (just to acknowledge the interrupt) */
 460                         read_data(devc);
 461                 }
 462         }
 463         return IRQ_RETVAL(handled);
 464 }
 465
 466 static int mpu401_open(int dev, int mode,
 467             void            (*input) (int dev, unsigned char data),
 468             void            (*output) (int dev)
 469 )
 470 {
 471         int err;
 472         struct mpu_config *devc;
 473         struct coproc_operations *coprocessor;
 474
 475         if (dev < 0 || dev >= num_midis || midi_devs[dev] == NULL)
 476                 return -ENXIO;
 477
 478         devc = &dev_conf[dev];
 479
 480         if (devc->opened)
 481                   return -EBUSY;
 482         /*
 483          *  Verify that the device is really running.
 484          *  Some devices (such as Ensoniq SoundScape don't
 485          *  work before the on board processor (OBP) is initialized
 486          *  by downloading its microcode.
 487          */
 488
 489         if (!devc->initialized)
 490         {
 491                 if (mpu401_status(devc) == 0xff)        /* Bus float */
 492                 {
 493                         printk(KERN_ERR "mpu401: Device not initialized properly\n");
 494                         return -EIO;
 495                 }
 496                 reset_mpu401(devc);
 497         }
 498
 499         if ( (coprocessor = midi_devs[dev]->coproc) != NULL )
 500         {
 501                 if (!try_module_get(coprocessor->owner)) {
 502                         mpu401_close(dev);
 503                         return -ENODEV;
 504                 }
 505
 506                 if ((err = coprocessor->open(coprocessor->devc, COPR_MIDI)) < 0)
 507                 {
 508                         printk(KERN_WARNING "MPU-401: Can't access coprocessor device\n");
 509                         mpu401_close(dev);
 510                         return err;
 511                 }
 512         }
 513
 514         set_uart_mode(dev, devc, 1);
 515         devc->mode = MODE_MIDI;
 516         devc->synthno = 0;
 517
 518         mpu401_input_loop(devc);
 519
 520         devc->inputintr = input;
 521         devc->opened = mode;
 522
 523         return 0;
 524 }
 525
 526 static void mpu401_close(int dev)
 527 {
 528         struct mpu_config *devc;
 529         struct coproc_operations *coprocessor;
 530
 531         devc = &dev_conf[dev];
 532         if (devc->uart_mode)
 533                 reset_mpu401(devc);     /*
 534                                          * This disables the UART mode
 535                                          */
 536         devc->mode = 0;
 537         devc->inputintr = NULL;
 538
 539         coprocessor = midi_devs[dev]->coproc;
 540         if (coprocessor) {
 541                 coprocessor->close(coprocessor->devc, COPR_MIDI);
 542                 module_put(coprocessor->owner);
 543         }
 544         devc->opened = 0;
 545 }
 546
 547 static int mpu401_out(int dev, unsigned char midi_byte)
 548 {
 549         int timeout;
 550         unsigned long flags;
 551
 552         struct mpu_config *devc;
 553
 554         devc = &dev_conf[dev];
 555
 556         /*
 557          * Sometimes it takes about 30000 loops before the output becomes ready
 558          * (After reset). Normally it takes just about 10 loops.
 559          */
 560
 561         for (timeout = 30000; timeout > 0 && !output_ready(devc); timeout--);
 562
 563         spin_lock_irqsave(&devc->lock,flags);
 564         if (!output_ready(devc))
 565         {
 566                 printk(KERN_WARNING "mpu401: Send data timeout\n");
 567                 spin_unlock_irqrestore(&devc->lock,flags);
 568                 return 0;
 569         }
 570         write_data(devc, midi_byte);
 571         spin_unlock_irqrestore(&devc->lock,flags);
 572         return 1;
 573 }
 574
 575 static int mpu401_command(int dev, mpu_command_rec * cmd)
 576 {
 577         int i, timeout, ok;
 578         int ret = 0;
 579         unsigned long   flags;
 580         struct mpu_config *devc;
 581
 582         devc = &dev_conf[dev];
 583
 584         if (devc->uart_mode)    /*
 585                                  * Not possible in UART mode
 586                                  */
 587         {
 588                 printk(KERN_WARNING "mpu401: commands not possible in the UART mode\n");
 589                 return -EINVAL;
 590         }
 591         /*
 592          * Test for input since pending input seems to block the output.
 593          */
 594         if (input_avail(devc))
 595                 mpu401_input_loop(devc);
 596
 597         /*
 598          * Sometimes it takes about 50000 loops before the output becomes ready
 599          * (After reset). Normally it takes just about 10 loops.
 600          */
 601
 602         timeout = 50000;
 603 retry:
 604         if (timeout-- <= 0)
 605         {
 606                 printk(KERN_WARNING "mpu401: Command (0x%x) timeout\n", (int) cmd->cmd);
 607                 return -EIO;
 608         }
 609         spin_lock_irqsave(&devc->lock,flags);
 610
 611         if (!output_ready(devc))
 612         {
 613                 spin_unlock_irqrestore(&devc->lock,flags);
 614                 goto retry;
 615         }
 616         write_command(devc, cmd->cmd);
 617
 618         ok = 0;
 619         for (timeout = 50000; timeout > 0 && !ok; timeout--)
 620         {
 621                 if (input_avail(devc))
 622                 {
 623                         if (devc->opened && devc->mode == MODE_SYNTH)
 624                         {
 625                                 if (mpu_input_scanner(devc, read_data(devc)) == MPU_ACK)
 626                                         ok = 1;
 627                         }
 628                         else
 629                         {
 630                                 /* Device is not currently open. Use simpler method */
 631                                 if (read_data(devc) == MPU_ACK)
 632                                         ok = 1;
 633                         }
 634                 }
 635         }
 636         if (!ok)
 637         {
 638                 spin_unlock_irqrestore(&devc->lock,flags);
 639                 return -EIO;
 640         }
 641         if (cmd->nr_args)
 642         {
 643                 for (i = 0; i < cmd->nr_args; i++)
 644                 {
 645                         for (timeout = 3000; timeout > 0 && !output_ready(devc); timeout--);
 646
 647                         if (!mpu401_out(dev, cmd->data[i]))
 648                         {
 649                                 spin_unlock_irqrestore(&devc->lock,flags);
 650                                 printk(KERN_WARNING "mpu401: Command (0x%x), parm send failed.\n", (int) cmd->cmd);
 651                                 return -EIO;
 652                         }
 653                 }
 654         }
 655         ret = 0;
 656         cmd->data[0] = 0;
 657
 658         if (cmd->nr_returns)
 659         {
 660                 for (i = 0; i < cmd->nr_returns; i++)
 661                 {
 662                         ok = 0;
 663                         for (timeout = 5000; timeout > 0 && !ok; timeout--)
 664                                 if (input_avail(devc))
 665                                 {
 666                                         cmd->data[i] = read_data(devc);
 667                                         ok = 1;
 668                                 }
 669                         if (!ok)
 670                         {
 671                                 spin_unlock_irqrestore(&devc->lock,flags);
 672                                 return -EIO;
 673                         }
 674                 }
 675         }
 676         spin_unlock_irqrestore(&devc->lock,flags);
 677         return ret;
 678 }
 679
 680 static int mpu_cmd(int dev, int cmd, int data)
 681 {
 682         int ret;
 683
 684         static mpu_command_rec rec;
 685
 686         rec.cmd = cmd & 0xff;
 687         rec.nr_args = ((cmd & 0xf0) == 0xE0);
 688         rec.nr_returns = ((cmd & 0xf0) == 0xA0);
 689         rec.data[0] = data & 0xff;
 690
 691         if ((ret = mpu401_command(dev, &rec)) < 0)
 692                 return ret;
 693         return (unsigned char) rec.data[0];
 694 }
 695
 696 static int mpu401_prefix_cmd(int dev, unsigned char status)
 697 {
 698         struct mpu_config *devc = &dev_conf[dev];
 699
 700         if (devc->uart_mode)
 701                 return 1;
 702
 703         if (status < 0xf0)
 704         {
 705                 if (mpu_cmd(dev, 0xD0, 0) < 0)
 706                         return 0;
 707                 return 1;
 708         }
 709         switch (status)
 710         {
 711                 case 0xF0:
 712                         if (mpu_cmd(dev, 0xDF, 0) < 0)
 713                                 return 0;
 714                         return 1;
 715
 716                 default:
 717                         return 0;
 718         }
 719 }
 720
 721 static int mpu401_start_read(int dev)
 722 {
 723         return 0;
 724 }
 725
 726 static int mpu401_end_read(int dev)
 727 {
 728         return 0;
 729 }
 730
 731 static int mpu401_ioctl(int dev, unsigned cmd, caddr_t arg)
 732 {
 733         struct mpu_config *devc;
 734         mpu_command_rec rec;
 735         int val, ret;
 736
 737         devc = &dev_conf[dev];
 738         switch (cmd)
 739         {
 740                 case SNDCTL_MIDI_MPUMODE:
 741                         if (!(devc->capabilities & MPU_CAP_INTLG)) { /* No intelligent mode */
 742                                 printk(KERN_WARNING "mpu401: Intelligent mode not supported by the HW\n");
 743                                 return -EINVAL;
 744                         }
 745                         if (get_user(val, (int *)arg))
 746                                 return -EFAULT;
 747                         set_uart_mode(dev, devc, !val);
 748                         return 0;
 749
 750                 case SNDCTL_MIDI_MPUCMD:
 751                         if (copy_from_user(&rec, arg, sizeof(rec)))
 752                                 return -EFAULT;
 753                         if ((ret = mpu401_command(dev, &rec)) < 0)
 754                                 return ret;
 755                         if (copy_to_user(arg, &rec, sizeof(rec)))
 756                                 return -EFAULT;
 757                         return 0;
 758
 759                 default:
 760                         return -EINVAL;
 761         }
 762 }
 763
 764 static void mpu401_kick(int dev)
 765 {
 766 }
 767
 768 static int mpu401_buffer_status(int dev)
 769 {
 770         return 0;               /*
 771                                  * No data in buffers
 772                                  */
 773 }
 774
 775 static int mpu_synth_ioctl(int dev,
 776                 unsigned int cmd, caddr_t arg)
 777 {
 778         int midi_dev;
 779         struct mpu_config *devc;
 780
 781         midi_dev = synth_devs[dev]->midi_dev;
 782
 783         if (midi_dev < 0 || midi_dev > num_midis || midi_devs[midi_dev] == NULL)
 784                 return -ENXIO;
 785
 786         devc = &dev_conf[midi_dev];
 787
 788         switch (cmd)
 789         {
 790
 791                 case SNDCTL_SYNTH_INFO:
 792                         if (copy_to_user((&((char *) arg)[0]),
 793                                         (char *) &mpu_synth_info[midi_dev],
 794                                         sizeof(struct synth_info)))
 795                                 return -EFAULT;
 796                         return 0;
 797
 798                 case SNDCTL_SYNTH_MEMAVL:
 799                         return 0x7fffffff;
 800
 801                 default:
 802                         return -EINVAL;
 803         }
 804 }
 805
 806 static int mpu_synth_open(int dev, int mode)
 807 {
 808         int midi_dev, err;
 809         struct mpu_config *devc;
 810         struct coproc_operations *coprocessor;
 811
 812         midi_dev = synth_devs[dev]->midi_dev;
 813
 814         if (midi_dev < 0 || midi_dev > num_midis || midi_devs[midi_dev] == NULL)
 815                 return -ENXIO;
 816
 817         devc = &dev_conf[midi_dev];
 818
 819         /*
 820          *  Verify that the device is really running.
 821          *  Some devices (such as Ensoniq SoundScape don't
 822          *  work before the on board processor (OBP) is initialized
 823          *  by downloading its microcode.
 824          */
 825
 826         if (!devc->initialized)
 827         {
 828                 if (mpu401_status(devc) == 0xff)        /* Bus float */
 829                 {
 830                         printk(KERN_ERR "mpu401: Device not initialized properly\n");
 831                         return -EIO;
 832                 }
 833                 reset_mpu401(devc);
 834         }
 835         if (devc->opened)
 836                 return -EBUSY;
 837         devc->mode = MODE_SYNTH;
 838         devc->synthno = dev;
 839
 840         devc->inputintr = NULL;
 841
 842         coprocessor = midi_devs[midi_dev]->coproc;
 843         if (coprocessor) {
 844                 if (!try_module_get(coprocessor->owner))
 845                         return -ENODEV;
 846
 847                 if ((err = coprocessor->open(coprocessor->devc, COPR_MIDI)) < 0)
 848                 {
 849                         printk(KERN_WARNING "mpu401: Can't access coprocessor device\n");
 850                         return err;
 851                 }
 852         }
 853         devc->opened = mode;
 854         reset_mpu401(devc);
 855
 856         if (mode & OPEN_READ)
 857         {
 858                 mpu_cmd(midi_dev, 0x8B, 0);     /* Enable data in stop mode */
 859                 mpu_cmd(midi_dev, 0x34, 0);     /* Return timing bytes in stop mode */
 860                 mpu_cmd(midi_dev, 0x87, 0);     /* Enable pitch & controller */
 861         }
 862         return 0;
 863 }
 864
 865 static void mpu_synth_close(int dev)
 866 {
 867         int midi_dev;
 868         struct mpu_config *devc;
 869         struct coproc_operations *coprocessor;
 870
 871         midi_dev = synth_devs[dev]->midi_dev;
 872
 873         devc = &dev_conf[midi_dev];
 874         mpu_cmd(midi_dev, 0x15, 0);     /* Stop recording, playback and MIDI */
 875         mpu_cmd(midi_dev, 0x8a, 0);     /* Disable data in stopped mode */
 876
 877         devc->inputintr = NULL;
 878
 879         coprocessor = midi_devs[midi_dev]->coproc;
 880         if (coprocessor) {
 881                 coprocessor->close(coprocessor->devc, COPR_MIDI);
 882                 module_put(coprocessor->owner);
 883         }
 884         devc->opened = 0;
 885         devc->mode = 0;
 886 }
 887
 888 #define MIDI_SYNTH_NAME "MPU-401 UART Midi"
 889 #define MIDI_SYNTH_CAPS SYNTH_CAP_INPUT
 890 #include "midi_synth.h"
 891
 892 static struct synth_operations mpu401_synth_proto =
 893 {
 894         .owner          = THIS_MODULE,
 895         .id             = "MPU401",
 896         .info           = NULL,
 897         .midi_dev       = 0,
 898         .synth_type     = SYNTH_TYPE_MIDI,
 899         .synth_subtype  = 0,
 900         .open           = mpu_synth_open,
 901         .close          = mpu_synth_close,
 902         .ioctl          = mpu_synth_ioctl,
 903         .kill_note      = midi_synth_kill_note,
 904         .start_note     = midi_synth_start_note,
 905         .set_instr      = midi_synth_set_instr,
 906         .reset          = midi_synth_reset,
 907         .hw_control     = midi_synth_hw_control,
 908         .load_patch     = midi_synth_load_patch,
 909         .aftertouch     = midi_synth_aftertouch,
 910         .controller     = midi_synth_controller,
 911         .panning        = midi_synth_panning,
 912         .bender         = midi_synth_bender,
 913         .setup_voice    = midi_synth_setup_voice,
 914         .send_sysex     = midi_synth_send_sysex
 915 };
 916
 917 static struct synth_operations *mpu401_synth_operations[MAX_MIDI_DEV];
 918
 919 static struct midi_operations mpu401_midi_proto =
 920 {
 921         .owner          = THIS_MODULE,
 922         .info           = {"MPU-401 Midi", 0, MIDI_CAP_MPU401, SNDCARD_MPU401},
 923         .in_info        = {0},
 924         .open           = mpu401_open,
 925         .close          = mpu401_close,
 926         .ioctl          = mpu401_ioctl,
 927         .outputc        = mpu401_out,
 928         .start_read     = mpu401_start_read,
 929         .end_read       = mpu401_end_read,
 930         .kick           = mpu401_kick,
 931         .buffer_status  = mpu401_buffer_status,
 932         .prefix_cmd     = mpu401_prefix_cmd
 933 };
 934
 935 static struct midi_operations mpu401_midi_operations[MAX_MIDI_DEV];
 936
 937 static void mpu401_chk_version(int n, struct mpu_config *devc)
 938 {
 939         int tmp;
 940         unsigned long flags;
 941
 942         devc->version = devc->revision = 0;
 943
 944         spin_lock_irqsave(&devc->lock,flags);
 945         if ((tmp = mpu_cmd(n, 0xAC, 0)) < 0)
 946         {
 947                 spin_unlock_irqrestore(&devc->lock,flags);
 948                 return;
 949         }
 950         if ((tmp & 0xf0) > 0x20)        /* Why it's larger than 2.x ??? */
 951         {
 952                 spin_unlock_irqrestore(&devc->lock,flags);
 953                 return;
 954         }
 955         devc->version = tmp;
 956
 957         if ((tmp = mpu_cmd(n, 0xAD, 0)) < 0)
 958         {
 959                 devc->version = 0;
 960                 spin_unlock_irqrestore(&devc->lock,flags);
 961                 return;
 962         }
 963         devc->revision = tmp;
 964         spin_unlock_irqrestore(&devc->lock,flags);
 965 }
 966
 967 int attach_mpu401(struct address_info *hw_config, struct module *owner)
 968 {
 969         unsigned long flags;
 970         char revision_char;
 971
 972         int m, ret;
 973         struct mpu_config *devc;
 974
 975         hw_config->slots[1] = -1;
 976         m = sound_alloc_mididev();
 977         if (m == -1)
 978         {
 979                 printk(KERN_WARNING "MPU-401: Too many midi devices detected\n");
 980                 ret = -ENOMEM;
 981                 goto out_err;
 982         }
 983         devc = &dev_conf[m];
 984         devc->base = hw_config->io_base;
 985         devc->osp = hw_config->osp;
 986         devc->irq = hw_config->irq;
 987         devc->opened = 0;
 988         devc->uart_mode = 0;
 989         devc->initialized = 0;
 990         devc->version = 0;
 991         devc->revision = 0;
 992         devc->capabilities = 0;
 993         devc->timer_flag = 0;
 994         devc->m_busy = 0;
 995         devc->m_state = ST_INIT;
 996         devc->shared_irq = hw_config->always_detect;
 997         devc->irq = hw_config->irq;
 998         spin_lock_init(&devc->lock);
 999
1000         if (devc->irq < 0)
1001         {
1002                 devc->irq *= -1;
1003                 devc->shared_irq = 1;
1004         }
1005
1006         if (!hw_config->always_detect)
1007         {
1008                 /* Verify the hardware again */
1009                 if (!reset_mpu401(devc))
1010                 {
1011                         printk(KERN_WARNING "mpu401: Device didn't respond\n");
1012                         ret = -ENODEV;
1013                         goto out_mididev;
1014                 }
1015                 if (!devc->shared_irq)
1016                 {
1017                         if (request_irq(devc->irq, mpuintr, 0, "mpu401", (void *)m) < 0)
1018                         {
1019                                 printk(KERN_WARNING "mpu401: Failed to allocate IRQ%d\n", devc->irq);
1020                                 ret = -ENOMEM;
1021                                 goto out_mididev;
1022                         }
1023                 }
1024                 spin_lock_irqsave(&devc->lock,flags);
1025                 mpu401_chk_version(m, devc);
1026                 if (devc->version == 0)
1027                         mpu401_chk_version(m, devc);
1028                         spin_unlock_irqrestore(&devc->lock,flags);
1029         }
1030
1031         if (!request_region(hw_config->io_base, 2, "mpu401"))
1032         {
1033                 ret = -ENOMEM;
1034                 goto out_irq;
1035         }
1036
1037         if (devc->version != 0)
1038                 if (mpu_cmd(m, 0xC5, 0) >= 0)   /* Set timebase OK */
1039                         if (mpu_cmd(m, 0xE0, 120) >= 0)         /* Set tempo OK */
1040                                 devc->capabilities |= MPU_CAP_INTLG;    /* Supports intelligent mode */
1041
1042
1043         mpu401_synth_operations[m] = (struct synth_operations *)kmalloc(sizeof(struct synth_operations), GFP_KERNEL);
1044
1045         if (mpu401_synth_operations[m] == NULL)
1046         {
1047                 printk(KERN_ERR "mpu401: Can't allocate memory\n");
1048                 ret = -ENOMEM;
1049                 goto out_resource;
1050         }
1051         if (!(devc->capabilities & MPU_CAP_INTLG))      /* No intelligent mode */
1052         {
1053                 memcpy((char *) mpu401_synth_operations[m],
1054                         (char *) &std_midi_synth,
1055                          sizeof(struct synth_operations));
1056         }
1057         else
1058         {
1059                 memcpy((char *) mpu401_synth_operations[m],
1060                         (char *) &mpu401_synth_proto,
1061                          sizeof(struct synth_operations));
1062         }
1063         if (owner)
1064                 mpu401_synth_operations[m]->owner = owner;
1065
1066         memcpy((char *) &mpu401_midi_operations[m],
1067                (char *) &mpu401_midi_proto,
1068                sizeof(struct midi_operations));
1069
1070         mpu401_midi_operations[m].converter = mpu401_synth_operations[m];
1071
1072         memcpy((char *) &mpu_synth_info[m],
1073                (char *) &mpu_synth_info_proto,
1074                sizeof(struct synth_info));
1075
1076         n_mpu_devs++;
1077
1078         if (devc->version == 0x20 && devc->revision >= 0x07)    /* MusicQuest interface */
1079         {
1080                 int ports = (devc->revision & 0x08) ? 32 : 16;
1081
1082                 devc->capabilities |= MPU_CAP_SYNC | MPU_CAP_SMPTE |
1083                                 MPU_CAP_CLS | MPU_CAP_2PORT;
1084
1085                 revision_char = (devc->revision == 0x7f) ? 'M' : ' ';
1086                 sprintf(mpu_synth_info[m].name, "MQX-%d%c MIDI Interface #%d",
1087                                 ports,
1088                                 revision_char,
1089                                 n_mpu_devs);
1090         }
1091         else
1092         {
1093                 revision_char = devc->revision ? devc->revision + '@' : ' ';
1094                 if ((int) devc->revision > ('Z' - '@'))
1095                         revision_char = '+';
1096
1097                 devc->capabilities |= MPU_CAP_SYNC | MPU_CAP_FSK;
1098
1099                 if (hw_config->name)
1100                         sprintf(mpu_synth_info[m].name, "%s (MPU401)", hw_config->name);
1101                 else
1102                         sprintf(mpu_synth_info[m].name,
1103                                 "MPU-401 %d.%d%c Midi interface #%d",
1104                                 (int) (devc->version & 0xf0) >> 4,
1105                                 devc->version & 0x0f,
1106                                 revision_char,
1107                                 n_mpu_devs);
1108         }
1109
1110         strcpy(mpu401_midi_operations[m].info.name,
1111                mpu_synth_info[m].name);
1112
1113         conf_printf(mpu_synth_info[m].name, hw_config);
1114
1115         mpu401_synth_operations[m]->midi_dev = devc->devno = m;
1116         mpu401_synth_operations[devc->devno]->info = &mpu_synth_info[devc->devno];
1117
1118         if (devc->capabilities & MPU_CAP_INTLG)         /* Intelligent mode */
1119                 hw_config->slots[2] = mpu_timer_init(m);
1120
1121         midi_devs[m] = &mpu401_midi_operations[devc->devno];
1122
1123         if (owner)
1124                 midi_devs[m]->owner = owner;
1125
1126         hw_config->slots[1] = m;
1127         sequencer_init();
1128
1129         return 0;
1130
1131 out_resource:
1132         release_region(hw_config->io_base, 2);
1133 out_irq:
1134         free_irq(devc->irq, (void *)m);
1135 out_mididev:
1136         sound_unload_mididev(m);
1137 out_err:
1138         return ret;
1139 }
1140
1141 static int reset_mpu401(struct mpu_config *devc)
1142 {
1143         unsigned long flags;
1144         int ok, timeout, n;
1145         int timeout_limit;
1146
1147         /*
1148          * Send the RESET command. Try again if no success at the first time.
1149          * (If the device is in the UART mode, it will not ack the reset cmd).
1150          */
1151
1152         ok = 0;
1153
1154         timeout_limit = devc->initialized ? 30000 : 100000;
1155         devc->initialized = 1;
1156
1157         for (n = 0; n < 2 && !ok; n++)
1158         {
1159                 for (timeout = timeout_limit; timeout > 0 && !ok; timeout--)
1160                           ok = output_ready(devc);
1161
1162                 write_command(devc, MPU_RESET); /*
1163                                                            * Send MPU-401 RESET Command
1164                                                          */
1165
1166                 /*
1167                  * Wait at least 25 msec. This method is not accurate so let's make the
1168                  * loop bit longer. Cannot sleep since this is called during boot.
1169                  */
1170
1171                 for (timeout = timeout_limit * 2; timeout > 0 && !ok; timeout--)
1172                 {
1173                         spin_lock_irqsave(&devc->lock,flags);
1174                         if (input_avail(devc))
1175                                 if (read_data(devc) == MPU_ACK)
1176                                         ok = 1;
1177                         spin_unlock_irqrestore(&devc->lock,flags);
1178                 }
1179
1180         }
1181
1182         devc->m_state = ST_INIT;
1183         devc->m_ptr = 0;
1184         devc->m_left = 0;
1185         devc->last_status = 0;
1186         devc->uart_mode = 0;
1187
1188         return ok;
1189 }
1190
1191 static void set_uart_mode(int dev, struct mpu_config *devc, int arg)
1192 {
1193         if (!arg && (devc->capabilities & MPU_CAP_INTLG))
1194                 return;
1195         if ((devc->uart_mode == 0) == (arg == 0))
1196                 return;         /* Already set */
1197         reset_mpu401(devc);     /* This exits the uart mode */
1198
1199         if (arg)
1200         {
1201                 if (mpu_cmd(dev, UART_MODE_ON, 0) < 0)
1202                 {
1203                         printk(KERN_ERR "mpu401: Can't enter UART mode\n");
1204                         devc->uart_mode = 0;
1205                         return;
1206                 }
1207         }
1208         devc->uart_mode = arg;
1209
1210 }
1211
1212 int probe_mpu401(struct address_info *hw_config)
1213 {
1214         int ok = 0;
1215         struct mpu_config tmp_devc;
1216
1217         if (check_region(hw_config->io_base, 2))
1218         {
1219                 printk(KERN_ERR "mpu401: I/O port %x already in use\n\n", hw_config->io_base);
1220                 return 0;
1221         }
1222         tmp_devc.base = hw_config->io_base;
1223         tmp_devc.irq = hw_config->irq;
1224         tmp_devc.initialized = 0;
1225         tmp_devc.opened = 0;
1226         tmp_devc.osp = hw_config->osp;
1227
1228         if (hw_config->always_detect)
1229                 return 1;
1230
1231         if (inb(hw_config->io_base + 1) == 0xff)
1232         {
1233                 DDB(printk("MPU401: Port %x looks dead.\n", hw_config->io_base));
1234                 return 0;       /* Just bus float? */
1235         }
1236         ok = reset_mpu401(&tmp_devc);
1237
1238         if (!ok)
1239         {
1240                 DDB(printk("MPU401: Reset failed on port %x\n", hw_config->io_base));
1241         }
1242         return ok;
1243 }
1244
1245 void unload_mpu401(struct address_info *hw_config)
1246 {
1247         void *p;
1248         int n=hw_config->slots[1];
1249
1250         if (n != -1) {
1251                 release_region(hw_config->io_base, 2);
1252                 if (hw_config->always_detect == 0 && hw_config->irq > 0)
1253                         free_irq(hw_config->irq, (void *)n);
1254                 p=mpu401_synth_operations[n];
1255                 sound_unload_mididev(n);
1256                 sound_unload_timerdev(hw_config->slots[2]);
1257                 if(p)
1258                         kfree(p);
1259         }
1260 }
1261
1262 /*****************************************************
1263  *      Timer stuff
1264  ****************************************************/
1265
1266 static volatile int timer_initialized = 0, timer_open = 0, tmr_running = 0;
1267 static volatile int curr_tempo, curr_timebase, hw_timebase;
1268 static int      max_timebase = 8;       /* 8*24=192 ppqn */
1269 static volatile unsigned long next_event_time;
1270 static volatile unsigned long curr_ticks, curr_clocks;
1271 static unsigned long prev_event_time;
1272 static int      metronome_mode;
1273
1274 static unsigned long clocks2ticks(unsigned long clocks)
1275 {
1276         /*
1277          * The MPU-401 supports just a limited set of possible timebase values.
1278          * Since the applications require more choices, the driver has to
1279          * program the HW to do its best and to convert between the HW and
1280          * actual timebases.
1281          */
1282         return ((clocks * curr_timebase) + (hw_timebase / 2)) / hw_timebase;
1283 }
1284
1285 static void set_timebase(int midi_dev, int val)
1286 {
1287         int hw_val;
1288
1289         if (val < 48)
1290                 val = 48;
1291         if (val > 1000)
1292                 val = 1000;
1293
1294         hw_val = val;
1295         hw_val = (hw_val + 12) / 24;
1296         if (hw_val > max_timebase)
1297                 hw_val = max_timebase;
1298
1299         if (mpu_cmd(midi_dev, 0xC0 | (hw_val & 0x0f), 0) < 0)
1300         {
1301                 printk(KERN_WARNING "mpu401: Can't set HW timebase to %d\n", hw_val * 24);
1302                 return;
1303         }
1304         hw_timebase = hw_val * 24;
1305         curr_timebase = val;
1306
1307 }
1308
1309 static void tmr_reset(struct mpu_config *devc)
1310 {
1311         unsigned long flags;
1312
1313         spin_lock_irqsave(&devc->lock,flags);
1314         next_event_time = (unsigned long) -1;
1315         prev_event_time = 0;
1316         curr_ticks = curr_clocks = 0;
1317         spin_unlock_irqrestore(&devc->lock,flags);
1318 }
1319
1320 static void set_timer_mode(int midi_dev)
1321 {
1322         if (timer_mode & TMR_MODE_CLS)
1323                 mpu_cmd(midi_dev, 0x3c, 0);     /* Use CLS sync */
1324         else if (timer_mode & TMR_MODE_SMPTE)
1325                 mpu_cmd(midi_dev, 0x3d, 0);     /* Use SMPTE sync */
1326
1327         if (timer_mode & TMR_INTERNAL)
1328         {
1329                   mpu_cmd(midi_dev, 0x80, 0);   /* Use MIDI sync */
1330         }
1331         else
1332         {
1333                 if (timer_mode & (TMR_MODE_MIDI | TMR_MODE_CLS))
1334                 {
1335                         mpu_cmd(midi_dev, 0x82, 0);             /* Use MIDI sync */
1336                         mpu_cmd(midi_dev, 0x91, 0);             /* Enable ext MIDI ctrl */
1337                 }
1338                 else if (timer_mode & TMR_MODE_FSK)
1339                         mpu_cmd(midi_dev, 0x81, 0);     /* Use FSK sync */
1340         }
1341 }
1342
1343 static void stop_metronome(int midi_dev)
1344 {
1345         mpu_cmd(midi_dev, 0x84, 0);     /* Disable metronome */
1346 }
1347
1348 static void setup_metronome(int midi_dev)
1349 {
1350         int numerator, denominator;
1351         int clks_per_click, num_32nds_per_beat;
1352         int beats_per_measure;
1353
1354         numerator = ((unsigned) metronome_mode >> 24) & 0xff;
1355         denominator = ((unsigned) metronome_mode >> 16) & 0xff;
1356         clks_per_click = ((unsigned) metronome_mode >> 8) & 0xff;
1357         num_32nds_per_beat = (unsigned) metronome_mode & 0xff;
1358         beats_per_measure = (numerator * 4) >> denominator;
1359
1360         if (!metronome_mode)
1361                 mpu_cmd(midi_dev, 0x84, 0);     /* Disable metronome */
1362         else
1363         {
1364                 mpu_cmd(midi_dev, 0xE4, clks_per_click);
1365                 mpu_cmd(midi_dev, 0xE6, beats_per_measure);
1366                 mpu_cmd(midi_dev, 0x83, 0);     /* Enable metronome without accents */
1367         }
1368 }
1369
1370 static int mpu_start_timer(int midi_dev)
1371 {
1372         struct mpu_config *devc= &dev_conf[midi_dev];
1373
1374         tmr_reset(devc);
1375         set_timer_mode(midi_dev);
1376
1377         if (tmr_running)
1378                 return TIMER_NOT_ARMED;         /* Already running */
1379
1380         if (timer_mode & TMR_INTERNAL)
1381         {
1382                 mpu_cmd(midi_dev, 0x02, 0);     /* Send MIDI start */
1383                 tmr_running = 1;
1384                 return TIMER_NOT_ARMED;
1385         }
1386         else
1387         {
1388                 mpu_cmd(midi_dev, 0x35, 0);     /* Enable mode messages to PC */
1389                 mpu_cmd(midi_dev, 0x38, 0);     /* Enable sys common messages to PC */
1390                 mpu_cmd(midi_dev, 0x39, 0);     /* Enable real time messages to PC */
1391                 mpu_cmd(midi_dev, 0x97, 0);     /* Enable system exclusive messages to PC */
1392         }
1393         return TIMER_ARMED;
1394 }
1395
1396 static int mpu_timer_open(int dev, int mode)
1397 {
1398         int midi_dev = sound_timer_devs[dev]->devlink;
1399         struct mpu_config *devc= &dev_conf[midi_dev];
1400
1401         if (timer_open)
1402                 return -EBUSY;
1403
1404         tmr_reset(devc);
1405         curr_tempo = 50;
1406         mpu_cmd(midi_dev, 0xE0, 50);
1407         curr_timebase = hw_timebase = 120;
1408         set_timebase(midi_dev, 120);
1409         timer_open = 1;
1410         metronome_mode = 0;
1411         set_timer_mode(midi_dev);
1412
1413         mpu_cmd(midi_dev, 0xe7, 0x04);  /* Send all clocks to host */
1414         mpu_cmd(midi_dev, 0x95, 0);     /* Enable clock to host */
1415
1416         return 0;
1417 }
1418
1419 static void mpu_timer_close(int dev)
1420 {
1421         int midi_dev = sound_timer_devs[dev]->devlink;
1422
1423         timer_open = tmr_running = 0;
1424         mpu_cmd(midi_dev, 0x15, 0);     /* Stop all */
1425         mpu_cmd(midi_dev, 0x94, 0);     /* Disable clock to host */
1426         mpu_cmd(midi_dev, 0x8c, 0);     /* Disable measure end messages to host */
1427         stop_metronome(midi_dev);
1428 }
1429
1430 static int mpu_timer_event(int dev, unsigned char *event)
1431 {
1432         unsigned char command = event[1];
1433         unsigned long parm = *(unsigned int *) &event[4];
1434         int midi_dev = sound_timer_devs[dev]->devlink;
1435
1436         switch (command)
1437         {
1438                 case TMR_WAIT_REL:
1439                         parm += prev_event_time;
1440                 case TMR_WAIT_ABS:
1441                         if (parm > 0)
1442                         {
1443                                 long time;
1444
1445                                 if (parm <= curr_ticks) /* It's the time */
1446                                         return TIMER_NOT_ARMED;
1447                                 time = parm;
1448                                 next_event_time = prev_event_time = time;
1449
1450                                 return TIMER_ARMED;
1451                         }
1452                         break;
1453
1454                 case TMR_START:
1455                         if (tmr_running)
1456                                 break;
1457                         return mpu_start_timer(midi_dev);
1458
1459                 case TMR_STOP:
1460                         mpu_cmd(midi_dev, 0x01, 0);     /* Send MIDI stop */
1461                         stop_metronome(midi_dev);
1462                         tmr_running = 0;
1463                         break;
1464
1465                 case TMR_CONTINUE:
1466                         if (tmr_running)
1467                                 break;
1468                         mpu_cmd(midi_dev, 0x03, 0);     /* Send MIDI continue */
1469                         setup_metronome(midi_dev);
1470                         tmr_running = 1;
1471                         break;
1472
1473                 case TMR_TEMPO:
1474                         if (parm)
1475                         {
1476                                 if (parm < 8)
1477                                         parm = 8;
1478                                 if (parm > 250)
1479                                         parm = 250;
1480                                 if (mpu_cmd(midi_dev, 0xE0, parm) < 0)
1481                                         printk(KERN_WARNING "mpu401: Can't set tempo to %d\n", (int) parm);
1482                                 curr_tempo = parm;
1483                         }
1484                         break;
1485
1486                 case TMR_ECHO:
1487                         seq_copy_to_input(event, 8);
1488                         break;
1489
1490                 case TMR_TIMESIG:
1491                         if (metronome_mode)     /* Metronome enabled */
1492                         {
1493                                 metronome_mode = parm;
1494                                 setup_metronome(midi_dev);
1495                         }
1496                         break;
1497
1498                 default:;
1499         }
1500         return TIMER_NOT_ARMED;
1501 }
1502
1503 static unsigned long mpu_timer_get_time(int dev)
1504 {
1505         if (!timer_open)
1506                 return 0;
1507
1508         return curr_ticks;
1509 }
1510
1511 static int mpu_timer_ioctl(int dev, unsigned int command, caddr_t arg)
1512 {
1513         int midi_dev = sound_timer_devs[dev]->devlink;
1514
1515         switch (command)
1516         {
1517                 case SNDCTL_TMR_SOURCE:
1518                         {
1519                                 int parm;
1520
1521                                 parm = *(int *) arg;
1522                                 parm &= timer_caps;
1523
1524                                 if (parm != 0)
1525                                 {
1526                                         timer_mode = parm;
1527
1528                                         if (timer_mode & TMR_MODE_CLS)
1529                                                 mpu_cmd(midi_dev, 0x3c, 0);             /* Use CLS sync */
1530                                         else if (timer_mode & TMR_MODE_SMPTE)
1531                                                 mpu_cmd(midi_dev, 0x3d, 0);             /* Use SMPTE sync */
1532                                 }
1533                                 return (*(int *) arg = timer_mode);
1534                         }
1535                         break;
1536
1537                 case SNDCTL_TMR_START:
1538                         mpu_start_timer(midi_dev);
1539                         return 0;
1540
1541                 case SNDCTL_TMR_STOP:
1542                         tmr_running = 0;
1543                         mpu_cmd(midi_dev, 0x01, 0);     /* Send MIDI stop */
1544                         stop_metronome(midi_dev);
1545                         return 0;
1546
1547                 case SNDCTL_TMR_CONTINUE:
1548                         if (tmr_running)
1549                                 return 0;
1550                         tmr_running = 1;
1551                         mpu_cmd(midi_dev, 0x03, 0);     /* Send MIDI continue */
1552                         return 0;
1553
1554                 case SNDCTL_TMR_TIMEBASE:
1555                         {
1556                                 int val;
1557
1558                                 val = *(int *) arg;
1559                                 if (val)
1560                                         set_timebase(midi_dev, val);
1561                                 return (*(int *) arg = curr_timebase);
1562                         }
1563                         break;
1564
1565                 case SNDCTL_TMR_TEMPO:
1566                         {
1567                                 int val;
1568                                 int ret;
1569
1570                                 val = *(int *) arg;
1571
1572                                 if (val)
1573                                 {
1574                                         if (val < 8)
1575                                                 val = 8;
1576                                         if (val > 250)
1577                                                 val = 250;
1578                                         if ((ret = mpu_cmd(midi_dev, 0xE0, val)) < 0)
1579                                         {
1580                                                 printk(KERN_WARNING "mpu401: Can't set tempo to %d\n", (int) val);
1581                                                 return ret;
1582                                         }
1583                                         curr_tempo = val;
1584                                 }
1585                                 return (*(int *) arg = curr_tempo);
1586                         }
1587                         break;
1588
1589                 case SNDCTL_SEQ_CTRLRATE:
1590                         {
1591                                 int val;
1592
1593                                 val = *(int *) arg;
1594                                 if (val != 0)           /* Can't change */
1595                                         return -EINVAL;
1596                                 return (*(int *) arg = ((curr_tempo * curr_timebase) + 30) / 60);
1597                         }
1598                         break;
1599
1600                 case SNDCTL_SEQ_GETTIME:
1601                         return (*(int *) arg = curr_ticks);
1602
1603                 case SNDCTL_TMR_METRONOME:
1604                         metronome_mode = *(int *) arg;
1605                         setup_metronome(midi_dev);
1606                         return 0;
1607
1608                 default:;
1609         }
1610         return -EINVAL;
1611 }
1612
1613 static void mpu_timer_arm(int dev, long time)
1614 {
1615         if (time < 0)
1616                 time = curr_ticks + 1;
1617         else if (time <= curr_ticks)    /* It's the time */
1618                 return;
1619         next_event_time = prev_event_time = time;
1620         return;
1621 }
1622
1623 static struct sound_timer_operations mpu_timer =
1624 {
1625         .owner          = THIS_MODULE,
1626         .info           = {"MPU-401 Timer", 0},
1627         .priority       = 10,   /* Priority */
1628         .devlink        = 0,    /* Local device link */
1629         .open           = mpu_timer_open,
1630         .close          = mpu_timer_close,
1631         .event          = mpu_timer_event,
1632         .get_time       = mpu_timer_get_time,
1633         .ioctl          = mpu_timer_ioctl,
1634         .arm_timer      = mpu_timer_arm
1635 };
1636
1637 static void mpu_timer_interrupt(void)
1638 {
1639         if (!timer_open)
1640                 return;
1641
1642         if (!tmr_running)
1643                 return;
1644
1645         curr_clocks++;
1646         curr_ticks = clocks2ticks(curr_clocks);
1647
1648         if (curr_ticks >= next_event_time)
1649         {
1650                 next_event_time = (unsigned long) -1;
1651                 sequencer_timer(0);
1652         }
1653 }
1654
1655 static void timer_ext_event(struct mpu_config *devc, int event, int parm)
1656 {
1657         int midi_dev = devc->devno;
1658
1659         if (!devc->timer_flag)
1660                 return;
1661
1662         switch (event)
1663         {
1664                 case TMR_CLOCK:
1665                         printk("<MIDI clk>");
1666                         break;
1667
1668                 case TMR_START:
1669                         printk("Ext MIDI start\n");
1670                         if (!tmr_running)
1671                         {
1672                                 if (timer_mode & TMR_EXTERNAL)
1673                                 {
1674                                         tmr_running = 1;
1675                                         setup_metronome(midi_dev);
1676                                         next_event_time = 0;
1677                                         STORE(SEQ_START_TIMER());
1678                                 }
1679                         }
1680                         break;
1681
1682                 case TMR_STOP:
1683                         printk("Ext MIDI stop\n");
1684                         if (timer_mode & TMR_EXTERNAL)
1685                         {
1686                                 tmr_running = 0;
1687                                 stop_metronome(midi_dev);
1688                                 STORE(SEQ_STOP_TIMER());
1689                         }
1690                         break;
1691
1692                 case TMR_CONTINUE:
1693                         printk("Ext MIDI continue\n");
1694                         if (timer_mode & TMR_EXTERNAL)
1695                         {
1696                                 tmr_running = 1;
1697                                 setup_metronome(midi_dev);
1698                                 STORE(SEQ_CONTINUE_TIMER());
1699                         }
1700                         break;
1701
1702                 case TMR_SPP:
1703                         printk("Songpos: %d\n", parm);
1704                         if (timer_mode & TMR_EXTERNAL)
1705                         {
1706                                 STORE(SEQ_SONGPOS(parm));
1707                         }
1708                         break;
1709         }
1710 }
1711
1712 static int mpu_timer_init(int midi_dev)
1713 {
1714         struct mpu_config *devc;
1715         int n;
1716
1717         devc = &dev_conf[midi_dev];
1718
1719         if (timer_initialized)
1720                 return -1;      /* There is already a similar timer */
1721
1722         timer_initialized = 1;
1723
1724         mpu_timer.devlink = midi_dev;
1725         dev_conf[midi_dev].timer_flag = 1;
1726
1727         n = sound_alloc_timerdev();
1728         if (n == -1)
1729                 n = 0;
1730         sound_timer_devs[n] = &mpu_timer;
1731
1732         if (devc->version < 0x20)       /* Original MPU-401 */
1733                 timer_caps = TMR_INTERNAL | TMR_EXTERNAL | TMR_MODE_FSK | TMR_MODE_MIDI;
1734         else
1735         {
1736                 /*
1737                  * The version number 2.0 is used (at least) by the
1738                  * MusicQuest cards and the Roland Super-MPU.
1739                  *
1740                  * MusicQuest has given a special meaning to the bits of the
1741                  * revision number. The Super-MPU returns 0.
1742                  */
1743
1744                 if (devc->revision)
1745                         timer_caps |= TMR_EXTERNAL | TMR_MODE_MIDI;
1746
1747                 if (devc->revision & 0x02)
1748                         timer_caps |= TMR_MODE_CLS;
1749
1750
1751                 if (devc->revision & 0x40)
1752                         max_timebase = 10;      /* Has the 216 and 240 ppqn modes */
1753         }
1754
1755         timer_mode = (TMR_INTERNAL | TMR_MODE_MIDI) & timer_caps;
1756         return n;
1757
1758 }
1759
1760 EXPORT_SYMBOL(probe_mpu401);
1761 EXPORT_SYMBOL(attach_mpu401);
1762 EXPORT_SYMBOL(unload_mpu401);
1763 EXPORT_SYMBOL(intchk_mpu401);
1764 EXPORT_SYMBOL(mpuintr);
1765
1766 static struct address_info cfg;
1767
1768 static int io = -1;
1769 static int irq = -1;
1770
1771 MODULE_PARM(irq, "i");
1772 MODULE_PARM(io, "i");
1773
1774 static int __init init_mpu401(void)
1775 {
1776         int ret;
1777         /* Can be loaded either for module use or to provide functions
1778            to others */
1779         if (io != -1 && irq != -1) {
1780                 cfg.irq = irq;
1781                 cfg.io_base = io;
1782                 if (probe_mpu401(&cfg) == 0)
1783                         return -ENODEV;
1784                 if ((ret = attach_mpu401(&cfg, THIS_MODULE)))
1785                         return ret;
1786         }
1787
1788         return 0;
1789 }
1790
1791 static void __exit cleanup_mpu401(void)
1792 {
1793         if (io != -1 && irq != -1) {
1794                 /* Check for use by, for example, sscape driver */
1795                 unload_mpu401(&cfg);
1796         }
1797 }
1798
1799 module_init(init_mpu401);
1800 module_exit(cleanup_mpu401);
1801
1802 #ifndef MODULE
1803 static int __init setup_mpu401(char *str)
1804 {
1805         /* io, irq */
1806         int ints[3];
1807
1808         str = get_options(str, ARRAY_SIZE(ints), ints);
1809
1810         io = ints[1];
1811         irq = ints[2];
1812
1813         return 1;
1814 }
1815
1816 __setup("mpu401=", setup_mpu401);
1817 #endif
1818 MODULE_LICENSE("GPL");