drivers/staging/comedi/drivers/quatech_daqp_cs.c

   1 /*======================================================================
   2
   3     comedi/drivers/quatech_daqp_cs.c
   4
   5     Quatech DAQP PCMCIA data capture cards COMEDI client driver
   6     Copyright (C) 2000, 2003 Brent Baccala <baccala@freesoft.org>
   7     The DAQP interface code in this file is released into the public domain.
   8
   9     COMEDI - Linux Control and Measurement Device Interface
  10     Copyright (C) 1998 David A. Schleef <ds@schleef.org>
  11     http://www.comedi.org/
  12
  13     quatech_daqp_cs.c 1.10
  14
  15     Documentation for the DAQP PCMCIA cards can be found on Quatech's site:
  16
  17                 ftp://ftp.quatech.com/Manuals/daqp-208.pdf
  18
  19     This manual is for both the DAQP-208 and the DAQP-308.
  20
  21     What works:
  22
  23         - A/D conversion
  24             - 8 channels
  25             - 4 gain ranges
  26             - ground ref or differential
  27             - single-shot and timed both supported
  28         - D/A conversion, single-shot
  29         - digital I/O
  30
  31     What doesn't:
  32
  33         - any kind of triggering - external or D/A channel 1
  34         - the card's optional expansion board
  35         - the card's timer (for anything other than A/D conversion)
  36         - D/A update modes other than immediate (i.e, timed)
  37         - fancier timing modes
  38         - setting card's FIFO buffer thresholds to anything but default
  39
  40 ======================================================================*/
  41
  42 /*
  43 Driver: quatech_daqp_cs
  44 Description: Quatech DAQP PCMCIA data capture cards
  45 Author: Brent Baccala <baccala@freesoft.org>
  46 Status: works
  47 Devices: [Quatech] DAQP-208 (daqp), DAQP-308
  48 */
  49
  50 #include "../comedidev.h"
  51 #include <linux/semaphore.h>
  52
  53 #include <pcmcia/cistpl.h>
  54 #include <pcmcia/cisreg.h>
  55 #include <pcmcia/ds.h>
  56
  57 #include <linux/completion.h>
  58
  59 /* Maximum number of separate DAQP devices we'll allow */
  60 #define MAX_DEV         4
  61
  62 struct local_info_t {
  63         struct pcmcia_device *link;
  64         int stop;
  65         int table_index;
  66         char board_name[32];
  67
  68         enum { semaphore, buffer } interrupt_mode;
  69
  70         struct completion eos;
  71
  72         struct comedi_device *dev;
  73         struct comedi_subdevice *s;
  74         int count;
  75 };
  76
  77 /* A list of "instances" of the device. */
  78
  79 static struct local_info_t *dev_table[MAX_DEV] = { NULL, /* ... */  };
  80
  81 /* The DAQP communicates with the system through a 16 byte I/O window. */
  82
  83 #define DAQP_FIFO_SIZE          4096
  84
  85 #define DAQP_FIFO               0
  86 #define DAQP_SCANLIST           1
  87 #define DAQP_CONTROL            2
  88 #define DAQP_STATUS             2
  89 #define DAQP_DIGITAL_IO         3
  90 #define DAQP_PACER_LOW          4
  91 #define DAQP_PACER_MID          5
  92 #define DAQP_PACER_HIGH         6
  93 #define DAQP_COMMAND            7
  94 #define DAQP_DA                 8
  95 #define DAQP_TIMER              10
  96 #define DAQP_AUX                15
  97
  98 #define DAQP_SCANLIST_DIFFERENTIAL      0x4000
  99 #define DAQP_SCANLIST_GAIN(x)           ((x)<<12)
 100 #define DAQP_SCANLIST_CHANNEL(x)        ((x)<<8)
 101 #define DAQP_SCANLIST_START             0x0080
 102 #define DAQP_SCANLIST_EXT_GAIN(x)       ((x)<<4)
 103 #define DAQP_SCANLIST_EXT_CHANNEL(x)    (x)
 104
 105 #define DAQP_CONTROL_PACER_100kHz       0xc0
 106 #define DAQP_CONTROL_PACER_1MHz         0x80
 107 #define DAQP_CONTROL_PACER_5MHz         0x40
 108 #define DAQP_CONTROL_PACER_EXTERNAL     0x00
 109 #define DAQP_CONTORL_EXPANSION          0x20
 110 #define DAQP_CONTROL_EOS_INT_ENABLE     0x10
 111 #define DAQP_CONTROL_FIFO_INT_ENABLE    0x08
 112 #define DAQP_CONTROL_TRIGGER_ONESHOT    0x00
 113 #define DAQP_CONTROL_TRIGGER_CONTINUOUS 0x04
 114 #define DAQP_CONTROL_TRIGGER_INTERNAL   0x00
 115 #define DAQP_CONTROL_TRIGGER_EXTERNAL   0x02
 116 #define DAQP_CONTROL_TRIGGER_RISING     0x00
 117 #define DAQP_CONTROL_TRIGGER_FALLING    0x01
 118
 119 #define DAQP_STATUS_IDLE                0x80
 120 #define DAQP_STATUS_RUNNING             0x40
 121 #define DAQP_STATUS_EVENTS              0x38
 122 #define DAQP_STATUS_DATA_LOST           0x20
 123 #define DAQP_STATUS_END_OF_SCAN         0x10
 124 #define DAQP_STATUS_FIFO_THRESHOLD      0x08
 125 #define DAQP_STATUS_FIFO_FULL           0x04
 126 #define DAQP_STATUS_FIFO_NEARFULL       0x02
 127 #define DAQP_STATUS_FIFO_EMPTY          0x01
 128
 129 #define DAQP_COMMAND_ARM                0x80
 130 #define DAQP_COMMAND_RSTF               0x40
 131 #define DAQP_COMMAND_RSTQ               0x20
 132 #define DAQP_COMMAND_STOP               0x10
 133 #define DAQP_COMMAND_LATCH              0x08
 134 #define DAQP_COMMAND_100kHz             0x00
 135 #define DAQP_COMMAND_50kHz              0x02
 136 #define DAQP_COMMAND_25kHz              0x04
 137 #define DAQP_COMMAND_FIFO_DATA          0x01
 138 #define DAQP_COMMAND_FIFO_PROGRAM       0x00
 139
 140 #define DAQP_AUX_TRIGGER_TTL            0x00
 141 #define DAQP_AUX_TRIGGER_ANALOG         0x80
 142 #define DAQP_AUX_TRIGGER_PRETRIGGER     0x40
 143 #define DAQP_AUX_TIMER_INT_ENABLE       0x20
 144 #define DAQP_AUX_TIMER_RELOAD           0x00
 145 #define DAQP_AUX_TIMER_PAUSE            0x08
 146 #define DAQP_AUX_TIMER_GO               0x10
 147 #define DAQP_AUX_TIMER_GO_EXTERNAL      0x18
 148 #define DAQP_AUX_TIMER_EXTERNAL_SRC     0x04
 149 #define DAQP_AUX_TIMER_INTERNAL_SRC     0x00
 150 #define DAQP_AUX_DA_DIRECT              0x00
 151 #define DAQP_AUX_DA_OVERFLOW            0x01
 152 #define DAQP_AUX_DA_EXTERNAL            0x02
 153 #define DAQP_AUX_DA_PACER               0x03
 154
 155 #define DAQP_AUX_RUNNING                0x80
 156 #define DAQP_AUX_TRIGGERED              0x40
 157 #define DAQP_AUX_DA_BUFFER              0x20
 158 #define DAQP_AUX_TIMER_OVERFLOW         0x10
 159 #define DAQP_AUX_CONVERSION             0x08
 160 #define DAQP_AUX_DATA_LOST              0x04
 161 #define DAQP_AUX_FIFO_NEARFULL          0x02
 162 #define DAQP_AUX_FIFO_EMPTY             0x01
 163
 164 /* These range structures tell COMEDI how the sample values map to
 165  * voltages.  The A/D converter has four        .ranges = +/- 10V through
 166  * +/- 1.25V, and the D/A converter has only    .one = +/- 5V.
 167  */
 168
 169 static const struct comedi_lrange range_daqp_ai = { 4, {
 170                                                         BIP_RANGE(10),
 171                                                         BIP_RANGE(5),
 172                                                         BIP_RANGE(2.5),
 173                                                         BIP_RANGE(1.25)
 174                                                         }
 175 };
 176
 177 static const struct comedi_lrange range_daqp_ao = { 1, {BIP_RANGE(5)} };
 178
 179 /*====================================================================*/
 180
 181 /* comedi interface code */
 182
 183 static int daqp_attach(struct comedi_device *dev, struct comedi_devconfig *it);
 184 static int daqp_detach(struct comedi_device *dev);
 185 static struct comedi_driver driver_daqp = {
 186         .driver_name = "quatech_daqp_cs",
 187         .module = THIS_MODULE,
 188         .attach = daqp_attach,
 189         .detach = daqp_detach,
 190 };
 191
 192 #ifdef DAQP_DEBUG
 193
 194 static void daqp_dump(struct comedi_device *dev)
 195 {
 196         printk(KERN_INFO "DAQP: status %02x; aux status %02x\n",
 197                inb(dev->iobase + DAQP_STATUS), inb(dev->iobase + DAQP_AUX));
 198 }
 199
 200 static void hex_dump(char *str, void *ptr, int len)
 201 {
 202         unsigned char *cptr = ptr;
 203         int i;
 204
 205         printk(str);
 206
 207         for (i = 0; i < len; i++) {
 208                 if (i % 16 == 0)
 209                         printk("\n%p:", cptr);
 210
 211                 printk(" %02x", *(cptr++));
 212         }
 213         printk("\n");
 214 }
 215
 216 #endif
 217
 218 /* Cancel a running acquisition */
 219
 220 static int daqp_ai_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
 221 {
 222         struct local_info_t *local = (struct local_info_t *)s->private;
 223
 224         if (local->stop)
 225                 return -EIO;
 226
 227
 228         outb(DAQP_COMMAND_STOP, dev->iobase + DAQP_COMMAND);
 229
 230         /* flush any linguring data in FIFO - superfluous here */
 231         /* outb(DAQP_COMMAND_RSTF, dev->iobase+DAQP_COMMAND); */
 232
 233         local->interrupt_mode = semaphore;
 234
 235         return 0;
 236 }
 237
 238 /* Interrupt handler
 239  *
 240  * Operates in one of two modes.  If local->interrupt_mode is
 241  * 'semaphore', just signal the local->eos completion and return
 242  * (one-shot mode).  Otherwise (continuous mode), read data in from
 243  * the card, transfer it to the buffer provided by the higher-level
 244  * comedi kernel module, and signal various comedi callback routines,
 245  * which run pretty quick.
 246  */
 247 static enum irqreturn daqp_interrupt(int irq, void *dev_id)
 248 {
 249         struct local_info_t *local = (struct local_info_t *)dev_id;
 250         struct comedi_device *dev;
 251         struct comedi_subdevice *s;
 252         int loop_limit = 10000;
 253         int status;
 254
 255         if (local == NULL) {
 256                 printk(KERN_WARNING
 257                        "daqp_interrupt(): irq %d for unknown device.\n", irq);
 258                 return IRQ_NONE;
 259         }
 260
 261         dev = local->dev;
 262         if (dev == NULL) {
 263                 printk(KERN_WARNING "daqp_interrupt(): NULL comedi_device.\n");
 264                 return IRQ_NONE;
 265         }
 266
 267         if (!dev->attached) {
 268                 printk(KERN_WARNING
 269                        "daqp_interrupt(): struct comedi_device not yet attached.\n");
 270                 return IRQ_NONE;
 271         }
 272
 273         s = local->s;
 274         if (s == NULL) {
 275                 printk(KERN_WARNING
 276                        "daqp_interrupt(): NULL comedi_subdevice.\n");
 277                 return IRQ_NONE;
 278         }
 279
 280         if ((struct local_info_t *)s->private != local) {
 281                 printk(KERN_WARNING
 282                        "daqp_interrupt(): invalid comedi_subdevice.\n");
 283                 return IRQ_NONE;
 284         }
 285
 286         switch (local->interrupt_mode) {
 287
 288         case semaphore:
 289
 290                 complete(&local->eos);
 291                 break;
 292
 293         case buffer:
 294
 295                 while (!((status = inb(dev->iobase + DAQP_STATUS))
 296                          & DAQP_STATUS_FIFO_EMPTY)) {
 297
 298                         short data;
 299
 300                         if (status & DAQP_STATUS_DATA_LOST) {
 301                                 s->async->events |=
 302                                     COMEDI_CB_EOA | COMEDI_CB_OVERFLOW;
 303                                 printk("daqp: data lost\n");
 304                                 daqp_ai_cancel(dev, s);
 305                                 break;
 306                         }
 307
 308                         data = inb(dev->iobase + DAQP_FIFO);
 309                         data |= inb(dev->iobase + DAQP_FIFO) << 8;
 310                         data ^= 0x8000;
 311
 312                         comedi_buf_put(s->async, data);
 313
 314                         /* If there's a limit, decrement it
 315                          * and stop conversion if zero
 316                          */
 317
 318                         if (local->count > 0) {
 319                                 local->count--;
 320                                 if (local->count == 0) {
 321                                         daqp_ai_cancel(dev, s);
 322                                         s->async->events |= COMEDI_CB_EOA;
 323                                         break;
 324                                 }
 325                         }
 326
 327                         if ((loop_limit--) <= 0)
 328                                 break;
 329                 }
 330
 331                 if (loop_limit <= 0) {
 332                         printk(KERN_WARNING
 333                                "loop_limit reached in daqp_interrupt()\n");
 334                         daqp_ai_cancel(dev, s);
 335                         s->async->events |= COMEDI_CB_EOA | COMEDI_CB_ERROR;
 336                 }
 337
 338                 s->async->events |= COMEDI_CB_BLOCK;
 339
 340                 comedi_event(dev, s);
 341         }
 342         return IRQ_HANDLED;
 343 }
 344
 345 /* One-shot analog data acquisition routine */
 346
 347 static int daqp_ai_insn_read(struct comedi_device *dev,
 348                              struct comedi_subdevice *s,
 349                              struct comedi_insn *insn, unsigned int *data)
 350 {
 351         struct local_info_t *local = (struct local_info_t *)s->private;
 352         int i;
 353         int v;
 354         int counter = 10000;
 355
 356         if (local->stop)
 357                 return -EIO;
 358
 359
 360         /* Stop any running conversion */
 361         daqp_ai_cancel(dev, s);
 362
 363         outb(0, dev->iobase + DAQP_AUX);
 364
 365         /* Reset scan list queue */
 366         outb(DAQP_COMMAND_RSTQ, dev->iobase + DAQP_COMMAND);
 367
 368         /* Program one scan list entry */
 369
 370         v = DAQP_SCANLIST_CHANNEL(CR_CHAN(insn->chanspec))
 371             | DAQP_SCANLIST_GAIN(CR_RANGE(insn->chanspec));
 372
 373         if (CR_AREF(insn->chanspec) == AREF_DIFF)
 374                 v |= DAQP_SCANLIST_DIFFERENTIAL;
 375
 376
 377         v |= DAQP_SCANLIST_START;
 378
 379         outb(v & 0xff, dev->iobase + DAQP_SCANLIST);
 380         outb(v >> 8, dev->iobase + DAQP_SCANLIST);
 381
 382         /* Reset data FIFO (see page 28 of DAQP User's Manual) */
 383
 384         outb(DAQP_COMMAND_RSTF, dev->iobase + DAQP_COMMAND);
 385
 386         /* Set trigger */
 387
 388         v = DAQP_CONTROL_TRIGGER_ONESHOT | DAQP_CONTROL_TRIGGER_INTERNAL
 389             | DAQP_CONTROL_PACER_100kHz | DAQP_CONTROL_EOS_INT_ENABLE;
 390
 391         outb(v, dev->iobase + DAQP_CONTROL);
 392
 393         /* Reset any pending interrupts (my card has a tendency to require
 394          * require multiple reads on the status register to achieve this)
 395          */
 396
 397         while (--counter
 398                && (inb(dev->iobase + DAQP_STATUS) & DAQP_STATUS_EVENTS)) ;
 399         if (!counter) {
 400                 printk("daqp: couldn't clear interrupts in status register\n");
 401                 return -1;
 402         }
 403
 404         init_completion(&local->eos);
 405         local->interrupt_mode = semaphore;
 406         local->dev = dev;
 407         local->s = s;
 408
 409         for (i = 0; i < insn->n; i++) {
 410
 411                 /* Start conversion */
 412                 outb(DAQP_COMMAND_ARM | DAQP_COMMAND_FIFO_DATA,
 413                      dev->iobase + DAQP_COMMAND);
 414
 415                 /* Wait for interrupt service routine to unblock completion */
 416                 /* Maybe could use a timeout here, but it's interruptible */
 417                 if (wait_for_completion_interruptible(&local->eos))
 418                         return -EINTR;
 419
 420                 data[i] = inb(dev->iobase + DAQP_FIFO);
 421                 data[i] |= inb(dev->iobase + DAQP_FIFO) << 8;
 422                 data[i] ^= 0x8000;
 423         }
 424
 425         return insn->n;
 426 }
 427
 428 /* This function converts ns nanoseconds to a counter value suitable
 429  * for programming the device.  We always use the DAQP's 5 MHz clock,
 430  * which with its 24-bit counter, allows values up to 84 seconds.
 431  * Also, the function adjusts ns so that it cooresponds to the actual
 432  * time that the device will use.
 433  */
 434
 435 static int daqp_ns_to_timer(unsigned int *ns, int round)
 436 {
 437         int timer;
 438
 439         timer = *ns / 200;
 440         *ns = timer * 200;
 441
 442         return timer;
 443 }
 444
 445 /* cmdtest tests a particular command to see if it is valid.
 446  * Using the cmdtest ioctl, a user can create a valid cmd
 447  * and then have it executed by the cmd ioctl.
 448  *
 449  * cmdtest returns 1,2,3,4 or 0, depending on which tests
 450  * the command passes.
 451  */
 452
 453 static int daqp_ai_cmdtest(struct comedi_device *dev,
 454                            struct comedi_subdevice *s, struct comedi_cmd *cmd)
 455 {
 456         int err = 0;
 457         int tmp;
 458
 459         /* step 1: make sure trigger sources are trivially valid */
 460
 461         tmp = cmd->start_src;
 462         cmd->start_src &= TRIG_NOW;
 463         if (!cmd->start_src || tmp != cmd->start_src)
 464                 err++;
 465
 466         tmp = cmd->scan_begin_src;
 467         cmd->scan_begin_src &= TRIG_TIMER | TRIG_FOLLOW;
 468         if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
 469                 err++;
 470
 471         tmp = cmd->convert_src;
 472         cmd->convert_src &= TRIG_TIMER | TRIG_NOW;
 473         if (!cmd->convert_src || tmp != cmd->convert_src)
 474                 err++;
 475
 476         tmp = cmd->scan_end_src;
 477         cmd->scan_end_src &= TRIG_COUNT;
 478         if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
 479                 err++;
 480
 481         tmp = cmd->stop_src;
 482         cmd->stop_src &= TRIG_COUNT | TRIG_NONE;
 483         if (!cmd->stop_src || tmp != cmd->stop_src)
 484                 err++;
 485
 486         if (err)
 487                 return 1;
 488
 489         /*
 490          * step 2: make sure trigger sources
 491          * are unique and mutually compatible
 492          */
 493
 494         /* note that mutual compatibility is not an issue here */
 495         if (cmd->scan_begin_src != TRIG_TIMER &&
 496             cmd->scan_begin_src != TRIG_FOLLOW)
 497                 err++;
 498         if (cmd->convert_src != TRIG_NOW && cmd->convert_src != TRIG_TIMER)
 499                 err++;
 500         if (cmd->scan_begin_src == TRIG_FOLLOW && cmd->convert_src == TRIG_NOW)
 501                 err++;
 502         if (cmd->stop_src != TRIG_COUNT && cmd->stop_src != TRIG_NONE)
 503                 err++;
 504
 505         if (err)
 506                 return 2;
 507
 508         /* step 3: make sure arguments are trivially compatible */
 509
 510         if (cmd->start_arg != 0) {
 511                 cmd->start_arg = 0;
 512                 err++;
 513         }
 514 #define MAX_SPEED       10000   /* 100 kHz - in nanoseconds */
 515
 516         if (cmd->scan_begin_src == TRIG_TIMER
 517             && cmd->scan_begin_arg < MAX_SPEED) {
 518                 cmd->scan_begin_arg = MAX_SPEED;
 519                 err++;
 520         }
 521
 522         /* If both scan_begin and convert are both timer values, the only
 523          * way that can make sense is if the scan time is the number of
 524          * conversions times the convert time
 525          */
 526
 527         if (cmd->scan_begin_src == TRIG_TIMER && cmd->convert_src == TRIG_TIMER
 528             && cmd->scan_begin_arg != cmd->convert_arg * cmd->scan_end_arg) {
 529                 err++;
 530         }
 531
 532         if (cmd->convert_src == TRIG_TIMER && cmd->convert_arg < MAX_SPEED) {
 533                 cmd->convert_arg = MAX_SPEED;
 534                 err++;
 535         }
 536
 537         if (cmd->scan_end_arg != cmd->chanlist_len) {
 538                 cmd->scan_end_arg = cmd->chanlist_len;
 539                 err++;
 540         }
 541         if (cmd->stop_src == TRIG_COUNT) {
 542                 if (cmd->stop_arg > 0x00ffffff) {
 543                         cmd->stop_arg = 0x00ffffff;
 544                         err++;
 545                 }
 546         } else {
 547                 /* TRIG_NONE */
 548                 if (cmd->stop_arg != 0) {
 549                         cmd->stop_arg = 0;
 550                         err++;
 551                 }
 552         }
 553
 554         if (err)
 555                 return 3;
 556
 557         /* step 4: fix up any arguments */
 558
 559         if (cmd->scan_begin_src == TRIG_TIMER) {
 560                 tmp = cmd->scan_begin_arg;
 561                 daqp_ns_to_timer(&cmd->scan_begin_arg,
 562                                  cmd->flags & TRIG_ROUND_MASK);
 563                 if (tmp != cmd->scan_begin_arg)
 564                         err++;
 565         }
 566
 567         if (cmd->convert_src == TRIG_TIMER) {
 568                 tmp = cmd->convert_arg;
 569                 daqp_ns_to_timer(&cmd->convert_arg,
 570                                  cmd->flags & TRIG_ROUND_MASK);
 571                 if (tmp != cmd->convert_arg)
 572                         err++;
 573         }
 574
 575         if (err)
 576                 return 4;
 577
 578         return 0;
 579 }
 580
 581 static int daqp_ai_cmd(struct comedi_device *dev, struct comedi_subdevice *s)
 582 {
 583         struct local_info_t *local = (struct local_info_t *)s->private;
 584         struct comedi_cmd *cmd = &s->async->cmd;
 585         int counter;
 586         int scanlist_start_on_every_entry;
 587         int threshold;
 588
 589         int i;
 590         int v;
 591
 592         if (local->stop)
 593                 return -EIO;
 594
 595
 596         /* Stop any running conversion */
 597         daqp_ai_cancel(dev, s);
 598
 599         outb(0, dev->iobase + DAQP_AUX);
 600
 601         /* Reset scan list queue */
 602         outb(DAQP_COMMAND_RSTQ, dev->iobase + DAQP_COMMAND);
 603
 604         /* Program pacer clock
 605          *
 606          * There's two modes we can operate in.  If convert_src is
 607          * TRIG_TIMER, then convert_arg specifies the time between
 608          * each conversion, so we program the pacer clock to that
 609          * frequency and set the SCANLIST_START bit on every scanlist
 610          * entry.  Otherwise, convert_src is TRIG_NOW, which means
 611          * we want the fastest possible conversions, scan_begin_src
 612          * is TRIG_TIMER, and scan_begin_arg specifies the time between
 613          * each scan, so we program the pacer clock to this frequency
 614          * and only set the SCANLIST_START bit on the first entry.
 615          */
 616
 617         if (cmd->convert_src == TRIG_TIMER) {
 618                 counter = daqp_ns_to_timer(&cmd->convert_arg,
 619                                                cmd->flags & TRIG_ROUND_MASK);
 620                 outb(counter & 0xff, dev->iobase + DAQP_PACER_LOW);
 621                 outb((counter >> 8) & 0xff, dev->iobase + DAQP_PACER_MID);
 622                 outb((counter >> 16) & 0xff, dev->iobase + DAQP_PACER_HIGH);
 623                 scanlist_start_on_every_entry = 1;
 624         } else {
 625                 counter = daqp_ns_to_timer(&cmd->scan_begin_arg,
 626                                                cmd->flags & TRIG_ROUND_MASK);
 627                 outb(counter & 0xff, dev->iobase + DAQP_PACER_LOW);
 628                 outb((counter >> 8) & 0xff, dev->iobase + DAQP_PACER_MID);
 629                 outb((counter >> 16) & 0xff, dev->iobase + DAQP_PACER_HIGH);
 630                 scanlist_start_on_every_entry = 0;
 631         }
 632
 633         /* Program scan list */
 634
 635         for (i = 0; i < cmd->chanlist_len; i++) {
 636
 637                 int chanspec = cmd->chanlist[i];
 638
 639                 /* Program one scan list entry */
 640
 641                 v = DAQP_SCANLIST_CHANNEL(CR_CHAN(chanspec))
 642                     | DAQP_SCANLIST_GAIN(CR_RANGE(chanspec));
 643
 644                 if (CR_AREF(chanspec) == AREF_DIFF)
 645                         v |= DAQP_SCANLIST_DIFFERENTIAL;
 646
 647                 if (i == 0 || scanlist_start_on_every_entry)
 648                         v |= DAQP_SCANLIST_START;
 649
 650                 outb(v & 0xff, dev->iobase + DAQP_SCANLIST);
 651                 outb(v >> 8, dev->iobase + DAQP_SCANLIST);
 652         }
 653
 654         /* Now it's time to program the FIFO threshold, basically the
 655          * number of samples the card will buffer before it interrupts
 656          * the CPU.
 657          *
 658          * If we don't have a stop count, then use half the size of
 659          * the FIFO (the manufacturer's recommendation).  Consider
 660          * that the FIFO can hold 2K samples (4K bytes).  With the
 661          * threshold set at half the FIFO size, we have a margin of
 662          * error of 1024 samples.  At the chip's maximum sample rate
 663          * of 100,000 Hz, the CPU would have to delay interrupt
 664          * service for a full 10 milliseconds in order to lose data
 665          * here (as opposed to higher up in the kernel).  I've never
 666          * seen it happen.  However, for slow sample rates it may
 667          * buffer too much data and introduce too much delay for the
 668          * user application.
 669          *
 670          * If we have a stop count, then things get more interesting.
 671          * If the stop count is less than the FIFO size (actually
 672          * three-quarters of the FIFO size - see below), we just use
 673          * the stop count itself as the threshold, the card interrupts
 674          * us when that many samples have been taken, and we kill the
 675          * acquisition at that point and are done.  If the stop count
 676          * is larger than that, then we divide it by 2 until it's less
 677          * than three quarters of the FIFO size (we always leave the
 678          * top quarter of the FIFO as protection against sluggish CPU
 679          * interrupt response) and use that as the threshold.  So, if
 680          * the stop count is 4000 samples, we divide by two twice to
 681          * get 1000 samples, use that as the threshold, take four
 682          * interrupts to get our 4000 samples and are done.
 683          *
 684          * The algorithm could be more clever.  For example, if 81000
 685          * samples are requested, we could set the threshold to 1500
 686          * samples and take 54 interrupts to get 81000.  But 54 isn't
 687          * a power of two, so this algorithm won't find that option.
 688          * Instead, it'll set the threshold at 1266 and take 64
 689          * interrupts to get 81024 samples, of which the last 24 will
 690          * be discarded... but we won't get the last interrupt until
 691          * they've been collected.  To find the first option, the
 692          * computer could look at the prime decomposition of the
 693          * sample count (81000 = 3^4 * 5^3 * 2^3) and factor it into a
 694          * threshold (1500 = 3 * 5^3 * 2^2) and an interrupt count (54
 695          * = 3^3 * 2).  Hmmm... a one-line while loop or prime
 696          * decomposition of integers... I'll leave it the way it is.
 697          *
 698          * I'll also note a mini-race condition before ignoring it in
 699          * the code.  Let's say we're taking 4000 samples, as before.
 700          * After 1000 samples, we get an interrupt.  But before that
 701          * interrupt is completely serviced, another sample is taken
 702          * and loaded into the FIFO.  Since the interrupt handler
 703          * empties the FIFO before returning, it will read 1001 samples.
 704          * If that happens four times, we'll end up taking 4004 samples,
 705          * not 4000.  The interrupt handler will discard the extra four
 706          * samples (by halting the acquisition with four samples still
 707          * in the FIFO), but we will have to wait for them.
 708          *
 709          * In short, this code works pretty well, but for either of
 710          * the two reasons noted, might end up waiting for a few more
 711          * samples than actually requested.  Shouldn't make too much
 712          * of a difference.
 713          */
 714
 715         /* Save away the number of conversions we should perform, and
 716          * compute the FIFO threshold (in bytes, not samples - that's
 717          * why we multiple local->count by 2 = sizeof(sample))
 718          */
 719
 720         if (cmd->stop_src == TRIG_COUNT) {
 721                 local->count = cmd->stop_arg * cmd->scan_end_arg;
 722                 threshold = 2 * local->count;
 723                 while (threshold > DAQP_FIFO_SIZE * 3 / 4)
 724                         threshold /= 2;
 725         } else {
 726                 local->count = -1;
 727                 threshold = DAQP_FIFO_SIZE / 2;
 728         }
 729
 730         /* Reset data FIFO (see page 28 of DAQP User's Manual) */
 731
 732         outb(DAQP_COMMAND_RSTF, dev->iobase + DAQP_COMMAND);
 733
 734         /* Set FIFO threshold.  First two bytes are near-empty
 735          * threshold, which is unused; next two bytes are near-full
 736          * threshold.  We computed the number of bytes we want in the
 737          * FIFO when the interrupt is generated, what the card wants
 738          * is actually the number of available bytes left in the FIFO
 739          * when the interrupt is to happen.
 740          */
 741
 742         outb(0x00, dev->iobase + DAQP_FIFO);
 743         outb(0x00, dev->iobase + DAQP_FIFO);
 744
 745         outb((DAQP_FIFO_SIZE - threshold) & 0xff, dev->iobase + DAQP_FIFO);
 746         outb((DAQP_FIFO_SIZE - threshold) >> 8, dev->iobase + DAQP_FIFO);
 747
 748         /* Set trigger */
 749
 750         v = DAQP_CONTROL_TRIGGER_CONTINUOUS | DAQP_CONTROL_TRIGGER_INTERNAL
 751             | DAQP_CONTROL_PACER_5MHz | DAQP_CONTROL_FIFO_INT_ENABLE;
 752
 753         outb(v, dev->iobase + DAQP_CONTROL);
 754
 755         /* Reset any pending interrupts (my card has a tendency to require
 756          * require multiple reads on the status register to achieve this)
 757          */
 758         counter = 100;
 759         while (--counter
 760                && (inb(dev->iobase + DAQP_STATUS) & DAQP_STATUS_EVENTS)) ;
 761         if (!counter) {
 762                 printk(KERN_ERR
 763                        "daqp: couldn't clear interrupts in status register\n");
 764                 return -1;
 765         }
 766
 767         local->interrupt_mode = buffer;
 768         local->dev = dev;
 769         local->s = s;
 770
 771         /* Start conversion */
 772         outb(DAQP_COMMAND_ARM | DAQP_COMMAND_FIFO_DATA,
 773              dev->iobase + DAQP_COMMAND);
 774
 775         return 0;
 776 }
 777
 778 /* Single-shot analog output routine */
 779
 780 static int daqp_ao_insn_write(struct comedi_device *dev,
 781                               struct comedi_subdevice *s,
 782                               struct comedi_insn *insn, unsigned int *data)
 783 {
 784         struct local_info_t *local = (struct local_info_t *)s->private;
 785         int d;
 786         unsigned int chan;
 787
 788         if (local->stop)
 789                 return -EIO;
 790
 791         chan = CR_CHAN(insn->chanspec);
 792         d = data[0];
 793         d &= 0x0fff;
 794         d ^= 0x0800;            /* Flip the sign */
 795         d |= chan << 12;
 796
 797         /* Make sure D/A update mode is direct update */
 798         outb(0, dev->iobase + DAQP_AUX);
 799
 800         outw(d, dev->iobase + DAQP_DA);
 801
 802         return 1;
 803 }
 804
 805 /* Digital input routine */
 806
 807 static int daqp_di_insn_read(struct comedi_device *dev,
 808                              struct comedi_subdevice *s,
 809                              struct comedi_insn *insn, unsigned int *data)
 810 {
 811         struct local_info_t *local = (struct local_info_t *)s->private;
 812
 813         if (local->stop)
 814                 return -EIO;
 815
 816         data[0] = inb(dev->iobase + DAQP_DIGITAL_IO);
 817
 818         return 1;
 819 }
 820
 821 /* Digital output routine */
 822
 823 static int daqp_do_insn_write(struct comedi_device *dev,
 824                               struct comedi_subdevice *s,
 825                               struct comedi_insn *insn, unsigned int *data)
 826 {
 827         struct local_info_t *local = (struct local_info_t *)s->private;
 828
 829         if (local->stop)
 830                 return -EIO;
 831
 832         outw(data[0] & 0xf, dev->iobase + DAQP_DIGITAL_IO);
 833
 834         return 1;
 835 }
 836
 837 /* daqp_attach is called via comedi_config to attach a comedi device
 838  * to a /dev/comedi*.  Note that this is different from daqp_cs_attach()
 839  * which is called by the pcmcia subsystem to attach the PCMCIA card
 840  * when it is inserted.
 841  */
 842
 843 static int daqp_attach(struct comedi_device *dev, struct comedi_devconfig *it)
 844 {
 845         int ret;
 846         struct local_info_t *local = dev_table[it->options[0]];
 847         struct comedi_subdevice *s;
 848
 849         if (it->options[0] < 0 || it->options[0] >= MAX_DEV || !local) {
 850                 printk("comedi%d: No such daqp device %d\n",
 851                        dev->minor, it->options[0]);
 852                 return -EIO;
 853         }
 854
 855         /* Typically brittle code that I don't completely understand,
 856          * but "it works on my card".  The intent is to pull the model
 857          * number of the card out the PCMCIA CIS and stash it away as
 858          * the COMEDI board_name.  Looks like the third field in
 859          * CISTPL_VERS_1 (offset 2) holds what we're looking for.  If
 860          * it doesn't work, who cares, just leave it as "DAQP".
 861          */
 862
 863         strcpy(local->board_name, "DAQP");
 864         dev->board_name = local->board_name;
 865         if (local->link->prod_id[2]) {
 866                 if (strncmp(local->link->prod_id[2], "DAQP", 4) == 0) {
 867                         strncpy(local->board_name, local->link->prod_id[2],
 868                                 sizeof(local->board_name));
 869                 }
 870         }
 871
 872         dev->iobase = local->link->resource[0]->start;
 873
 874         ret = alloc_subdevices(dev, 4);
 875         if (ret < 0)
 876                 return ret;
 877
 878         printk(KERN_INFO "comedi%d: attaching daqp%d (io 0x%04lx)\n",
 879                dev->minor, it->options[0], dev->iobase);
 880
 881         s = dev->subdevices + 0;
 882         dev->read_subdev = s;
 883         s->private = local;
 884         s->type = COMEDI_SUBD_AI;
 885         s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_DIFF | SDF_CMD_READ;
 886         s->n_chan = 8;
 887         s->len_chanlist = 2048;
 888         s->maxdata = 0xffff;
 889         s->range_table = &range_daqp_ai;
 890         s->insn_read = daqp_ai_insn_read;
 891         s->do_cmdtest = daqp_ai_cmdtest;
 892         s->do_cmd = daqp_ai_cmd;
 893         s->cancel = daqp_ai_cancel;
 894
 895         s = dev->subdevices + 1;
 896         dev->write_subdev = s;
 897         s->private = local;
 898         s->type = COMEDI_SUBD_AO;
 899         s->subdev_flags = SDF_WRITEABLE;
 900         s->n_chan = 2;
 901         s->len_chanlist = 1;
 902         s->maxdata = 0x0fff;
 903         s->range_table = &range_daqp_ao;
 904         s->insn_write = daqp_ao_insn_write;
 905
 906         s = dev->subdevices + 2;
 907         s->private = local;
 908         s->type = COMEDI_SUBD_DI;
 909         s->subdev_flags = SDF_READABLE;
 910         s->n_chan = 1;
 911         s->len_chanlist = 1;
 912         s->insn_read = daqp_di_insn_read;
 913
 914         s = dev->subdevices + 3;
 915         s->private = local;
 916         s->type = COMEDI_SUBD_DO;
 917         s->subdev_flags = SDF_WRITEABLE;
 918         s->n_chan = 1;
 919         s->len_chanlist = 1;
 920         s->insn_write = daqp_do_insn_write;
 921
 922         return 1;
 923 }
 924
 925 /* daqp_detach (called from comedi_comdig) does nothing. If the PCMCIA
 926  * card is removed, daqp_cs_detach() is called by the pcmcia subsystem.
 927  */
 928
 929 static int daqp_detach(struct comedi_device *dev)
 930 {
 931         printk(KERN_INFO "comedi%d: detaching daqp\n", dev->minor);
 932
 933         return 0;
 934 }
 935
 936 /*====================================================================
 937
 938     PCMCIA interface code
 939
 940     The rest of the code in this file is based on dummy_cs.c v1.24
 941     from the Linux pcmcia_cs distribution v3.1.8 and is subject
 942     to the following license agreement.
 943
 944     The remaining contents of this file are subject to the Mozilla Public
 945     License Version 1.1 (the "License"); you may not use this file
 946     except in compliance with the License. You may obtain a copy of
 947     the License at http://www.mozilla.org/MPL/
 948
 949     Software distributed under the License is distributed on an "AS
 950     IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
 951     implied. See the License for the specific language governing
 952     rights and limitations under the License.
 953
 954     The initial developer of the original code is David A. Hinds
 955     <dhinds@pcmcia.sourceforge.org>.  Portions created by David A. Hinds
 956     are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
 957
 958     Alternatively, the contents of this file may be used under the
 959     terms of the GNU Public License version 2 (the "GPL"), in which
 960     case the provisions of the GPL are applicable instead of the
 961     above.  If you wish to allow the use of your version of this file
 962     only under the terms of the GPL and not to allow others to use
 963     your version of this file under the MPL, indicate your decision
 964     by deleting the provisions above and replace them with the notice
 965     and other provisions required by the GPL.  If you do not delete
 966     the provisions above, a recipient may use your version of this
 967     file under either the MPL or the GPL.
 968
 969 ======================================================================*/
 970
 971 static void daqp_cs_config(struct pcmcia_device *link);
 972 static void daqp_cs_release(struct pcmcia_device *link);
 973 static int daqp_cs_suspend(struct pcmcia_device *p_dev);
 974 static int daqp_cs_resume(struct pcmcia_device *p_dev);
 975
 976 static int daqp_cs_attach(struct pcmcia_device *);
 977 static void daqp_cs_detach(struct pcmcia_device *);
 978
 979 static int daqp_cs_attach(struct pcmcia_device *link)
 980 {
 981         struct local_info_t *local;
 982         int i;
 983
 984         dev_dbg(&link->dev, "daqp_cs_attach()\n");
 985
 986         for (i = 0; i < MAX_DEV; i++)
 987                 if (dev_table[i] == NULL)
 988                         break;
 989         if (i == MAX_DEV) {
 990                 printk(KERN_NOTICE "daqp_cs: no devices available\n");
 991                 return -ENODEV;
 992         }
 993
 994         /* Allocate space for private device-specific data */
 995         local = kzalloc(sizeof(struct local_info_t), GFP_KERNEL);
 996         if (!local)
 997                 return -ENOMEM;
 998
 999         local->table_index = i;
1000         dev_table[i] = local;
1001         local->link = link;
1002         link->priv = local;
1003
1004         daqp_cs_config(link);
1005
1006         return 0;
1007 }                               /* daqp_cs_attach */
1008
1009 static void daqp_cs_detach(struct pcmcia_device *link)
1010 {
1011         struct local_info_t *dev = link->priv;
1012
1013         dev_dbg(&link->dev, "daqp_cs_detach\n");
1014
1015         dev->stop = 1;
1016         daqp_cs_release(link);
1017
1018         /* Unlink device structure, and free it */
1019         dev_table[dev->table_index] = NULL;
1020         kfree(dev);
1021
1022 }                               /* daqp_cs_detach */
1023
1024 static int daqp_pcmcia_config_loop(struct pcmcia_device *p_dev, void *priv_data)
1025 {
1026         if (p_dev->config_index == 0)
1027                 return -EINVAL;
1028
1029         return pcmcia_request_io(p_dev);
1030 }
1031
1032 static void daqp_cs_config(struct pcmcia_device *link)
1033 {
1034         int ret;
1035
1036         dev_dbg(&link->dev, "daqp_cs_config\n");
1037
1038         link->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
1039
1040         ret = pcmcia_loop_config(link, daqp_pcmcia_config_loop, NULL);
1041         if (ret) {
1042                 dev_warn(&link->dev, "no configuration found\n");
1043                 goto failed;
1044         }
1045
1046         ret = pcmcia_request_irq(link, daqp_interrupt);
1047         if (ret)
1048                 goto failed;
1049
1050         ret = pcmcia_enable_device(link);
1051         if (ret)
1052                 goto failed;
1053
1054         return;
1055
1056 failed:
1057         daqp_cs_release(link);
1058
1059 }                               /* daqp_cs_config */
1060
1061 static void daqp_cs_release(struct pcmcia_device *link)
1062 {
1063         dev_dbg(&link->dev, "daqp_cs_release\n");
1064
1065         pcmcia_disable_device(link);
1066 }                               /* daqp_cs_release */
1067
1068 static int daqp_cs_suspend(struct pcmcia_device *link)
1069 {
1070         struct local_info_t *local = link->priv;
1071
1072         /* Mark the device as stopped, to block IO until later */
1073         local->stop = 1;
1074         return 0;
1075 }
1076
1077 static int daqp_cs_resume(struct pcmcia_device *link)
1078 {
1079         struct local_info_t *local = link->priv;
1080
1081         local->stop = 0;
1082
1083         return 0;
1084 }
1085
1086 /*====================================================================*/
1087
1088 #ifdef MODULE
1089
1090 static const struct pcmcia_device_id daqp_cs_id_table[] = {
1091         PCMCIA_DEVICE_MANF_CARD(0x0137, 0x0027),
1092         PCMCIA_DEVICE_NULL
1093 };
1094
1095 MODULE_DEVICE_TABLE(pcmcia, daqp_cs_id_table);
1096 MODULE_AUTHOR("Brent Baccala <baccala@freesoft.org>");
1097 MODULE_DESCRIPTION("Comedi driver for Quatech DAQP PCMCIA data capture cards");
1098 MODULE_LICENSE("GPL");
1099
1100 static struct pcmcia_driver daqp_cs_driver = {
1101         .probe = daqp_cs_attach,
1102         .remove = daqp_cs_detach,
1103         .suspend = daqp_cs_suspend,
1104         .resume = daqp_cs_resume,
1105         .id_table = daqp_cs_id_table,
1106         .owner = THIS_MODULE,
1107         .name = "quatech_daqp_cs",
1108 };
1109
1110 int __init init_module(void)
1111 {
1112         pcmcia_register_driver(&daqp_cs_driver);
1113         comedi_driver_register(&driver_daqp);
1114         return 0;
1115 }
1116
1117 void __exit cleanup_module(void)
1118 {
1119         comedi_driver_unregister(&driver_daqp);
1120         pcmcia_unregister_driver(&daqp_cs_driver);
1121 }
1122
1123 #endif