Staging: comedi: add das16m1 driver
Driver for Measurement Computing CIO-DAS16/M1 From: Frank Mori Hess <fmhess@users.sourceforge.net> Cc: David Schleef <ds@schleef.org> Cc: Ian Abbott <abbotti@mev.co.uk> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
f0922ec52c
commit
9afbebe411
|
@ -0,0 +1,765 @@
|
||||||
|
/*
|
||||||
|
comedi/drivers/das16m1.c
|
||||||
|
CIO-DAS16/M1 driver
|
||||||
|
Author: Frank Mori Hess, based on code from the das16
|
||||||
|
driver.
|
||||||
|
Copyright (C) 2001 Frank Mori Hess <fmhess@users.sourceforge.net>
|
||||||
|
|
||||||
|
COMEDI - Linux Control and Measurement Device Interface
|
||||||
|
Copyright (C) 2000 David A. Schleef <ds@schleef.org>
|
||||||
|
|
||||||
|
This program is free software; you can redistribute it and/or modify
|
||||||
|
it under the terms of the GNU General Public License as published by
|
||||||
|
the Free Software Foundation; either version 2 of the License, or
|
||||||
|
(at your option) any later version.
|
||||||
|
|
||||||
|
This program is distributed in the hope that it will be useful,
|
||||||
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
GNU General Public License for more details.
|
||||||
|
|
||||||
|
You should have received a copy of the GNU General Public License
|
||||||
|
along with this program; if not, write to the Free Software
|
||||||
|
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||||
|
|
||||||
|
************************************************************************
|
||||||
|
*/
|
||||||
|
/*
|
||||||
|
Driver: das16m1
|
||||||
|
Description: CIO-DAS16/M1
|
||||||
|
Author: Frank Mori Hess <fmhess@users.sourceforge.net>
|
||||||
|
Devices: [Measurement Computing] CIO-DAS16/M1 (cio-das16/m1)
|
||||||
|
Status: works
|
||||||
|
|
||||||
|
This driver supports a single board - the CIO-DAS16/M1.
|
||||||
|
As far as I know, there are no other boards that have
|
||||||
|
the same register layout. Even the CIO-DAS16/M1/16 is
|
||||||
|
significantly different.
|
||||||
|
|
||||||
|
I was _barely_ able to reach the full 1 MHz capability
|
||||||
|
of this board, using a hard real-time interrupt
|
||||||
|
(set the TRIG_RT flag in your comedi_cmd and use
|
||||||
|
rtlinux or RTAI). The board can't do dma, so the bottleneck is
|
||||||
|
pulling the data across the ISA bus. I timed the interrupt
|
||||||
|
handler, and it took my computer ~470 microseconds to pull 512
|
||||||
|
samples from the board. So at 1 Mhz sampling rate,
|
||||||
|
expect your CPU to be spending almost all of its
|
||||||
|
time in the interrupt handler.
|
||||||
|
|
||||||
|
This board has some unusual restrictions for its channel/gain list. If the
|
||||||
|
list has 2 or more channels in it, then two conditions must be satisfied:
|
||||||
|
(1) - even/odd channels must appear at even/odd indices in the list
|
||||||
|
(2) - the list must have an even number of entries.
|
||||||
|
|
||||||
|
Options:
|
||||||
|
[0] - base io address
|
||||||
|
[1] - irq (optional, but you probably want it)
|
||||||
|
|
||||||
|
irq can be omitted, although the cmd interface will not work without it.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <linux/ioport.h>
|
||||||
|
#include "../comedidev.h"
|
||||||
|
|
||||||
|
#include "8255.h"
|
||||||
|
#include "8253.h"
|
||||||
|
#include "comedi_fc.h"
|
||||||
|
|
||||||
|
#define DAS16M1_SIZE 16
|
||||||
|
#define DAS16M1_SIZE2 8
|
||||||
|
|
||||||
|
#define DAS16M1_XTAL 100 //10 MHz master clock
|
||||||
|
|
||||||
|
#define FIFO_SIZE 1024 // 1024 sample fifo
|
||||||
|
|
||||||
|
/*
|
||||||
|
CIO-DAS16_M1.pdf
|
||||||
|
|
||||||
|
"cio-das16/m1"
|
||||||
|
|
||||||
|
0 a/d bits 0-3, mux start 12 bit
|
||||||
|
1 a/d bits 4-11 unused
|
||||||
|
2 status control
|
||||||
|
3 di 4 bit do 4 bit
|
||||||
|
4 unused clear interrupt
|
||||||
|
5 interrupt, pacer
|
||||||
|
6 channel/gain queue address
|
||||||
|
7 channel/gain queue data
|
||||||
|
89ab 8254
|
||||||
|
cdef 8254
|
||||||
|
400 8255
|
||||||
|
404-407 8254
|
||||||
|
|
||||||
|
*/
|
||||||
|
|
||||||
|
#define DAS16M1_AI 0 // 16-bit wide register
|
||||||
|
#define AI_CHAN(x) ((x) & 0xf)
|
||||||
|
#define DAS16M1_CS 2
|
||||||
|
#define EXT_TRIG_BIT 0x1
|
||||||
|
#define OVRUN 0x20
|
||||||
|
#define IRQDATA 0x80
|
||||||
|
#define DAS16M1_DIO 3
|
||||||
|
#define DAS16M1_CLEAR_INTR 4
|
||||||
|
#define DAS16M1_INTR_CONTROL 5
|
||||||
|
#define EXT_PACER 0x2
|
||||||
|
#define INT_PACER 0x3
|
||||||
|
#define PACER_MASK 0x3
|
||||||
|
#define INTE 0x80
|
||||||
|
#define DAS16M1_QUEUE_ADDR 6
|
||||||
|
#define DAS16M1_QUEUE_DATA 7
|
||||||
|
#define Q_CHAN(x) ((x) & 0x7)
|
||||||
|
#define Q_RANGE(x) (((x) & 0xf) << 4)
|
||||||
|
#define UNIPOLAR 0x40
|
||||||
|
#define DAS16M1_8254_FIRST 0x8
|
||||||
|
#define DAS16M1_8254_FIRST_CNTRL 0xb
|
||||||
|
#define TOTAL_CLEAR 0x30
|
||||||
|
#define DAS16M1_8254_SECOND 0xc
|
||||||
|
#define DAS16M1_82C55 0x400
|
||||||
|
#define DAS16M1_8254_THIRD 0x404
|
||||||
|
|
||||||
|
static const comedi_lrange range_das16m1 = { 9,
|
||||||
|
{
|
||||||
|
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),
|
||||||
|
BIP_RANGE(10),
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
static int das16m1_do_wbits(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data);
|
||||||
|
static int das16m1_di_rbits(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data);
|
||||||
|
static int das16m1_ai_rinsn(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data);
|
||||||
|
|
||||||
|
static int das16m1_cmd_test(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_cmd * cmd);
|
||||||
|
static int das16m1_cmd_exec(comedi_device * dev, comedi_subdevice * s);
|
||||||
|
static int das16m1_cancel(comedi_device * dev, comedi_subdevice * s);
|
||||||
|
|
||||||
|
static int das16m1_poll(comedi_device * dev, comedi_subdevice * s);
|
||||||
|
static irqreturn_t das16m1_interrupt(int irq, void *d PT_REGS_ARG);
|
||||||
|
static void das16m1_handler(comedi_device * dev, unsigned int status);
|
||||||
|
|
||||||
|
static unsigned int das16m1_set_pacer(comedi_device * dev, unsigned int ns,
|
||||||
|
int round_flag);
|
||||||
|
|
||||||
|
static int das16m1_irq_bits(unsigned int irq);
|
||||||
|
|
||||||
|
typedef struct das16m1_board_struct {
|
||||||
|
const char *name;
|
||||||
|
unsigned int ai_speed;
|
||||||
|
} das16m1_board;
|
||||||
|
|
||||||
|
static const das16m1_board das16m1_boards[] = {
|
||||||
|
{
|
||||||
|
name: "cio-das16/m1", // CIO-DAS16_M1.pdf
|
||||||
|
ai_speed:1000, // 1MHz max speed
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
|
#define das16m1_num_boards ((sizeof(das16m1_boards)) / (sizeof(das16m1_boards[0])))
|
||||||
|
|
||||||
|
static int das16m1_attach(comedi_device * dev, comedi_devconfig * it);
|
||||||
|
static int das16m1_detach(comedi_device * dev);
|
||||||
|
static comedi_driver driver_das16m1 = {
|
||||||
|
driver_name:"das16m1",
|
||||||
|
module:THIS_MODULE,
|
||||||
|
attach:das16m1_attach,
|
||||||
|
detach:das16m1_detach,
|
||||||
|
board_name:&das16m1_boards[0].name,
|
||||||
|
num_names:das16m1_num_boards,
|
||||||
|
offset:sizeof(das16m1_boards[0]),
|
||||||
|
};
|
||||||
|
|
||||||
|
struct das16m1_private_struct {
|
||||||
|
unsigned int control_state;
|
||||||
|
volatile unsigned int adc_count; // number of samples completed
|
||||||
|
/* initial value in lower half of hardware conversion counter,
|
||||||
|
* needed to keep track of whether new count has been loaded into
|
||||||
|
* counter yet (loaded by first sample conversion) */
|
||||||
|
u16 initial_hw_count;
|
||||||
|
sampl_t ai_buffer[FIFO_SIZE];
|
||||||
|
unsigned int do_bits; // saves status of digital output bits
|
||||||
|
unsigned int divisor1; // divides master clock to obtain conversion speed
|
||||||
|
unsigned int divisor2; // divides master clock to obtain conversion speed
|
||||||
|
};
|
||||||
|
#define devpriv ((struct das16m1_private_struct *)(dev->private))
|
||||||
|
#define thisboard ((const das16m1_board *)(dev->board_ptr))
|
||||||
|
|
||||||
|
COMEDI_INITCLEANUP(driver_das16m1);
|
||||||
|
|
||||||
|
static inline sampl_t munge_sample(sampl_t data)
|
||||||
|
{
|
||||||
|
return (data >> 4) & 0xfff;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_cmd_test(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_cmd * cmd)
|
||||||
|
{
|
||||||
|
unsigned int err = 0, tmp, i;
|
||||||
|
|
||||||
|
/* make sure triggers are valid */
|
||||||
|
tmp = cmd->start_src;
|
||||||
|
cmd->start_src &= TRIG_NOW | TRIG_EXT;
|
||||||
|
if (!cmd->start_src || tmp != cmd->start_src)
|
||||||
|
err++;
|
||||||
|
|
||||||
|
tmp = cmd->scan_begin_src;
|
||||||
|
cmd->scan_begin_src &= TRIG_FOLLOW;
|
||||||
|
if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
|
||||||
|
err++;
|
||||||
|
|
||||||
|
tmp = cmd->convert_src;
|
||||||
|
cmd->convert_src &= TRIG_TIMER | TRIG_EXT;
|
||||||
|
if (!cmd->convert_src || tmp != cmd->convert_src)
|
||||||
|
err++;
|
||||||
|
|
||||||
|
tmp = cmd->scan_end_src;
|
||||||
|
cmd->scan_end_src &= TRIG_COUNT;
|
||||||
|
if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
|
||||||
|
err++;
|
||||||
|
|
||||||
|
tmp = cmd->stop_src;
|
||||||
|
cmd->stop_src &= TRIG_COUNT | TRIG_NONE;
|
||||||
|
if (!cmd->stop_src || tmp != cmd->stop_src)
|
||||||
|
err++;
|
||||||
|
|
||||||
|
if (err)
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
/* step 2: make sure trigger sources are unique and mutually compatible */
|
||||||
|
if (cmd->stop_src != TRIG_COUNT && cmd->stop_src != TRIG_NONE)
|
||||||
|
err++;
|
||||||
|
if (cmd->start_src != TRIG_NOW && cmd->start_src != TRIG_EXT)
|
||||||
|
err++;
|
||||||
|
if (cmd->convert_src != TRIG_TIMER && cmd->convert_src != TRIG_EXT)
|
||||||
|
err++;
|
||||||
|
|
||||||
|
if (err)
|
||||||
|
return 2;
|
||||||
|
|
||||||
|
/* step 3: make sure arguments are trivially compatible */
|
||||||
|
if (cmd->start_arg != 0) {
|
||||||
|
cmd->start_arg = 0;
|
||||||
|
err++;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (cmd->scan_begin_src == TRIG_FOLLOW) {
|
||||||
|
/* internal trigger */
|
||||||
|
if (cmd->scan_begin_arg != 0) {
|
||||||
|
cmd->scan_begin_arg = 0;
|
||||||
|
err++;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (cmd->convert_src == TRIG_TIMER) {
|
||||||
|
if (cmd->convert_arg < thisboard->ai_speed) {
|
||||||
|
cmd->convert_arg = thisboard->ai_speed;
|
||||||
|
err++;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (cmd->scan_end_arg != cmd->chanlist_len) {
|
||||||
|
cmd->scan_end_arg = cmd->chanlist_len;
|
||||||
|
err++;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (cmd->stop_src == TRIG_COUNT) {
|
||||||
|
/* any count is allowed */
|
||||||
|
} else {
|
||||||
|
/* TRIG_NONE */
|
||||||
|
if (cmd->stop_arg != 0) {
|
||||||
|
cmd->stop_arg = 0;
|
||||||
|
err++;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (err)
|
||||||
|
return 3;
|
||||||
|
|
||||||
|
/* step 4: fix up arguments */
|
||||||
|
|
||||||
|
if (cmd->convert_src == TRIG_TIMER) {
|
||||||
|
tmp = cmd->convert_arg;
|
||||||
|
/* calculate counter values that give desired timing */
|
||||||
|
i8253_cascade_ns_to_timer_2div(DAS16M1_XTAL,
|
||||||
|
&(devpriv->divisor1), &(devpriv->divisor2),
|
||||||
|
&(cmd->convert_arg), cmd->flags & TRIG_ROUND_MASK);
|
||||||
|
if (tmp != cmd->convert_arg)
|
||||||
|
err++;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (err)
|
||||||
|
return 4;
|
||||||
|
|
||||||
|
// check chanlist against board's peculiarities
|
||||||
|
if (cmd->chanlist && cmd->chanlist_len > 1) {
|
||||||
|
for (i = 0; i < cmd->chanlist_len; i++) {
|
||||||
|
// even/odd channels must go into even/odd queue addresses
|
||||||
|
if ((i % 2) != (CR_CHAN(cmd->chanlist[i]) % 2)) {
|
||||||
|
comedi_error(dev, "bad chanlist:\n"
|
||||||
|
" even/odd channels must go have even/odd chanlist indices");
|
||||||
|
err++;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if ((cmd->chanlist_len % 2) != 0) {
|
||||||
|
comedi_error(dev,
|
||||||
|
"chanlist must be of even length or length 1");
|
||||||
|
err++;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (err)
|
||||||
|
return 5;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_cmd_exec(comedi_device * dev, comedi_subdevice * s)
|
||||||
|
{
|
||||||
|
comedi_async *async = s->async;
|
||||||
|
comedi_cmd *cmd = &async->cmd;
|
||||||
|
unsigned int byte, i;
|
||||||
|
|
||||||
|
if (dev->irq == 0) {
|
||||||
|
comedi_error(dev, "irq required to execute comedi_cmd");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* disable interrupts and internal pacer */
|
||||||
|
devpriv->control_state &= ~INTE & ~PACER_MASK;
|
||||||
|
outb(devpriv->control_state, dev->iobase + DAS16M1_INTR_CONTROL);
|
||||||
|
|
||||||
|
// set software count
|
||||||
|
devpriv->adc_count = 0;
|
||||||
|
/* Initialize lower half of hardware counter, used to determine how
|
||||||
|
* many samples are in fifo. Value doesn't actually load into counter
|
||||||
|
* until counter's next clock (the next a/d conversion) */
|
||||||
|
i8254_load(dev->iobase + DAS16M1_8254_FIRST, 0, 1, 0, 2);
|
||||||
|
/* remember current reading of counter so we know when counter has
|
||||||
|
* actually been loaded */
|
||||||
|
devpriv->initial_hw_count =
|
||||||
|
i8254_read(dev->iobase + DAS16M1_8254_FIRST, 0, 1);
|
||||||
|
/* setup channel/gain queue */
|
||||||
|
for (i = 0; i < cmd->chanlist_len; i++) {
|
||||||
|
outb(i, dev->iobase + DAS16M1_QUEUE_ADDR);
|
||||||
|
byte = Q_CHAN(CR_CHAN(cmd->
|
||||||
|
chanlist[i])) | Q_RANGE(CR_RANGE(cmd->
|
||||||
|
chanlist[i]));
|
||||||
|
outb(byte, dev->iobase + DAS16M1_QUEUE_DATA);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* set counter mode and counts */
|
||||||
|
cmd->convert_arg =
|
||||||
|
das16m1_set_pacer(dev, cmd->convert_arg,
|
||||||
|
cmd->flags & TRIG_ROUND_MASK);
|
||||||
|
|
||||||
|
// set control & status register
|
||||||
|
byte = 0;
|
||||||
|
/* if we are using external start trigger (also board dislikes having
|
||||||
|
* both start and conversion triggers external simultaneously) */
|
||||||
|
if (cmd->start_src == TRIG_EXT && cmd->convert_src != TRIG_EXT) {
|
||||||
|
byte |= EXT_TRIG_BIT;
|
||||||
|
}
|
||||||
|
outb(byte, dev->iobase + DAS16M1_CS);
|
||||||
|
/* clear interrupt bit */
|
||||||
|
outb(0, dev->iobase + DAS16M1_CLEAR_INTR);
|
||||||
|
|
||||||
|
/* enable interrupts and internal pacer */
|
||||||
|
devpriv->control_state &= ~PACER_MASK;
|
||||||
|
if (cmd->convert_src == TRIG_TIMER) {
|
||||||
|
devpriv->control_state |= INT_PACER;
|
||||||
|
} else {
|
||||||
|
devpriv->control_state |= EXT_PACER;
|
||||||
|
}
|
||||||
|
devpriv->control_state |= INTE;
|
||||||
|
outb(devpriv->control_state, dev->iobase + DAS16M1_INTR_CONTROL);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_cancel(comedi_device * dev, comedi_subdevice * s)
|
||||||
|
{
|
||||||
|
devpriv->control_state &= ~INTE & ~PACER_MASK;
|
||||||
|
outb(devpriv->control_state, dev->iobase + DAS16M1_INTR_CONTROL);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_ai_rinsn(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
int i, n;
|
||||||
|
int byte;
|
||||||
|
const int timeout = 1000;
|
||||||
|
|
||||||
|
/* disable interrupts and internal pacer */
|
||||||
|
devpriv->control_state &= ~INTE & ~PACER_MASK;
|
||||||
|
outb(devpriv->control_state, dev->iobase + DAS16M1_INTR_CONTROL);
|
||||||
|
|
||||||
|
/* setup channel/gain queue */
|
||||||
|
outb(0, dev->iobase + DAS16M1_QUEUE_ADDR);
|
||||||
|
byte = Q_CHAN(CR_CHAN(insn->chanspec)) | Q_RANGE(CR_RANGE(insn->
|
||||||
|
chanspec));
|
||||||
|
outb(byte, dev->iobase + DAS16M1_QUEUE_DATA);
|
||||||
|
|
||||||
|
for (n = 0; n < insn->n; n++) {
|
||||||
|
/* clear IRQDATA bit */
|
||||||
|
outb(0, dev->iobase + DAS16M1_CLEAR_INTR);
|
||||||
|
/* trigger conversion */
|
||||||
|
outb(0, dev->iobase);
|
||||||
|
|
||||||
|
for (i = 0; i < timeout; i++) {
|
||||||
|
if (inb(dev->iobase + DAS16M1_CS) & IRQDATA)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (i == timeout) {
|
||||||
|
comedi_error(dev, "timeout");
|
||||||
|
return -ETIME;
|
||||||
|
}
|
||||||
|
data[n] = munge_sample(inw(dev->iobase));
|
||||||
|
}
|
||||||
|
|
||||||
|
return n;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_di_rbits(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
lsampl_t bits;
|
||||||
|
|
||||||
|
bits = inb(dev->iobase + DAS16M1_DIO) & 0xf;
|
||||||
|
data[1] = bits;
|
||||||
|
data[0] = 0;
|
||||||
|
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_do_wbits(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
lsampl_t wbits;
|
||||||
|
|
||||||
|
// only set bits that have been masked
|
||||||
|
data[0] &= 0xf;
|
||||||
|
wbits = devpriv->do_bits;
|
||||||
|
// zero bits that have been masked
|
||||||
|
wbits &= ~data[0];
|
||||||
|
// set masked bits
|
||||||
|
wbits |= data[0] & data[1];
|
||||||
|
devpriv->do_bits = wbits;
|
||||||
|
data[1] = wbits;
|
||||||
|
|
||||||
|
outb(devpriv->do_bits, dev->iobase + DAS16M1_DIO);
|
||||||
|
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_poll(comedi_device * dev, comedi_subdevice * s)
|
||||||
|
{
|
||||||
|
unsigned long flags;
|
||||||
|
unsigned int status;
|
||||||
|
|
||||||
|
// prevent race with interrupt handler
|
||||||
|
comedi_spin_lock_irqsave(&dev->spinlock, flags);
|
||||||
|
status = inb(dev->iobase + DAS16M1_CS);
|
||||||
|
das16m1_handler(dev, status);
|
||||||
|
comedi_spin_unlock_irqrestore(&dev->spinlock, flags);
|
||||||
|
|
||||||
|
return s->async->buf_write_count - s->async->buf_read_count;
|
||||||
|
}
|
||||||
|
|
||||||
|
static irqreturn_t das16m1_interrupt(int irq, void *d PT_REGS_ARG)
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
comedi_device *dev = d;
|
||||||
|
|
||||||
|
if (dev->attached == 0) {
|
||||||
|
comedi_error(dev, "premature interrupt");
|
||||||
|
return IRQ_HANDLED;
|
||||||
|
}
|
||||||
|
// prevent race with comedi_poll()
|
||||||
|
spin_lock(&dev->spinlock);
|
||||||
|
|
||||||
|
status = inb(dev->iobase + DAS16M1_CS);
|
||||||
|
|
||||||
|
if ((status & (IRQDATA | OVRUN)) == 0) {
|
||||||
|
comedi_error(dev, "spurious interrupt");
|
||||||
|
spin_unlock(&dev->spinlock);
|
||||||
|
return IRQ_NONE;
|
||||||
|
}
|
||||||
|
|
||||||
|
das16m1_handler(dev, status);
|
||||||
|
|
||||||
|
/* clear interrupt */
|
||||||
|
outb(0, dev->iobase + DAS16M1_CLEAR_INTR);
|
||||||
|
|
||||||
|
spin_unlock(&dev->spinlock);
|
||||||
|
return IRQ_HANDLED;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void munge_sample_array(sampl_t * array, unsigned int num_elements)
|
||||||
|
{
|
||||||
|
unsigned int i;
|
||||||
|
|
||||||
|
for (i = 0; i < num_elements; i++) {
|
||||||
|
array[i] = munge_sample(array[i]);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void das16m1_handler(comedi_device * dev, unsigned int status)
|
||||||
|
{
|
||||||
|
comedi_subdevice *s;
|
||||||
|
comedi_async *async;
|
||||||
|
comedi_cmd *cmd;
|
||||||
|
u16 num_samples;
|
||||||
|
u16 hw_counter;
|
||||||
|
|
||||||
|
s = dev->read_subdev;
|
||||||
|
async = s->async;
|
||||||
|
async->events = 0;
|
||||||
|
cmd = &async->cmd;
|
||||||
|
|
||||||
|
// figure out how many samples are in fifo
|
||||||
|
hw_counter = i8254_read(dev->iobase + DAS16M1_8254_FIRST, 0, 1);
|
||||||
|
/* make sure hardware counter reading is not bogus due to initial value
|
||||||
|
* not having been loaded yet */
|
||||||
|
if (devpriv->adc_count == 0 && hw_counter == devpriv->initial_hw_count) {
|
||||||
|
num_samples = 0;
|
||||||
|
} else {
|
||||||
|
/* The calculation of num_samples looks odd, but it uses the following facts.
|
||||||
|
* 16 bit hardware counter is initialized with value of zero (which really
|
||||||
|
* means 0x1000). The counter decrements by one on each conversion
|
||||||
|
* (when the counter decrements from zero it goes to 0xffff). num_samples
|
||||||
|
* is a 16 bit variable, so it will roll over in a similar fashion to the
|
||||||
|
* hardware counter. Work it out, and this is what you get. */
|
||||||
|
num_samples = -hw_counter - devpriv->adc_count;
|
||||||
|
}
|
||||||
|
// check if we only need some of the points
|
||||||
|
if (cmd->stop_src == TRIG_COUNT) {
|
||||||
|
if (num_samples > cmd->stop_arg * cmd->chanlist_len)
|
||||||
|
num_samples = cmd->stop_arg * cmd->chanlist_len;
|
||||||
|
}
|
||||||
|
// make sure we dont try to get too many points if fifo has overrun
|
||||||
|
if (num_samples > FIFO_SIZE)
|
||||||
|
num_samples = FIFO_SIZE;
|
||||||
|
insw(dev->iobase, devpriv->ai_buffer, num_samples);
|
||||||
|
munge_sample_array(devpriv->ai_buffer, num_samples);
|
||||||
|
cfc_write_array_to_buffer(s, devpriv->ai_buffer,
|
||||||
|
num_samples * sizeof(sampl_t));
|
||||||
|
devpriv->adc_count += num_samples;
|
||||||
|
|
||||||
|
if (cmd->stop_src == TRIG_COUNT) {
|
||||||
|
if (devpriv->adc_count >= cmd->stop_arg * cmd->chanlist_len) { /* end of acquisition */
|
||||||
|
das16m1_cancel(dev, s);
|
||||||
|
async->events |= COMEDI_CB_EOA;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* this probably won't catch overruns since the card doesn't generate
|
||||||
|
* overrun interrupts, but we might as well try */
|
||||||
|
if (status & OVRUN) {
|
||||||
|
das16m1_cancel(dev, s);
|
||||||
|
async->events |= COMEDI_CB_EOA | COMEDI_CB_ERROR;
|
||||||
|
comedi_error(dev, "fifo overflow");
|
||||||
|
}
|
||||||
|
|
||||||
|
comedi_event(dev, s);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/* This function takes a time in nanoseconds and sets the *
|
||||||
|
* 2 pacer clocks to the closest frequency possible. It also *
|
||||||
|
* returns the actual sampling period. */
|
||||||
|
static unsigned int das16m1_set_pacer(comedi_device * dev, unsigned int ns,
|
||||||
|
int rounding_flags)
|
||||||
|
{
|
||||||
|
i8253_cascade_ns_to_timer_2div(DAS16M1_XTAL, &(devpriv->divisor1),
|
||||||
|
&(devpriv->divisor2), &ns, rounding_flags & TRIG_ROUND_MASK);
|
||||||
|
|
||||||
|
/* Write the values of ctr1 and ctr2 into counters 1 and 2 */
|
||||||
|
i8254_load(dev->iobase + DAS16M1_8254_SECOND, 0, 1, devpriv->divisor1,
|
||||||
|
2);
|
||||||
|
i8254_load(dev->iobase + DAS16M1_8254_SECOND, 0, 2, devpriv->divisor2,
|
||||||
|
2);
|
||||||
|
|
||||||
|
return ns;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_irq_bits(unsigned int irq)
|
||||||
|
{
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
switch (irq) {
|
||||||
|
case 10:
|
||||||
|
ret = 0x0;
|
||||||
|
break;
|
||||||
|
case 11:
|
||||||
|
ret = 0x1;
|
||||||
|
break;
|
||||||
|
case 12:
|
||||||
|
ret = 0x2;
|
||||||
|
break;
|
||||||
|
case 15:
|
||||||
|
ret = 0x3;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
ret = 0x4;
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
ret = 0x5;
|
||||||
|
break;
|
||||||
|
case 5:
|
||||||
|
ret = 0x6;
|
||||||
|
break;
|
||||||
|
case 7:
|
||||||
|
ret = 0x7;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return -1;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
return (ret << 4);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Options list:
|
||||||
|
* 0 I/O base
|
||||||
|
* 1 IRQ
|
||||||
|
*/
|
||||||
|
|
||||||
|
static int das16m1_attach(comedi_device * dev, comedi_devconfig * it)
|
||||||
|
{
|
||||||
|
comedi_subdevice *s;
|
||||||
|
int ret;
|
||||||
|
unsigned int irq;
|
||||||
|
unsigned long iobase;
|
||||||
|
|
||||||
|
iobase = it->options[0];
|
||||||
|
|
||||||
|
printk("comedi%d: das16m1:", dev->minor);
|
||||||
|
|
||||||
|
if ((ret = alloc_private(dev,
|
||||||
|
sizeof(struct das16m1_private_struct))) < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
dev->board_name = thisboard->name;
|
||||||
|
|
||||||
|
printk(" io 0x%lx-0x%lx 0x%lx-0x%lx",
|
||||||
|
iobase, iobase + DAS16M1_SIZE,
|
||||||
|
iobase + DAS16M1_82C55, iobase + DAS16M1_82C55 + DAS16M1_SIZE2);
|
||||||
|
if (!request_region(iobase, DAS16M1_SIZE, driver_das16m1.driver_name)) {
|
||||||
|
printk(" I/O port conflict\n");
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
if (!request_region(iobase + DAS16M1_82C55, DAS16M1_SIZE2,
|
||||||
|
driver_das16m1.driver_name)) {
|
||||||
|
release_region(iobase, DAS16M1_SIZE);
|
||||||
|
printk(" I/O port conflict\n");
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
dev->iobase = iobase;
|
||||||
|
|
||||||
|
/* now for the irq */
|
||||||
|
irq = it->options[1];
|
||||||
|
// make sure it is valid
|
||||||
|
if (das16m1_irq_bits(irq) >= 0) {
|
||||||
|
ret = comedi_request_irq(irq, das16m1_interrupt, 0,
|
||||||
|
driver_das16m1.driver_name, dev);
|
||||||
|
if (ret < 0) {
|
||||||
|
printk(", irq unavailable\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
dev->irq = irq;
|
||||||
|
printk(", irq %u\n", irq);
|
||||||
|
} else if (irq == 0) {
|
||||||
|
printk(", no irq\n");
|
||||||
|
} else {
|
||||||
|
printk(", invalid irq\n"
|
||||||
|
" valid irqs are 2, 3, 5, 7, 10, 11, 12, or 15\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ((ret = alloc_subdevices(dev, 4)) < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
s = dev->subdevices + 0;
|
||||||
|
dev->read_subdev = s;
|
||||||
|
/* ai */
|
||||||
|
s->type = COMEDI_SUBD_AI;
|
||||||
|
s->subdev_flags = SDF_READABLE | SDF_CMD_READ;
|
||||||
|
s->n_chan = 8;
|
||||||
|
s->subdev_flags = SDF_DIFF;
|
||||||
|
s->len_chanlist = 256;
|
||||||
|
s->maxdata = (1 << 12) - 1;
|
||||||
|
s->range_table = &range_das16m1;
|
||||||
|
s->insn_read = das16m1_ai_rinsn;
|
||||||
|
s->do_cmdtest = das16m1_cmd_test;
|
||||||
|
s->do_cmd = das16m1_cmd_exec;
|
||||||
|
s->cancel = das16m1_cancel;
|
||||||
|
s->poll = das16m1_poll;
|
||||||
|
|
||||||
|
s = dev->subdevices + 1;
|
||||||
|
/* di */
|
||||||
|
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 = das16m1_di_rbits;
|
||||||
|
|
||||||
|
s = dev->subdevices + 2;
|
||||||
|
/* do */
|
||||||
|
s->type = COMEDI_SUBD_DO;
|
||||||
|
s->subdev_flags = SDF_WRITABLE | SDF_READABLE;
|
||||||
|
s->n_chan = 4;
|
||||||
|
s->maxdata = 1;
|
||||||
|
s->range_table = &range_digital;
|
||||||
|
s->insn_bits = das16m1_do_wbits;
|
||||||
|
|
||||||
|
s = dev->subdevices + 3;
|
||||||
|
/* 8255 */
|
||||||
|
subdev_8255_init(dev, s, NULL, dev->iobase + DAS16M1_82C55);
|
||||||
|
|
||||||
|
// disable upper half of hardware conversion counter so it doesn't mess with us
|
||||||
|
outb(TOTAL_CLEAR, dev->iobase + DAS16M1_8254_FIRST_CNTRL);
|
||||||
|
|
||||||
|
// initialize digital output lines
|
||||||
|
outb(devpriv->do_bits, dev->iobase + DAS16M1_DIO);
|
||||||
|
|
||||||
|
/* set the interrupt level */
|
||||||
|
if (dev->irq)
|
||||||
|
devpriv->control_state = das16m1_irq_bits(dev->irq);
|
||||||
|
else
|
||||||
|
devpriv->control_state = 0;
|
||||||
|
outb(devpriv->control_state, dev->iobase + DAS16M1_INTR_CONTROL);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int das16m1_detach(comedi_device * dev)
|
||||||
|
{
|
||||||
|
printk("comedi%d: das16m1: remove\n", dev->minor);
|
||||||
|
|
||||||
|
// das16m1_reset(dev);
|
||||||
|
|
||||||
|
if (dev->subdevices)
|
||||||
|
subdev_8255_cleanup(dev, dev->subdevices + 3);
|
||||||
|
|
||||||
|
if (dev->irq)
|
||||||
|
comedi_free_irq(dev->irq, dev);
|
||||||
|
|
||||||
|
if (dev->iobase) {
|
||||||
|
release_region(dev->iobase, DAS16M1_SIZE);
|
||||||
|
release_region(dev->iobase + DAS16M1_82C55, DAS16M1_SIZE2);
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
Loading…
Reference in New Issue