kernel/drivers/staging/comedi/drivers/adl_pci9111.c

   1 /*
   2
   3 comedi/drivers/adl_pci9111.c
   4
   5 Hardware driver for PCI9111 ADLink cards:
   6
   7 PCI-9111HR
   8
   9 Copyright (C) 2002-2005 Emmanuel Pacaud <emmanuel.pacaud@univ-poitiers.fr>
  10
  11 This program is free software; you can redistribute it and/or modify
  12 it under the terms of the GNU General Public License as published by
  13 the Free Software Foundation; either version 2 of the License, or
  14 (at your option) any later version.
  15
  16 This program is distributed in the hope that it will be useful,
  17 but WITHOUT ANY WARRANTY; without even the implied warranty of
  18 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19 GNU General Public License for more details.
  20 */
  21
  22 /*
  23 Driver: adl_pci9111
  24 Description: Adlink PCI-9111HR
  25 Author: Emmanuel Pacaud <emmanuel.pacaud@univ-poitiers.fr>
  26 Devices: [ADLink] PCI-9111HR (adl_pci9111)
  27 Status: experimental
  28
  29 Supports:
  30
  31         - ai_insn read
  32         - ao_insn read/write
  33         - di_insn read
  34         - do_insn read/write
  35         - ai_do_cmd mode with the following sources:
  36
  37         - start_src             TRIG_NOW
  38         - scan_begin_src        TRIG_FOLLOW     TRIG_TIMER      TRIG_EXT
  39         - convert_src                           TRIG_TIMER      TRIG_EXT
  40         - scan_end_src          TRIG_COUNT
  41         - stop_src              TRIG_COUNT      TRIG_NONE
  42
  43 The scanned channels must be consecutive and start from 0. They must
  44 all have the same range and aref.
  45
  46 Configuration options: not applicable, uses PCI auto config
  47 */
  48
  49 /*
  50 CHANGELOG:
  51
  52 2005/02/17 Extend AI streaming capabilities. Now, scan_begin_arg can be
  53 a multiple of chanlist_len*convert_arg.
  54 2002/02/19 Fixed the two's complement conversion in pci9111_(hr_)ai_get_data.
  55 2002/02/18 Added external trigger support for analog input.
  56
  57 TODO:
  58
  59         - Really test implemented functionality.
  60         - Add support for the PCI-9111DG with a probe routine to identify
  61           the card type (perhaps with the help of the channel number readback
  62           of the A/D Data register).
  63         - Add external multiplexer support.
  64
  65 */
  66
  67 #include <linux/module.h>
  68 #include <linux/delay.h>
  69 #include <linux/interrupt.h>
  70
  71 #include "../comedi_pci.h"
  72
  73 #include "plx9052.h"
  74 #include "comedi_8254.h"
  75
  76 #define PCI9111_FIFO_HALF_SIZE  512
  77
  78 #define PCI9111_AI_ACQUISITION_PERIOD_MIN_NS    10000
  79
  80 #define PCI9111_RANGE_SETTING_DELAY             10
  81 #define PCI9111_AI_INSTANT_READ_UDELAY_US       2
  82
  83 /*
  84  * IO address map and bit defines
  85  */
  86 #define PCI9111_AI_FIFO_REG             0x00
  87 #define PCI9111_AO_REG                  0x00
  88 #define PCI9111_DIO_REG                 0x02
  89 #define PCI9111_EDIO_REG                0x04
  90 #define PCI9111_AI_CHANNEL_REG          0x06
  91 #define PCI9111_AI_RANGE_STAT_REG       0x08
  92 #define PCI9111_AI_STAT_AD_BUSY         (1 << 7)
  93 #define PCI9111_AI_STAT_FF_FF           (1 << 6)
  94 #define PCI9111_AI_STAT_FF_HF           (1 << 5)
  95 #define PCI9111_AI_STAT_FF_EF           (1 << 4)
  96 #define PCI9111_AI_RANGE_MASK           (7 << 0)
  97 #define PCI9111_AI_TRIG_CTRL_REG        0x0a
  98 #define PCI9111_AI_TRIG_CTRL_TRGEVENT   (1 << 5)
  99 #define PCI9111_AI_TRIG_CTRL_POTRG      (1 << 4)
 100 #define PCI9111_AI_TRIG_CTRL_PTRG       (1 << 3)
 101 #define PCI9111_AI_TRIG_CTRL_ETIS       (1 << 2)
 102 #define PCI9111_AI_TRIG_CTRL_TPST       (1 << 1)
 103 #define PCI9111_AI_TRIG_CTRL_ASCAN      (1 << 0)
 104 #define PCI9111_INT_CTRL_REG            0x0c
 105 #define PCI9111_INT_CTRL_ISC2           (1 << 3)
 106 #define PCI9111_INT_CTRL_FFEN           (1 << 2)
 107 #define PCI9111_INT_CTRL_ISC1           (1 << 1)
 108 #define PCI9111_INT_CTRL_ISC0           (1 << 0)
 109 #define PCI9111_SOFT_TRIG_REG           0x0e
 110 #define PCI9111_8254_BASE_REG           0x40
 111 #define PCI9111_INT_CLR_REG             0x48
 112
 113 /* PLX 9052 Local Interrupt 1 enabled and active */
 114 #define PCI9111_LI1_ACTIVE      (PLX9052_INTCSR_LI1ENAB |       \
 115                                  PLX9052_INTCSR_LI1STAT)
 116
 117 /* PLX 9052 Local Interrupt 2 enabled and active */
 118 #define PCI9111_LI2_ACTIVE      (PLX9052_INTCSR_LI2ENAB |       \
 119                                  PLX9052_INTCSR_LI2STAT)
 120
 121 static const struct comedi_lrange pci9111_ai_range = {
 122         5, {
 123                 BIP_RANGE(10),
 124                 BIP_RANGE(5),
 125                 BIP_RANGE(2.5),
 126                 BIP_RANGE(1.25),
 127                 BIP_RANGE(0.625)
 128         }
 129 };
 130
 131 struct pci9111_private_data {
 132         unsigned long lcr_io_base;
 133
 134         unsigned int scan_delay;
 135         unsigned int chunk_counter;
 136         unsigned int chunk_num_samples;
 137
 138         unsigned short ai_bounce_buffer[2 * PCI9111_FIFO_HALF_SIZE];
 139 };
 140
 141 static void plx9050_interrupt_control(unsigned long io_base,
 142                                       bool LINTi1_enable,
 143                                       bool LINTi1_active_high,
 144                                       bool LINTi2_enable,
 145                                       bool LINTi2_active_high,
 146                                       bool interrupt_enable)
 147 {
 148         int flags = 0;
 149
 150         if (LINTi1_enable)
 151                 flags |= PLX9052_INTCSR_LI1ENAB;
 152         if (LINTi1_active_high)
 153                 flags |= PLX9052_INTCSR_LI1POL;
 154         if (LINTi2_enable)
 155                 flags |= PLX9052_INTCSR_LI2ENAB;
 156         if (LINTi2_active_high)
 157                 flags |= PLX9052_INTCSR_LI2POL;
 158
 159         if (interrupt_enable)
 160                 flags |= PLX9052_INTCSR_PCIENAB;
 161
 162         outb(flags, io_base + PLX9052_INTCSR);
 163 }
 164
 165 enum pci9111_ISC0_sources {
 166         irq_on_eoc,
 167         irq_on_fifo_half_full
 168 };
 169
 170 enum pci9111_ISC1_sources {
 171         irq_on_timer_tick,
 172         irq_on_external_trigger
 173 };
 174
 175 static void pci9111_interrupt_source_set(struct comedi_device *dev,
 176                                          enum pci9111_ISC0_sources irq_0_source,
 177                                          enum pci9111_ISC1_sources irq_1_source)
 178 {
 179         int flags;
 180
 181         /* Read the current interrupt control bits */
 182         flags = inb(dev->iobase + PCI9111_AI_TRIG_CTRL_REG);
 183         /* Shift the bits so they are compatible with the write register */
 184         flags >>= 4;
 185         /* Mask off the ISCx bits */
 186         flags &= 0xc0;
 187
 188         /* Now set the new ISCx bits */
 189         if (irq_0_source == irq_on_fifo_half_full)
 190                 flags |= PCI9111_INT_CTRL_ISC0;
 191
 192         if (irq_1_source == irq_on_external_trigger)
 193                 flags |= PCI9111_INT_CTRL_ISC1;
 194
 195         outb(flags, dev->iobase + PCI9111_INT_CTRL_REG);
 196 }
 197
 198 static void pci9111_fifo_reset(struct comedi_device *dev)
 199 {
 200         unsigned long int_ctrl_reg = dev->iobase + PCI9111_INT_CTRL_REG;
 201
 202         /* To reset the FIFO, set FFEN sequence as 0 -> 1 -> 0 */
 203         outb(0, int_ctrl_reg);
 204         outb(PCI9111_INT_CTRL_FFEN, int_ctrl_reg);
 205         outb(0, int_ctrl_reg);
 206 }
 207
 208 static int pci9111_ai_cancel(struct comedi_device *dev,
 209                              struct comedi_subdevice *s)
 210 {
 211         struct pci9111_private_data *dev_private = dev->private;
 212
 213         /*  Disable interrupts */
 214         plx9050_interrupt_control(dev_private->lcr_io_base, true, true, true,
 215                                   true, false);
 216
 217         /* disable A/D triggers (software trigger mode) and auto scan off */
 218         outb(0, dev->iobase + PCI9111_AI_TRIG_CTRL_REG);
 219
 220         pci9111_fifo_reset(dev);
 221
 222         return 0;
 223 }
 224
 225 static int pci9111_ai_check_chanlist(struct comedi_device *dev,
 226                                      struct comedi_subdevice *s,
 227                                      struct comedi_cmd *cmd)
 228 {
 229         unsigned int range0 = CR_RANGE(cmd->chanlist[0]);
 230         unsigned int aref0 = CR_AREF(cmd->chanlist[0]);
 231         int i;
 232
 233         for (i = 1; i < cmd->chanlist_len; i++) {
 234                 unsigned int chan = CR_CHAN(cmd->chanlist[i]);
 235                 unsigned int range = CR_RANGE(cmd->chanlist[i]);
 236                 unsigned int aref = CR_AREF(cmd->chanlist[i]);
 237
 238                 if (chan != i) {
 239                         dev_dbg(dev->class_dev,
 240                                 "entries in chanlist must be consecutive channels,counting upwards from 0\n");
 241                         return -EINVAL;
 242                 }
 243
 244                 if (range != range0) {
 245                         dev_dbg(dev->class_dev,
 246                                 "entries in chanlist must all have the same gain\n");
 247                         return -EINVAL;
 248                 }
 249
 250                 if (aref != aref0) {
 251                         dev_dbg(dev->class_dev,
 252                                 "entries in chanlist must all have the same reference\n");
 253                         return -EINVAL;
 254                 }
 255         }
 256
 257         return 0;
 258 }
 259
 260 static int pci9111_ai_do_cmd_test(struct comedi_device *dev,
 261                                   struct comedi_subdevice *s,
 262                                   struct comedi_cmd *cmd)
 263 {
 264         int err = 0;
 265         unsigned int arg;
 266
 267         /* Step 1 : check if triggers are trivially valid */
 268
 269         err |= comedi_check_trigger_src(&cmd->start_src, TRIG_NOW);
 270         err |= comedi_check_trigger_src(&cmd->scan_begin_src,
 271                                         TRIG_TIMER | TRIG_FOLLOW | TRIG_EXT);
 272         err |= comedi_check_trigger_src(&cmd->convert_src,
 273                                         TRIG_TIMER | TRIG_EXT);
 274         err |= comedi_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT);
 275         err |= comedi_check_trigger_src(&cmd->stop_src,
 276                                         TRIG_COUNT | TRIG_NONE);
 277
 278         if (err)
 279                 return 1;
 280
 281         /* Step 2a : make sure trigger sources are unique */
 282
 283         err |= comedi_check_trigger_is_unique(cmd->scan_begin_src);
 284         err |= comedi_check_trigger_is_unique(cmd->convert_src);
 285         err |= comedi_check_trigger_is_unique(cmd->stop_src);
 286
 287         /* Step 2b : and mutually compatible */
 288
 289         if (cmd->scan_begin_src != TRIG_FOLLOW) {
 290                 if (cmd->scan_begin_src != cmd->convert_src)
 291                         err |= -EINVAL;
 292         }
 293
 294         if (err)
 295                 return 2;
 296
 297         /* Step 3: check if arguments are trivially valid */
 298
 299         err |= comedi_check_trigger_arg_is(&cmd->start_arg, 0);
 300
 301         if (cmd->convert_src == TRIG_TIMER) {
 302                 err |= comedi_check_trigger_arg_min(&cmd->convert_arg,
 303                                         PCI9111_AI_ACQUISITION_PERIOD_MIN_NS);
 304         } else {        /* TRIG_EXT */
 305                 err |= comedi_check_trigger_arg_is(&cmd->convert_arg, 0);
 306         }
 307
 308         if (cmd->scan_begin_src == TRIG_TIMER) {
 309                 err |= comedi_check_trigger_arg_min(&cmd->scan_begin_arg,
 310                                         PCI9111_AI_ACQUISITION_PERIOD_MIN_NS);
 311         } else {        /* TRIG_FOLLOW || TRIG_EXT */
 312                 err |= comedi_check_trigger_arg_is(&cmd->scan_begin_arg, 0);
 313         }
 314
 315         err |= comedi_check_trigger_arg_is(&cmd->scan_end_arg,
 316                                            cmd->chanlist_len);
 317
 318         if (cmd->stop_src == TRIG_COUNT)
 319                 err |= comedi_check_trigger_arg_min(&cmd->stop_arg, 1);
 320         else    /* TRIG_NONE */
 321                 err |= comedi_check_trigger_arg_is(&cmd->stop_arg, 0);
 322
 323         if (err)
 324                 return 3;
 325
 326         /* Step 4: fix up any arguments */
 327
 328         if (cmd->convert_src == TRIG_TIMER) {
 329                 arg = cmd->convert_arg;
 330                 comedi_8254_cascade_ns_to_timer(dev->pacer, &arg, cmd->flags);
 331                 err |= comedi_check_trigger_arg_is(&cmd->convert_arg, arg);
 332         }
 333
 334         /*
 335          * There's only one timer on this card, so the scan_begin timer
 336          * must be a multiple of chanlist_len*convert_arg
 337          */
 338         if (cmd->scan_begin_src == TRIG_TIMER) {
 339                 arg = cmd->chanlist_len * cmd->convert_arg;
 340
 341                 if (arg < cmd->scan_begin_arg)
 342                         arg *= (cmd->scan_begin_arg / arg);
 343
 344                 err |= comedi_check_trigger_arg_is(&cmd->scan_begin_arg, arg);
 345         }
 346
 347         if (err)
 348                 return 4;
 349
 350         /* Step 5: check channel list if it exists */
 351         if (cmd->chanlist && cmd->chanlist_len > 0)
 352                 err |= pci9111_ai_check_chanlist(dev, s, cmd);
 353
 354         if (err)
 355                 return 5;
 356
 357         return 0;
 358 }
 359
 360 static int pci9111_ai_do_cmd(struct comedi_device *dev,
 361                              struct comedi_subdevice *s)
 362 {
 363         struct pci9111_private_data *dev_private = dev->private;
 364         struct comedi_cmd *cmd = &s->async->cmd;
 365         unsigned int last_chan = CR_CHAN(cmd->chanlist[cmd->chanlist_len - 1]);
 366         unsigned int trig = 0;
 367
 368         /*  Set channel scan limit */
 369         /*  PCI9111 allows only scanning from channel 0 to channel n */
 370         /*  TODO: handle the case of an external multiplexer */
 371
 372         if (cmd->chanlist_len > 1)
 373                 trig |= PCI9111_AI_TRIG_CTRL_ASCAN;
 374
 375         outb(last_chan, dev->iobase + PCI9111_AI_CHANNEL_REG);
 376
 377         /*  Set gain */
 378         /*  This is the same gain on every channel */
 379
 380         outb(CR_RANGE(cmd->chanlist[0]) & PCI9111_AI_RANGE_MASK,
 381              dev->iobase + PCI9111_AI_RANGE_STAT_REG);
 382
 383         /*  Set timer pacer */
 384         dev_private->scan_delay = 0;
 385         if (cmd->convert_src == TRIG_TIMER) {
 386                 trig |= PCI9111_AI_TRIG_CTRL_TPST;
 387                 comedi_8254_update_divisors(dev->pacer);
 388                 comedi_8254_pacer_enable(dev->pacer, 1, 2, true);
 389                 pci9111_fifo_reset(dev);
 390                 pci9111_interrupt_source_set(dev, irq_on_fifo_half_full,
 391                                              irq_on_timer_tick);
 392                 plx9050_interrupt_control(dev_private->lcr_io_base, true, true,
 393                                           false, true, true);
 394
 395                 if (cmd->scan_begin_src == TRIG_TIMER) {
 396                         dev_private->scan_delay = (cmd->scan_begin_arg /
 397                                 (cmd->convert_arg * cmd->chanlist_len)) - 1;
 398                 }
 399         } else {        /* TRIG_EXT */
 400                 trig |= PCI9111_AI_TRIG_CTRL_ETIS;
 401                 pci9111_fifo_reset(dev);
 402                 pci9111_interrupt_source_set(dev, irq_on_fifo_half_full,
 403                                              irq_on_timer_tick);
 404                 plx9050_interrupt_control(dev_private->lcr_io_base, true, true,
 405                                           false, true, true);
 406         }
 407         outb(trig, dev->iobase + PCI9111_AI_TRIG_CTRL_REG);
 408
 409         dev_private->chunk_counter = 0;
 410         dev_private->chunk_num_samples = cmd->chanlist_len *
 411                                          (1 + dev_private->scan_delay);
 412
 413         return 0;
 414 }
 415
 416 static void pci9111_ai_munge(struct comedi_device *dev,
 417                              struct comedi_subdevice *s, void *data,
 418                              unsigned int num_bytes,
 419                              unsigned int start_chan_index)
 420 {
 421         unsigned short *array = data;
 422         unsigned int maxdata = s->maxdata;
 423         unsigned int invert = (maxdata + 1) >> 1;
 424         unsigned int shift = (maxdata == 0xffff) ? 0 : 4;
 425         unsigned int num_samples = comedi_bytes_to_samples(s, num_bytes);
 426         unsigned int i;
 427
 428         for (i = 0; i < num_samples; i++)
 429                 array[i] = ((array[i] >> shift) & maxdata) ^ invert;
 430 }
 431
 432 static void pci9111_handle_fifo_half_full(struct comedi_device *dev,
 433                                           struct comedi_subdevice *s)
 434 {
 435         struct pci9111_private_data *devpriv = dev->private;
 436         struct comedi_cmd *cmd = &s->async->cmd;
 437         unsigned int samples;
 438
 439         samples = comedi_nsamples_left(s, PCI9111_FIFO_HALF_SIZE);
 440         insw(dev->iobase + PCI9111_AI_FIFO_REG,
 441              devpriv->ai_bounce_buffer, samples);
 442
 443         if (devpriv->scan_delay < 1) {
 444                 comedi_buf_write_samples(s, devpriv->ai_bounce_buffer, samples);
 445         } else {
 446                 unsigned int pos = 0;
 447                 unsigned int to_read;
 448
 449                 while (pos < samples) {
 450                         if (devpriv->chunk_counter < cmd->chanlist_len) {
 451                                 to_read = cmd->chanlist_len -
 452                                           devpriv->chunk_counter;
 453
 454                                 if (to_read > samples - pos)
 455                                         to_read = samples - pos;
 456
 457                                 comedi_buf_write_samples(s,
 458                                                 devpriv->ai_bounce_buffer + pos,
 459                                                 to_read);
 460                         } else {
 461                                 to_read = devpriv->chunk_num_samples -
 462                                           devpriv->chunk_counter;
 463
 464                                 if (to_read > samples - pos)
 465                                         to_read = samples - pos;
 466                         }
 467
 468                         pos += to_read;
 469                         devpriv->chunk_counter += to_read;
 470
 471                         if (devpriv->chunk_counter >=
 472                             devpriv->chunk_num_samples)
 473                                 devpriv->chunk_counter = 0;
 474                 }
 475         }
 476 }
 477
 478 static irqreturn_t pci9111_interrupt(int irq, void *p_device)
 479 {
 480         struct comedi_device *dev = p_device;
 481         struct pci9111_private_data *dev_private = dev->private;
 482         struct comedi_subdevice *s = dev->read_subdev;
 483         struct comedi_async *async;
 484         struct comedi_cmd *cmd;
 485         unsigned int status;
 486         unsigned long irq_flags;
 487         unsigned char intcsr;
 488
 489         if (!dev->attached) {
 490                 /*  Ignore interrupt before device fully attached. */
 491                 /*  Might not even have allocated subdevices yet! */
 492                 return IRQ_NONE;
 493         }
 494
 495         async = s->async;
 496         cmd = &async->cmd;
 497
 498         spin_lock_irqsave(&dev->spinlock, irq_flags);
 499
 500         /*  Check if we are source of interrupt */
 501         intcsr = inb(dev_private->lcr_io_base + PLX9052_INTCSR);
 502         if (!(((intcsr & PLX9052_INTCSR_PCIENAB) != 0) &&
 503               (((intcsr & PCI9111_LI1_ACTIVE) == PCI9111_LI1_ACTIVE) ||
 504                ((intcsr & PCI9111_LI2_ACTIVE) == PCI9111_LI2_ACTIVE)))) {
 505                 /*  Not the source of the interrupt. */
 506                 /*  (N.B. not using PLX9052_INTCSR_SOFTINT) */
 507                 spin_unlock_irqrestore(&dev->spinlock, irq_flags);
 508                 return IRQ_NONE;
 509         }
 510
 511         if ((intcsr & PCI9111_LI1_ACTIVE) == PCI9111_LI1_ACTIVE) {
 512                 /*  Interrupt comes from fifo_half-full signal */
 513
 514                 status = inb(dev->iobase + PCI9111_AI_RANGE_STAT_REG);
 515
 516                 /* '0' means FIFO is full, data may have been lost */
 517                 if (!(status & PCI9111_AI_STAT_FF_FF)) {
 518                         spin_unlock_irqrestore(&dev->spinlock, irq_flags);
 519                         dev_dbg(dev->class_dev, "fifo overflow\n");
 520                         outb(0, dev->iobase + PCI9111_INT_CLR_REG);
 521                         async->events |= COMEDI_CB_ERROR;
 522                         comedi_handle_events(dev, s);
 523
 524                         return IRQ_HANDLED;
 525                 }
 526
 527                 /* '0' means FIFO is half-full */
 528                 if (!(status & PCI9111_AI_STAT_FF_HF))
 529                         pci9111_handle_fifo_half_full(dev, s);
 530         }
 531
 532         if (cmd->stop_src == TRIG_COUNT && async->scans_done >= cmd->stop_arg)
 533                 async->events |= COMEDI_CB_EOA;
 534
 535         outb(0, dev->iobase + PCI9111_INT_CLR_REG);
 536
 537         spin_unlock_irqrestore(&dev->spinlock, irq_flags);
 538
 539         comedi_handle_events(dev, s);
 540
 541         return IRQ_HANDLED;
 542 }
 543
 544 static int pci9111_ai_eoc(struct comedi_device *dev,
 545                           struct comedi_subdevice *s,
 546                           struct comedi_insn *insn,
 547                           unsigned long context)
 548 {
 549         unsigned int status;
 550
 551         status = inb(dev->iobase + PCI9111_AI_RANGE_STAT_REG);
 552         if (status & PCI9111_AI_STAT_FF_EF)
 553                 return 0;
 554         return -EBUSY;
 555 }
 556
 557 static int pci9111_ai_insn_read(struct comedi_device *dev,
 558                                 struct comedi_subdevice *s,
 559                                 struct comedi_insn *insn, unsigned int *data)
 560 {
 561         unsigned int chan = CR_CHAN(insn->chanspec);
 562         unsigned int range = CR_RANGE(insn->chanspec);
 563         unsigned int maxdata = s->maxdata;
 564         unsigned int invert = (maxdata + 1) >> 1;
 565         unsigned int shift = (maxdata == 0xffff) ? 0 : 4;
 566         unsigned int status;
 567         int ret;
 568         int i;
 569
 570         outb(chan, dev->iobase + PCI9111_AI_CHANNEL_REG);
 571
 572         status = inb(dev->iobase + PCI9111_AI_RANGE_STAT_REG);
 573         if ((status & PCI9111_AI_RANGE_MASK) != range) {
 574                 outb(range & PCI9111_AI_RANGE_MASK,
 575                      dev->iobase + PCI9111_AI_RANGE_STAT_REG);
 576         }
 577
 578         pci9111_fifo_reset(dev);
 579
 580         for (i = 0; i < insn->n; i++) {
 581                 /* Generate a software trigger */
 582                 outb(0, dev->iobase + PCI9111_SOFT_TRIG_REG);
 583
 584                 ret = comedi_timeout(dev, s, insn, pci9111_ai_eoc, 0);
 585                 if (ret) {
 586                         pci9111_fifo_reset(dev);
 587                         return ret;
 588                 }
 589
 590                 data[i] = inw(dev->iobase + PCI9111_AI_FIFO_REG);
 591                 data[i] = ((data[i] >> shift) & maxdata) ^ invert;
 592         }
 593
 594         return i;
 595 }
 596
 597 static int pci9111_ao_insn_write(struct comedi_device *dev,
 598                                  struct comedi_subdevice *s,
 599                                  struct comedi_insn *insn,
 600                                  unsigned int *data)
 601 {
 602         unsigned int chan = CR_CHAN(insn->chanspec);
 603         unsigned int val = s->readback[chan];
 604         int i;
 605
 606         for (i = 0; i < insn->n; i++) {
 607                 val = data[i];
 608                 outw(val, dev->iobase + PCI9111_AO_REG);
 609         }
 610         s->readback[chan] = val;
 611
 612         return insn->n;
 613 }
 614
 615 static int pci9111_di_insn_bits(struct comedi_device *dev,
 616                                 struct comedi_subdevice *s,
 617                                 struct comedi_insn *insn,
 618                                 unsigned int *data)
 619 {
 620         data[1] = inw(dev->iobase + PCI9111_DIO_REG);
 621
 622         return insn->n;
 623 }
 624
 625 static int pci9111_do_insn_bits(struct comedi_device *dev,
 626                                 struct comedi_subdevice *s,
 627                                 struct comedi_insn *insn,
 628                                 unsigned int *data)
 629 {
 630         if (comedi_dio_update_state(s, data))
 631                 outw(s->state, dev->iobase + PCI9111_DIO_REG);
 632
 633         data[1] = s->state;
 634
 635         return insn->n;
 636 }
 637
 638 static int pci9111_reset(struct comedi_device *dev)
 639 {
 640         struct pci9111_private_data *dev_private = dev->private;
 641
 642         /*  Set trigger source to software */
 643         plx9050_interrupt_control(dev_private->lcr_io_base, true, true, true,
 644                                   true, false);
 645
 646         /* disable A/D triggers (software trigger mode) and auto scan off */
 647         outb(0, dev->iobase + PCI9111_AI_TRIG_CTRL_REG);
 648
 649         return 0;
 650 }
 651
 652 static int pci9111_auto_attach(struct comedi_device *dev,
 653                                unsigned long context_unused)
 654 {
 655         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
 656         struct pci9111_private_data *dev_private;
 657         struct comedi_subdevice *s;
 658         int ret;
 659
 660         dev_private = comedi_alloc_devpriv(dev, sizeof(*dev_private));
 661         if (!dev_private)
 662                 return -ENOMEM;
 663
 664         ret = comedi_pci_enable(dev);
 665         if (ret)
 666                 return ret;
 667         dev_private->lcr_io_base = pci_resource_start(pcidev, 1);
 668         dev->iobase = pci_resource_start(pcidev, 2);
 669
 670         pci9111_reset(dev);
 671
 672         if (pcidev->irq) {
 673                 ret = request_irq(pcidev->irq, pci9111_interrupt,
 674                                   IRQF_SHARED, dev->board_name, dev);
 675                 if (ret == 0)
 676                         dev->irq = pcidev->irq;
 677         }
 678
 679         dev->pacer = comedi_8254_init(dev->iobase + PCI9111_8254_BASE_REG,
 680                                       I8254_OSC_BASE_2MHZ, I8254_IO16, 0);
 681         if (!dev->pacer)
 682                 return -ENOMEM;
 683
 684         ret = comedi_alloc_subdevices(dev, 4);
 685         if (ret)
 686                 return ret;
 687
 688         s = &dev->subdevices[0];
 689         s->type         = COMEDI_SUBD_AI;
 690         s->subdev_flags = SDF_READABLE | SDF_COMMON;
 691         s->n_chan       = 16;
 692         s->maxdata      = 0xffff;
 693         s->range_table  = &pci9111_ai_range;
 694         s->insn_read    = pci9111_ai_insn_read;
 695         if (dev->irq) {
 696                 dev->read_subdev = s;
 697                 s->subdev_flags |= SDF_CMD_READ;
 698                 s->len_chanlist = s->n_chan;
 699                 s->do_cmdtest   = pci9111_ai_do_cmd_test;
 700                 s->do_cmd       = pci9111_ai_do_cmd;
 701                 s->cancel       = pci9111_ai_cancel;
 702                 s->munge        = pci9111_ai_munge;
 703         }
 704
 705         s = &dev->subdevices[1];
 706         s->type         = COMEDI_SUBD_AO;
 707         s->subdev_flags = SDF_WRITABLE | SDF_COMMON;
 708         s->n_chan       = 1;
 709         s->maxdata      = 0x0fff;
 710         s->len_chanlist = 1;
 711         s->range_table  = &range_bipolar10;
 712         s->insn_write   = pci9111_ao_insn_write;
 713
 714         ret = comedi_alloc_subdev_readback(s);
 715         if (ret)
 716                 return ret;
 717
 718         s = &dev->subdevices[2];
 719         s->type         = COMEDI_SUBD_DI;
 720         s->subdev_flags = SDF_READABLE;
 721         s->n_chan       = 16;
 722         s->maxdata      = 1;
 723         s->range_table  = &range_digital;
 724         s->insn_bits    = pci9111_di_insn_bits;
 725
 726         s = &dev->subdevices[3];
 727         s->type         = COMEDI_SUBD_DO;
 728         s->subdev_flags = SDF_WRITABLE;
 729         s->n_chan       = 16;
 730         s->maxdata      = 1;
 731         s->range_table  = &range_digital;
 732         s->insn_bits    = pci9111_do_insn_bits;
 733
 734         return 0;
 735 }
 736
 737 static void pci9111_detach(struct comedi_device *dev)
 738 {
 739         if (dev->iobase)
 740                 pci9111_reset(dev);
 741         comedi_pci_detach(dev);
 742 }
 743
 744 static struct comedi_driver adl_pci9111_driver = {
 745         .driver_name    = "adl_pci9111",
 746         .module         = THIS_MODULE,
 747         .auto_attach    = pci9111_auto_attach,
 748         .detach         = pci9111_detach,
 749 };
 750
 751 static int pci9111_pci_probe(struct pci_dev *dev,
 752                              const struct pci_device_id *id)
 753 {
 754         return comedi_pci_auto_config(dev, &adl_pci9111_driver,
 755                                       id->driver_data);
 756 }
 757
 758 static const struct pci_device_id pci9111_pci_table[] = {
 759         { PCI_DEVICE(PCI_VENDOR_ID_ADLINK, 0x9111) },
 760         /* { PCI_DEVICE(PCI_VENDOR_ID_ADLINK, PCI9111_HG_DEVICE_ID) }, */
 761         { 0 }
 762 };
 763 MODULE_DEVICE_TABLE(pci, pci9111_pci_table);
 764
 765 static struct pci_driver adl_pci9111_pci_driver = {
 766         .name           = "adl_pci9111",
 767         .id_table       = pci9111_pci_table,
 768         .probe          = pci9111_pci_probe,
 769         .remove         = comedi_pci_auto_unconfig,
 770 };
 771 module_comedi_pci_driver(adl_pci9111_driver, adl_pci9111_pci_driver);
 772
 773 MODULE_AUTHOR("Comedi http://www.comedi.org");
 774 MODULE_DESCRIPTION("Comedi low-level driver");
 775 MODULE_LICENSE("GPL");