diff options
Diffstat (limited to 'drivers/staging/comedi/drivers/das16.c')
| -rw-r--r-- | drivers/staging/comedi/drivers/das16.c | 1200 |
1 files changed, 0 insertions, 1200 deletions
diff --git a/drivers/staging/comedi/drivers/das16.c b/drivers/staging/comedi/drivers/das16.c deleted file mode 100644 index 4ac2622b0fac..000000000000 --- a/drivers/staging/comedi/drivers/das16.c +++ /dev/null @@ -1,1200 +0,0 @@ -// SPDX-License-Identifier: GPL-2.0+ -/* - * das16.c - * DAS16 driver - * - * COMEDI - Linux Control and Measurement Device Interface - * Copyright (C) 2000 David A. Schleef <ds@schleef.org> - * Copyright (C) 2000 Chris R. Baugher <baugher@enteract.com> - * Copyright (C) 2001,2002 Frank Mori Hess <fmhess@users.sourceforge.net> - */ - -/* - * Driver: das16 - * Description: DAS16 compatible boards - * Author: Sam Moore, Warren Jasper, ds, Chris Baugher, Frank Hess, Roman Fietze - * Devices: [Keithley Metrabyte] DAS-16 (das-16), DAS-16G (das-16g), - * DAS-16F (das-16f), DAS-1201 (das-1201), DAS-1202 (das-1202), - * DAS-1401 (das-1401), DAS-1402 (das-1402), DAS-1601 (das-1601), - * DAS-1602 (das-1602), - * [ComputerBoards] PC104-DAS16/JR (pc104-das16jr), - * PC104-DAS16JR/16 (pc104-das16jr/16), CIO-DAS16 (cio-das16), - * CIO-DAS16F (cio-das16/f), CIO-DAS16/JR (cio-das16/jr), - * CIO-DAS16JR/16 (cio-das16jr/16), CIO-DAS1401/12 (cio-das1401/12), - * CIO-DAS1402/12 (cio-das1402/12), CIO-DAS1402/16 (cio-das1402/16), - * CIO-DAS1601/12 (cio-das1601/12), CIO-DAS1602/12 (cio-das1602/12), - * CIO-DAS1602/16 (cio-das1602/16), CIO-DAS16/330 (cio-das16/330) - * Status: works - * Updated: 2003-10-12 - * - * A rewrite of the das16 and das1600 drivers. - * - * Options: - * [0] - base io address - * [1] - irq (does nothing, irq is not used anymore) - * [2] - dma channel (optional, required for comedi_command support) - * [3] - master clock speed in MHz (optional, 1 or 10, ignored if - * board can probe clock, defaults to 1) - * [4] - analog input range lowest voltage in microvolts (optional, - * only useful if your board does not have software - * programmable gain) - * [5] - analog input range highest voltage in microvolts (optional, - * only useful if board does not have software programmable - * gain) - * [6] - analog output range lowest voltage in microvolts (optional) - * [7] - analog output range highest voltage in microvolts (optional) - * - * Passing a zero for an option is the same as leaving it unspecified. - */ - -/* - * Testing and debugging help provided by Daniel Koch. - * - * Keithley Manuals: - * 2309.PDF (das16) - * 4919.PDF (das1400, 1600) - * 4922.PDF (das-1400) - * 4923.PDF (das1200, 1400, 1600) - * - * Computer boards manuals also available from their website - * www.measurementcomputing.com - */ - -#include <linux/module.h> -#include <linux/slab.h> -#include <linux/interrupt.h> - -#include "../comedidev.h" - -#include "comedi_isadma.h" -#include "comedi_8254.h" -#include "8255.h" - -#define DAS16_DMA_SIZE 0xff00 /* size in bytes of allocated dma buffer */ - -/* - * Register I/O map - */ -#define DAS16_TRIG_REG 0x00 -#define DAS16_AI_LSB_REG 0x00 -#define DAS16_AI_MSB_REG 0x01 -#define DAS16_MUX_REG 0x02 -#define DAS16_DIO_REG 0x03 -#define DAS16_AO_LSB_REG(x) ((x) ? 0x06 : 0x04) -#define DAS16_AO_MSB_REG(x) ((x) ? 0x07 : 0x05) -#define DAS16_STATUS_REG 0x08 -#define DAS16_STATUS_BUSY BIT(7) -#define DAS16_STATUS_UNIPOLAR BIT(6) -#define DAS16_STATUS_MUXBIT BIT(5) -#define DAS16_STATUS_INT BIT(4) -#define DAS16_CTRL_REG 0x09 -#define DAS16_CTRL_INTE BIT(7) -#define DAS16_CTRL_IRQ(x) (((x) & 0x7) << 4) -#define DAS16_CTRL_DMAE BIT(2) -#define DAS16_CTRL_PACING_MASK (3 << 0) -#define DAS16_CTRL_INT_PACER (3 << 0) -#define DAS16_CTRL_EXT_PACER (2 << 0) -#define DAS16_CTRL_SOFT_PACER (0 << 0) -#define DAS16_PACER_REG 0x0a -#define DAS16_PACER_BURST_LEN(x) (((x) & 0xf) << 4) -#define DAS16_PACER_CTR0 BIT(1) -#define DAS16_PACER_TRIG0 BIT(0) -#define DAS16_GAIN_REG 0x0b -#define DAS16_TIMER_BASE_REG 0x0c /* to 0x0f */ - -#define DAS1600_CONV_REG 0x404 -#define DAS1600_CONV_DISABLE BIT(6) -#define DAS1600_BURST_REG 0x405 -#define DAS1600_BURST_VAL BIT(6) -#define DAS1600_ENABLE_REG 0x406 -#define DAS1600_ENABLE_VAL BIT(6) -#define DAS1600_STATUS_REG 0x407 -#define DAS1600_STATUS_BME BIT(6) -#define DAS1600_STATUS_ME BIT(5) -#define DAS1600_STATUS_CD BIT(4) -#define DAS1600_STATUS_WS BIT(1) -#define DAS1600_STATUS_CLK_10MHZ BIT(0) - -static const struct comedi_lrange range_das1x01_bip = { - 4, { - BIP_RANGE(10), - BIP_RANGE(1), - BIP_RANGE(0.1), - BIP_RANGE(0.01) - } -}; - -static const struct comedi_lrange range_das1x01_unip = { - 4, { - UNI_RANGE(10), - UNI_RANGE(1), - UNI_RANGE(0.1), - UNI_RANGE(0.01) - } -}; - -static const struct comedi_lrange range_das1x02_bip = { - 4, { - BIP_RANGE(10), - BIP_RANGE(5), - BIP_RANGE(2.5), - BIP_RANGE(1.25) - } -}; - -static const struct comedi_lrange range_das1x02_unip = { - 4, { - UNI_RANGE(10), - UNI_RANGE(5), - UNI_RANGE(2.5), - UNI_RANGE(1.25) - } -}; - -static const struct comedi_lrange range_das16jr = { - 9, { - BIP_RANGE(10), - BIP_RANGE(5), - BIP_RANGE(2.5), - BIP_RANGE(1.25), - BIP_RANGE(0.625), - UNI_RANGE(10), - UNI_RANGE(5), - UNI_RANGE(2.5), - UNI_RANGE(1.25) - } -}; - -static const struct comedi_lrange range_das16jr_16 = { - 8, { - BIP_RANGE(10), - BIP_RANGE(5), - BIP_RANGE(2.5), - BIP_RANGE(1.25), - UNI_RANGE(10), - UNI_RANGE(5), - UNI_RANGE(2.5), - UNI_RANGE(1.25) - } -}; - -static const int das16jr_gainlist[] = { 8, 0, 1, 2, 3, 4, 5, 6, 7 }; -static const int das16jr_16_gainlist[] = { 0, 1, 2, 3, 4, 5, 6, 7 }; -static const int das1600_gainlist[] = { 0, 1, 2, 3 }; - -enum { - das16_pg_none = 0, - das16_pg_16jr, - das16_pg_16jr_16, - das16_pg_1601, - das16_pg_1602, -}; - -static const int *const das16_gainlists[] = { - NULL, - das16jr_gainlist, - das16jr_16_gainlist, - das1600_gainlist, - das1600_gainlist, -}; - -static const struct comedi_lrange *const das16_ai_uni_lranges[] = { - &range_unknown, - &range_das16jr, - &range_das16jr_16, - &range_das1x01_unip, - &range_das1x02_unip, -}; - -static const struct comedi_lrange *const das16_ai_bip_lranges[] = { - &range_unknown, - &range_das16jr, - &range_das16jr_16, - &range_das1x01_bip, - &range_das1x02_bip, -}; - -struct das16_board { - const char *name; - unsigned int ai_maxdata; - unsigned int ai_speed; /* max conversion speed in nanosec */ - unsigned int ai_pg; - unsigned int has_ao:1; - unsigned int has_8255:1; - - unsigned int i8255_offset; - - unsigned int size; - unsigned int id; -}; - -static const struct das16_board das16_boards[] = { - { - .name = "das-16", - .ai_maxdata = 0x0fff, - .ai_speed = 15000, - .ai_pg = das16_pg_none, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x10, - .size = 0x14, - .id = 0x00, - }, { - .name = "das-16g", - .ai_maxdata = 0x0fff, - .ai_speed = 15000, - .ai_pg = das16_pg_none, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x10, - .size = 0x14, - .id = 0x00, - }, { - .name = "das-16f", - .ai_maxdata = 0x0fff, - .ai_speed = 8500, - .ai_pg = das16_pg_none, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x10, - .size = 0x14, - .id = 0x00, - }, { - .name = "cio-das16", - .ai_maxdata = 0x0fff, - .ai_speed = 20000, - .ai_pg = das16_pg_none, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x10, - .size = 0x14, - .id = 0x80, - }, { - .name = "cio-das16/f", - .ai_maxdata = 0x0fff, - .ai_speed = 10000, - .ai_pg = das16_pg_none, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x10, - .size = 0x14, - .id = 0x80, - }, { - .name = "cio-das16/jr", - .ai_maxdata = 0x0fff, - .ai_speed = 7692, - .ai_pg = das16_pg_16jr, - .size = 0x10, - .id = 0x00, - }, { - .name = "pc104-das16jr", - .ai_maxdata = 0x0fff, - .ai_speed = 3300, - .ai_pg = das16_pg_16jr, - .size = 0x10, - .id = 0x00, - }, { - .name = "cio-das16jr/16", - .ai_maxdata = 0xffff, - .ai_speed = 10000, - .ai_pg = das16_pg_16jr_16, - .size = 0x10, - .id = 0x00, - }, { - .name = "pc104-das16jr/16", - .ai_maxdata = 0xffff, - .ai_speed = 10000, - .ai_pg = das16_pg_16jr_16, - .size = 0x10, - .id = 0x00, - }, { - .name = "das-1201", - .ai_maxdata = 0x0fff, - .ai_speed = 20000, - .ai_pg = das16_pg_none, - .has_8255 = 1, - .i8255_offset = 0x400, - .size = 0x408, - .id = 0x20, - }, { - .name = "das-1202", - .ai_maxdata = 0x0fff, - .ai_speed = 10000, - .ai_pg = das16_pg_none, - .has_8255 = 1, - .i8255_offset = 0x400, - .size = 0x408, - .id = 0x20, - }, { - .name = "das-1401", - .ai_maxdata = 0x0fff, - .ai_speed = 10000, - .ai_pg = das16_pg_1601, - .size = 0x408, - .id = 0xc0, - }, { - .name = "das-1402", - .ai_maxdata = 0x0fff, - .ai_speed = 10000, - .ai_pg = das16_pg_1602, - .size = 0x408, - .id = 0xc0, - }, { - .name = "das-1601", - .ai_maxdata = 0x0fff, - .ai_speed = 10000, - .ai_pg = das16_pg_1601, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x400, - .size = 0x408, - .id = 0xc0, - }, { - .name = "das-1602", - .ai_maxdata = 0x0fff, - .ai_speed = 10000, - .ai_pg = das16_pg_1602, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x400, - .size = 0x408, - .id = 0xc0, - }, { - .name = "cio-das1401/12", - .ai_maxdata = 0x0fff, - .ai_speed = 6250, - .ai_pg = das16_pg_1601, - .size = 0x408, - .id = 0xc0, - }, { - .name = "cio-das1402/12", - .ai_maxdata = 0x0fff, - .ai_speed = 6250, - .ai_pg = das16_pg_1602, - .size = 0x408, - .id = 0xc0, - }, { - .name = "cio-das1402/16", - .ai_maxdata = 0xffff, - .ai_speed = 10000, - .ai_pg = das16_pg_1602, - .size = 0x408, - .id = 0xc0, - }, { - .name = "cio-das1601/12", - .ai_maxdata = 0x0fff, - .ai_speed = 6250, - .ai_pg = das16_pg_1601, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x400, - .size = 0x408, - .id = 0xc0, - }, { - .name = "cio-das1602/12", - .ai_maxdata = 0x0fff, - .ai_speed = 10000, - .ai_pg = das16_pg_1602, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x400, - .size = 0x408, - .id = 0xc0, - }, { - .name = "cio-das1602/16", - .ai_maxdata = 0xffff, - .ai_speed = 10000, - .ai_pg = das16_pg_1602, - .has_ao = 1, - .has_8255 = 1, - .i8255_offset = 0x400, - .size = 0x408, - .id = 0xc0, - }, { - .name = "cio-das16/330", - .ai_maxdata = 0x0fff, - .ai_speed = 3030, - .ai_pg = das16_pg_16jr, - .size = 0x14, - .id = 0xf0, - }, -}; - -/* - * Period for timer interrupt in jiffies. It's a function - * to deal with possibility of dynamic HZ patches - */ -static inline int timer_period(void) -{ - return HZ / 20; -} - -struct das16_private_struct { - struct comedi_isadma *dma; - struct comedi_device *dev; - unsigned int clockbase; - unsigned int ctrl_reg; - unsigned int divisor1; - unsigned int divisor2; - struct timer_list timer; - unsigned long extra_iobase; - unsigned int can_burst:1; - unsigned int timer_running:1; -}; - -static void das16_ai_setup_dma(struct comedi_device *dev, - struct comedi_subdevice *s, - unsigned int unread_samples) -{ - struct das16_private_struct *devpriv = dev->private; - struct comedi_isadma *dma = devpriv->dma; - struct comedi_isadma_desc *desc = &dma->desc[dma->cur_dma]; - unsigned int max_samples = comedi_bytes_to_samples(s, desc->maxsize); - unsigned int nsamples; - - /* - * Determine dma size based on the buffer size plus the number of - * unread samples and the number of samples remaining in the command. - */ - nsamples = comedi_nsamples_left(s, max_samples + unread_samples); - if (nsamples > unread_samples) { - nsamples -= unread_samples; - desc->size = comedi_samples_to_bytes(s, nsamples); - comedi_isadma_program(desc); - } -} - -static void das16_interrupt(struct comedi_device *dev) -{ - struct das16_private_struct *devpriv = dev->private; - struct comedi_subdevice *s = dev->read_subdev; - struct comedi_async *async = s->async; - struct comedi_cmd *cmd = &async->cmd; - struct comedi_isadma *dma = devpriv->dma; - struct comedi_isadma_desc *desc = &dma->desc[dma->cur_dma]; - unsigned long spin_flags; - unsigned int residue; - unsigned int nbytes; - unsigned int nsamples; - - spin_lock_irqsave(&dev->spinlock, spin_flags); - if (!(devpriv->ctrl_reg & DAS16_CTRL_DMAE)) { - spin_unlock_irqrestore(&dev->spinlock, spin_flags); - return; - } - - /* - * The pc104-das16jr (at least) has problems if the dma - * transfer is interrupted in the middle of transferring - * a 16 bit sample. - */ - residue = comedi_isadma_disable_on_sample(desc->chan, - comedi_bytes_per_sample(s)); - - /* figure out how many samples to read */ - if (residue > desc->size) { - dev_err(dev->class_dev, "residue > transfer size!\n"); - async->events |= COMEDI_CB_ERROR; - nbytes = 0; - } else { - nbytes = desc->size - residue; - } - nsamples = comedi_bytes_to_samples(s, nbytes); - - /* restart DMA if more samples are needed */ - if (nsamples) { - dma->cur_dma = 1 - dma->cur_dma; - das16_ai_setup_dma(dev, s, nsamples); - } - - spin_unlock_irqrestore(&dev->spinlock, spin_flags); - - comedi_buf_write_samples(s, desc->virt_addr, nsamples); - - if (cmd->stop_src == TRIG_COUNT && async->scans_done >= cmd->stop_arg) - async->events |= COMEDI_CB_EOA; - - comedi_handle_events(dev, s); -} - -static void das16_timer_interrupt(struct timer_list *t) -{ - struct das16_private_struct *devpriv = from_timer(devpriv, t, timer); - struct comedi_device *dev = devpriv->dev; - unsigned long flags; - - das16_interrupt(dev); - - spin_lock_irqsave(&dev->spinlock, flags); - if (devpriv->timer_running) - mod_timer(&devpriv->timer, jiffies + timer_period()); - spin_unlock_irqrestore(&dev->spinlock, flags); -} - -static void das16_ai_set_mux_range(struct comedi_device *dev, - unsigned int first_chan, - unsigned int last_chan, - unsigned int range) -{ - const struct das16_board *board = dev->board_ptr; - - /* set multiplexer */ - outb(first_chan | (last_chan << 4), dev->iobase + DAS16_MUX_REG); - - /* some boards do not have programmable gain */ - if (board->ai_pg == das16_pg_none) - return; - - /* - * Set gain (this is also burst rate register but according to - * computer boards manual, burst rate does nothing, even on - * keithley cards). - */ - outb((das16_gainlists[board->ai_pg])[range], - dev->iobase + DAS16_GAIN_REG); -} - -static int das16_ai_check_chanlist(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_cmd *cmd) -{ - unsigned int chan0 = CR_CHAN(cmd->chanlist[0]); - unsigned int range0 = CR_RANGE(cmd->chanlist[0]); - int i; - - for (i = 1; i < cmd->chanlist_len; i++) { - unsigned int chan = CR_CHAN(cmd->chanlist[i]); - unsigned int range = CR_RANGE(cmd->chanlist[i]); - - if (chan != ((chan0 + i) % s->n_chan)) { - dev_dbg(dev->class_dev, - "entries in chanlist must be consecutive channels, counting upwards\n"); - return -EINVAL; - } - - if (range != range0) { - dev_dbg(dev->class_dev, - "entries in chanlist must all have the same gain\n"); - return -EINVAL; - } - } - - return 0; -} - -static int das16_cmd_test(struct comedi_device *dev, struct comedi_subdevice *s, - struct comedi_cmd *cmd) -{ - const struct das16_board *board = dev->board_ptr; - struct das16_private_struct *devpriv = dev->private; - int err = 0; - unsigned int trig_mask; - unsigned int arg; - - /* Step 1 : check if triggers are trivially valid */ - - err |= comedi_check_trigger_src(&cmd->start_src, TRIG_NOW); - - trig_mask = TRIG_FOLLOW; - if (devpriv->can_burst) - trig_mask |= TRIG_TIMER | TRIG_EXT; - err |= comedi_check_trigger_src(&cmd->scan_begin_src, trig_mask); - - trig_mask = TRIG_TIMER | TRIG_EXT; - if (devpriv->can_burst) - trig_mask |= TRIG_NOW; - err |= comedi_check_trigger_src(&cmd->convert_src, trig_mask); - - err |= comedi_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT); - err |= comedi_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE); - - if (err) - return 1; - - /* Step 2a : make sure trigger sources are unique */ - - err |= comedi_check_trigger_is_unique(cmd->scan_begin_src); - err |= comedi_check_trigger_is_unique(cmd->convert_src); - err |= comedi_check_trigger_is_unique(cmd->stop_src); - - /* Step 2b : and mutually compatible */ - - /* make sure scan_begin_src and convert_src don't conflict */ - if (cmd->scan_begin_src == TRIG_FOLLOW && cmd->convert_src == TRIG_NOW) - err |= -EINVAL; - if (cmd->scan_begin_src != TRIG_FOLLOW && cmd->convert_src != TRIG_NOW) - err |= -EINVAL; - - if (err) - return 2; - - /* Step 3: check if arguments are trivially valid */ - - err |= comedi_check_trigger_arg_is(&cmd->start_arg, 0); - - if (cmd->scan_begin_src == TRIG_FOLLOW) /* internal trigger */ - err |= comedi_check_trigger_arg_is(&cmd->scan_begin_arg, 0); - - err |= comedi_check_trigger_arg_is(&cmd->scan_end_arg, - cmd->chanlist_len); - - /* check against maximum frequency */ - if (cmd->scan_begin_src == TRIG_TIMER) { - err |= comedi_check_trigger_arg_min(&cmd->scan_begin_arg, - board->ai_speed * - cmd->chanlist_len); - } - - if (cmd->convert_src == TRIG_TIMER) { - err |= comedi_check_trigger_arg_min(&cmd->convert_arg, - board->ai_speed); - } - - if (cmd->stop_src == TRIG_COUNT) - err |= comedi_check_trigger_arg_min(&cmd->stop_arg, 1); - else /* TRIG_NONE */ - err |= comedi_check_trigger_arg_is(&cmd->stop_arg, 0); - - if (err) - return 3; - - /* step 4: fix up arguments */ - if (cmd->scan_begin_src == TRIG_TIMER) { - arg = cmd->scan_begin_arg; - comedi_8254_cascade_ns_to_timer(dev->pacer, &arg, cmd->flags); - err |= comedi_check_trigger_arg_is(&cmd->scan_begin_arg, arg); - } - if (cmd->convert_src == TRIG_TIMER) { - arg = cmd->convert_arg; - comedi_8254_cascade_ns_to_timer(dev->pacer, &arg, cmd->flags); - err |= comedi_check_trigger_arg_is(&cmd->convert_arg, arg); - } - if (err) - return 4; - - /* Step 5: check channel list if it exists */ - if (cmd->chanlist && cmd->chanlist_len > 0) - err |= das16_ai_check_chanlist(dev, s, cmd); - - if (err) - return 5; - - return 0; -} - -static unsigned int das16_set_pacer(struct comedi_device *dev, unsigned int ns, - unsigned int flags) -{ - comedi_8254_cascade_ns_to_timer(dev->pacer, &ns, flags); - comedi_8254_update_divisors(dev->pacer); - comedi_8254_pacer_enable(dev->pacer, 1, 2, true); - - return ns; -} - -static int das16_cmd_exec(struct comedi_device *dev, struct comedi_subdevice *s) -{ - struct das16_private_struct *devpriv = dev->private; - struct comedi_isadma *dma = devpriv->dma; - struct comedi_async *async = s->async; - struct comedi_cmd *cmd = &async->cmd; - unsigned int first_chan = CR_CHAN(cmd->chanlist[0]); - unsigned int last_chan = CR_CHAN(cmd->chanlist[cmd->chanlist_len - 1]); - unsigned int range = CR_RANGE(cmd->chanlist[0]); - unsigned int byte; - unsigned long flags; - - if (cmd->flags & CMDF_PRIORITY) { - dev_err(dev->class_dev, - "isa dma transfers cannot be performed with CMDF_PRIORITY, aborting\n"); - return -1; - } - - if (devpriv->can_burst) - outb(DAS1600_CONV_DISABLE, dev->iobase + DAS1600_CONV_REG); - - /* set mux and range for chanlist scan */ - das16_ai_set_mux_range(dev, first_chan, last_chan, range); - - /* set counter mode and counts */ - cmd->convert_arg = das16_set_pacer(dev, cmd->convert_arg, cmd->flags); - - /* enable counters */ - byte = 0; - if (devpriv->can_burst) { - if (cmd->convert_src == TRIG_NOW) { - outb(DAS1600_BURST_VAL, - dev->iobase + DAS1600_BURST_REG); - /* set burst length */ - byte |= DAS16_PACER_BURST_LEN(cmd->chanlist_len - 1); - } else { - outb(0, dev->iobase + DAS1600_BURST_REG); - } - } - outb(byte, dev->iobase + DAS16_PACER_REG); - - /* set up dma transfer */ - dma->cur_dma = 0; - das16_ai_setup_dma(dev, s, 0); - - /* set up timer */ - spin_lock_irqsave(&dev->spinlock, flags); - devpriv->timer_running = 1; - devpriv->timer.expires = jiffies + timer_period(); - add_timer(&devpriv->timer); - - /* enable DMA interrupt with external or internal pacing */ - devpriv->ctrl_reg &= ~(DAS16_CTRL_INTE | DAS16_CTRL_PACING_MASK); - devpriv->ctrl_reg |= DAS16_CTRL_DMAE; - if (cmd->convert_src == TRIG_EXT) - devpriv->ctrl_reg |= DAS16_CTRL_EXT_PACER; - else - devpriv->ctrl_reg |= DAS16_CTRL_INT_PACER; - outb(devpriv->ctrl_reg, dev->iobase + DAS16_CTRL_REG); - - if (devpriv->can_burst) - outb(0, dev->iobase + DAS1600_CONV_REG); - spin_unlock_irqrestore(&dev->spinlock, flags); - - return 0; -} - -static int das16_cancel(struct comedi_device *dev, struct comedi_subdevice *s) -{ - struct das16_private_struct *devpriv = dev->private; - struct comedi_isadma *dma = devpriv->dma; - unsigned long flags; - - spin_lock_irqsave(&dev->spinlock, flags); - - /* disable interrupts, dma and pacer clocked conversions */ - devpriv->ctrl_reg &= ~(DAS16_CTRL_INTE | DAS16_CTRL_DMAE | - DAS16_CTRL_PACING_MASK); - outb(devpriv->ctrl_reg, dev->iobase + DAS16_CTRL_REG); - - comedi_isadma_disable(dma->chan); - - /* disable SW timer */ - if (devpriv->timer_running) { - devpriv->timer_running = 0; - del_timer(&devpriv->timer); - } - - if (devpriv->can_burst) - outb(0, dev->iobase + DAS1600_BURST_REG); - - spin_unlock_irqrestore(&dev->spinlock, flags); - - return 0; -} - -static void das16_ai_munge(struct comedi_device *dev, - struct comedi_subdevice *s, void *array, - unsigned int num_bytes, - unsigned int start_chan_index) -{ - unsigned short *data = array; - unsigned int num_samples = comedi_bytes_to_samples(s, num_bytes); - unsigned int i; - __le16 *buf = array; - - for (i = 0; i < num_samples; i++) { - data[i] = le16_to_cpu(buf[i]); - if (s->maxdata == 0x0fff) - data[i] >>= 4; - data[i] &= s->maxdata; - } -} - -static int das16_ai_eoc(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_insn *insn, - unsigned long context) -{ - unsigned int status; - - status = inb(dev->iobase + DAS16_STATUS_REG); - if ((status & DAS16_STATUS_BUSY) == 0) - return 0; - return -EBUSY; -} - -static int das16_ai_insn_read(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_insn *insn, - unsigned int *data) -{ - unsigned int chan = CR_CHAN(insn->chanspec); - unsigned int range = CR_RANGE(insn->chanspec); - unsigned int val; - int ret; - int i; - - /* set mux and range for single channel */ - das16_ai_set_mux_range(dev, chan, chan, range); - - for (i = 0; i < insn->n; i++) { - /* trigger conversion */ - outb_p(0, dev->iobase + DAS16_TRIG_REG); - - ret = comedi_timeout(dev, s, insn, das16_ai_eoc, 0); - if (ret) - return ret; - - val = inb(dev->iobase + DAS16_AI_MSB_REG) << 8; - val |= inb(dev->iobase + DAS16_AI_LSB_REG); - if (s->maxdata == 0x0fff) - val >>= 4; - val &= s->maxdata; - - data[i] = val; - } - - return insn->n; -} - -static int das16_ao_insn_write(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_insn *insn, - unsigned int *data) -{ - unsigned int chan = CR_CHAN(insn->chanspec); - int i; - - for (i = 0; i < insn->n; i++) { - unsigned int val = data[i]; - - s->readback[chan] = val; - - val <<= 4; - - outb(val & 0xff, dev->iobase + DAS16_AO_LSB_REG(chan)); - outb((val >> 8) & 0xff, dev->iobase + DAS16_AO_MSB_REG(chan)); - } - - return insn->n; -} - -static int das16_di_insn_bits(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_insn *insn, - unsigned int *data) -{ - data[1] = inb(dev->iobase + DAS16_DIO_REG) & 0xf; - - return insn->n; -} - -static int das16_do_insn_bits(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_insn *insn, - unsigned int *data) -{ - if (comedi_dio_update_state(s, data)) - outb(s->state, dev->iobase + DAS16_DIO_REG); - - data[1] = s->state; - - return insn->n; -} - -static int das16_probe(struct comedi_device *dev, struct comedi_devconfig *it) -{ - const struct das16_board *board = dev->board_ptr; - int diobits; - - /* diobits indicates boards */ - diobits = inb(dev->iobase + DAS16_DIO_REG) & 0xf0; - if (board->id != diobits) { - dev_err(dev->class_dev, - "requested board's id bits are incorrect (0x%x != 0x%x)\n", - board->id, diobits); - return -EINVAL; - } - - return 0; -} - -static void das16_reset(struct comedi_device *dev) -{ - outb(0, dev->iobase + DAS16_STATUS_REG); - outb(0, dev->iobase + DAS16_CTRL_REG); - outb(0, dev->iobase + DAS16_PACER_REG); -} - -static void das16_alloc_dma(struct comedi_device *dev, unsigned int dma_chan) -{ - struct das16_private_struct *devpriv = dev->private; - - timer_setup(&devpriv->timer, das16_timer_interrupt, 0); - - /* only DMA channels 3 and 1 are valid */ - if (!(dma_chan == 1 || dma_chan == 3)) - return; - - /* DMA uses two buffers */ - devpriv->dma = comedi_isadma_alloc(dev, 2, dma_chan, dma_chan, - DAS16_DMA_SIZE, COMEDI_ISADMA_READ); -} - -static void das16_free_dma(struct comedi_device *dev) -{ - struct das16_private_struct *devpriv = dev->private; - - if (devpriv) { - del_timer_sync(&devpriv->timer); - comedi_isadma_free(devpriv->dma); - } -} - -static const struct comedi_lrange *das16_ai_range(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_devconfig *it, - unsigned int pg_type, - unsigned int status) -{ - unsigned int min = it->options[4]; - unsigned int max = it->options[5]; - - /* get any user-defined input range */ - if (pg_type == das16_pg_none && (min || max)) { - struct comedi_lrange *lrange; - struct comedi_krange *krange; - - /* allocate single-range range table */ - lrange = comedi_alloc_spriv(s, - sizeof(*lrange) + sizeof(*krange)); - if (!lrange) - return &range_unknown; - - /* initialize ai range */ - lrange->length = 1; - krange = lrange->range; - krange->min = min; - krange->max = max; - krange->flags = UNIT_volt; - - return lrange; - } - - /* use software programmable range */ - if (status & DAS16_STATUS_UNIPOLAR) - return das16_ai_uni_lranges[pg_type]; - return das16_ai_bip_lranges[pg_type]; -} - -static const struct comedi_lrange *das16_ao_range(struct comedi_device *dev, - struct comedi_subdevice *s, - struct comedi_devconfig *it) -{ - unsigned int min = it->options[6]; - unsigned int max = it->options[7]; - - /* get any user-defined output range */ - if (min || max) { - struct comedi_lrange *lrange; - struct comedi_krange *krange; - - /* allocate single-range range table */ - lrange = comedi_alloc_spriv(s, - sizeof(*lrange) + sizeof(*krange)); - if (!lrange) - return &range_unknown; - - /* initialize ao range */ - lrange->length = 1; - krange = lrange->range; - krange->min = min; - krange->max = max; - krange->flags = UNIT_volt; - - return lrange; - } - - return &range_unknown; -} - -static int das16_attach(struct comedi_device *dev, struct comedi_devconfig *it) -{ - const struct das16_board *board = dev->board_ptr; - struct das16_private_struct *devpriv; - struct comedi_subdevice *s; - unsigned int osc_base; - unsigned int status; - int ret; - - /* check that clock setting is valid */ - if (it->options[3]) { - if (it->options[3] != 1 && it->options[3] != 10) { - dev_err(dev->class_dev, - "Invalid option. Master clock must be set to 1 or 10 (MHz)\n"); - return -EINVAL; - } - } - - devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv)); - if (!devpriv) - return -ENOMEM; - devpriv->dev = dev; - - if (board->size < 0x400) { - ret = comedi_request_region(dev, it->options[0], board->size); - if (ret) - return ret; - } else { - ret = comedi_request_region(dev, it->options[0], 0x10); - if (ret) - return ret; - /* Request an additional region for the 8255 */ - ret = __comedi_request_region(dev, dev->iobase + 0x400, - board->size & 0x3ff); - if (ret) - return ret; - devpriv->extra_iobase = dev->iobase + 0x400; - devpriv->can_burst = 1; - } - - /* probe id bits to make sure they are consistent */ - if (das16_probe(dev, it)) - return -EINVAL; - - /* get master clock speed */ - osc_base = I8254_OSC_BASE_1MHZ; - if (devpriv->can_burst) { - status = inb(dev->iobase + DAS1600_STATUS_REG); - if (status & DAS1600_STATUS_CLK_10MHZ) - osc_base = I8254_OSC_BASE_10MHZ; - } else { - if (it->options[3]) - osc_base = I8254_OSC_BASE_1MHZ / it->options[3]; - } - - dev->pacer = comedi_8254_init(dev->iobase + DAS16_TIMER_BASE_REG, - osc_base, I8254_IO8, 0); - if (!dev->pacer) - return -ENOMEM; - - das16_alloc_dma(dev, it->options[2]); - - ret = comedi_alloc_subdevices(dev, 4 + board->has_8255); - if (ret) - return ret; - - status = inb(dev->iobase + DAS16_STATUS_REG); - - /* Analog Input subdevice */ - s = &dev->subdevices[0]; - s->type = COMEDI_SUBD_AI; - s->subdev_flags = SDF_READABLE; - if (status & DAS16_STATUS_MUXBIT) { - s->subdev_flags |= SDF_GROUND; - s->n_chan = 16; - } else { - s->subdev_flags |= SDF_DIFF; - s->n_chan = 8; - } - s->len_chanlist = s->n_chan; - s->maxdata = board->ai_maxdata; - s->range_table = das16_ai_range(dev, s, it, board->ai_pg, status); - s->insn_read = das16_ai_insn_read; - if (devpriv->dma) { - dev->read_subdev = s; - s->subdev_flags |= SDF_CMD_READ; - s->do_cmdtest = das16_cmd_test; - s->do_cmd = das16_cmd_exec; - s->cancel = das16_cancel; - s->munge = das16_ai_munge; - } - - /* Analog Output subdevice */ - s = &dev->subdevices[1]; - if (board->has_ao) { - s->type = COMEDI_SUBD_AO; - s->subdev_flags = SDF_WRITABLE; - s->n_chan = 2; - s->maxdata = 0x0fff; - s->range_table = das16_ao_range(dev, s, it); - s->insn_write = das16_ao_insn_write; - - ret = comedi_alloc_subdev_readback(s); - if (ret) - return ret; - } else { - s->type = COMEDI_SUBD_UNUSED; - } - - /* Digital Input subdevice */ - s = &dev->subdevices[2]; - s->type = COMEDI_SUBD_DI; - s->subdev_flags = SDF_READABLE; - s->n_chan = 4; - s->maxdata = 1; - s->range_table = &range_digital; - s->insn_bits = das16_di_insn_bits; - - /* Digital Output subdevice */ - s = &dev->subdevices[3]; - s->type = COMEDI_SUBD_DO; - s->subdev_flags = SDF_WRITABLE; - s->n_chan = 4; - s->maxdata = 1; - s->range_table = &range_digital; - s->insn_bits = das16_do_insn_bits; - - /* initialize digital output lines */ - outb(s->state, dev->iobase + DAS16_DIO_REG); - - /* 8255 Digital I/O subdevice */ - if (board->has_8255) { - s = &dev->subdevices[4]; - ret = subdev_8255_init(dev, s, NULL, board->i8255_offset); - if (ret) - return ret; - } - - das16_reset(dev); - /* set the interrupt level */ - devpriv->ctrl_reg = DAS16_CTRL_IRQ(dev->irq); - outb(devpriv->ctrl_reg, dev->iobase + DAS16_CTRL_REG); - - if (devpriv->can_burst) { - outb(DAS1600_ENABLE_VAL, dev->iobase + DAS1600_ENABLE_REG); - outb(0, dev->iobase + DAS1600_CONV_REG); - outb(0, dev->iobase + DAS1600_BURST_REG); - } - - return 0; -} - -static void das16_detach(struct comedi_device *dev) -{ - const struct das16_board *board = dev->board_ptr; - struct das16_private_struct *devpriv = dev->private; - - if (devpriv) { - if (dev->iobase) - das16_reset(dev); - das16_free_dma(dev); - - if (devpriv->extra_iobase) - release_region(devpriv->extra_iobase, - board->size & 0x3ff); - } - - comedi_legacy_detach(dev); -} - -static struct comedi_driver das16_driver = { - .driver_name = "das16", - .module = THIS_MODULE, - .attach = das16_attach, - .detach = das16_detach, - .board_name = &das16_boards[0].name, - .num_names = ARRAY_SIZE(das16_boards), - .offset = sizeof(das16_boards[0]), -}; -module_comedi_driver(das16_driver); - -MODULE_AUTHOR("Comedi https://www.comedi.org"); -MODULE_DESCRIPTION("Comedi driver for DAS16 compatible boards"); -MODULE_LICENSE("GPL"); |