| /* |
| * comedi/drivers/pcl812.c |
| * |
| * Author: Michal Dobes <dobes@tesnet.cz> |
| * |
| * hardware driver for Advantech cards |
| * card: PCL-812, PCL-812PG, PCL-813, PCL-813B |
| * driver: pcl812, pcl812pg, pcl813, pcl813b |
| * and for ADlink cards |
| * card: ACL-8112DG, ACL-8112HG, ACL-8112PG, ACL-8113, ACL-8216 |
| * driver: acl8112dg, acl8112hg, acl8112pg, acl8113, acl8216 |
| * and for ICP DAS cards |
| * card: ISO-813, A-821PGH, A-821PGL, A-821PGL-NDA, A-822PGH, A-822PGL, |
| * driver: iso813, a821pgh, a-821pgl, a-821pglnda, a822pgh, a822pgl, |
| * card: A-823PGH, A-823PGL, A-826PG |
| * driver: a823pgh, a823pgl, a826pg |
| */ |
| /* |
| Driver: pcl812 |
| Description: Advantech PCL-812/PG, PCL-813/B, |
| ADLink ACL-8112DG/HG/PG, ACL-8113, ACL-8216, |
| ICP DAS A-821PGH/PGL/PGL-NDA, A-822PGH/PGL, A-823PGH/PGL, A-826PG, |
| ICP DAS ISO-813 |
| Author: Michal Dobes <dobes@tesnet.cz> |
| Devices: [Advantech] PCL-812 (pcl812), PCL-812PG (pcl812pg), |
| PCL-813 (pcl813), PCL-813B (pcl813b), [ADLink] ACL-8112DG (acl8112dg), |
| ACL-8112HG (acl8112hg), ACL-8113 (acl-8113), ACL-8216 (acl8216), |
| [ICP] ISO-813 (iso813), A-821PGH (a821pgh), A-821PGL (a821pgl), |
| A-821PGL-NDA (a821pclnda), A-822PGH (a822pgh), A-822PGL (a822pgl), |
| A-823PGH (a823pgh), A-823PGL (a823pgl), A-826PG (a826pg) |
| Updated: Mon, 06 Aug 2007 12:03:15 +0100 |
| Status: works (I hope. My board fire up under my hands |
| and I cann't test all features.) |
| |
| This driver supports insn and cmd interfaces. Some boards support only insn |
| becouse their hardware don't allow more (PCL-813/B, ACL-8113, ISO-813). |
| Data transfer over DMA is supported only when you measure only one |
| channel, this is too hardware limitation of these boards. |
| |
| Options for PCL-812: |
| [0] - IO Base |
| [1] - IRQ (0=disable, 2, 3, 4, 5, 6, 7; 10, 11, 12, 14, 15) |
| [2] - DMA (0=disable, 1, 3) |
| [3] - 0=trigger source is internal 8253 with 2MHz clock |
| 1=trigger source is external |
| [4] - 0=A/D input range is +/-10V |
| 1=A/D input range is +/-5V |
| 2=A/D input range is +/-2.5V |
| 3=A/D input range is +/-1.25V |
| 4=A/D input range is +/-0.625V |
| 5=A/D input range is +/-0.3125V |
| [5] - 0=D/A outputs 0-5V (internal reference -5V) |
| 1=D/A outputs 0-10V (internal reference -10V) |
| 2=D/A outputs unknown (external reference) |
| |
| Options for PCL-812PG, ACL-8112PG: |
| [0] - IO Base |
| [1] - IRQ (0=disable, 2, 3, 4, 5, 6, 7; 10, 11, 12, 14, 15) |
| [2] - DMA (0=disable, 1, 3) |
| [3] - 0=trigger source is internal 8253 with 2MHz clock |
| 1=trigger source is external |
| [4] - 0=A/D have max +/-5V input |
| 1=A/D have max +/-10V input |
| [5] - 0=D/A outputs 0-5V (internal reference -5V) |
| 1=D/A outputs 0-10V (internal reference -10V) |
| 2=D/A outputs unknown (external reference) |
| |
| Options for ACL-8112DG/HG, A-822PGL/PGH, A-823PGL/PGH, ACL-8216, A-826PG: |
| [0] - IO Base |
| [1] - IRQ (0=disable, 2, 3, 4, 5, 6, 7; 10, 11, 12, 14, 15) |
| [2] - DMA (0=disable, 1, 3) |
| [3] - 0=trigger source is internal 8253 with 2MHz clock |
| 1=trigger source is external |
| [4] - 0=A/D channels are S.E. |
| 1=A/D channels are DIFF |
| [5] - 0=D/A outputs 0-5V (internal reference -5V) |
| 1=D/A outputs 0-10V (internal reference -10V) |
| 2=D/A outputs unknown (external reference) |
| |
| Options for A-821PGL/PGH: |
| [0] - IO Base |
| [1] - IRQ (0=disable, 2, 3, 4, 5, 6, 7) |
| [2] - 0=A/D channels are S.E. |
| 1=A/D channels are DIFF |
| [3] - 0=D/A output 0-5V (internal reference -5V) |
| 1=D/A output 0-10V (internal reference -10V) |
| |
| Options for A-821PGL-NDA: |
| [0] - IO Base |
| [1] - IRQ (0=disable, 2, 3, 4, 5, 6, 7) |
| [2] - 0=A/D channels are S.E. |
| 1=A/D channels are DIFF |
| |
| Options for PCL-813: |
| [0] - IO Base |
| |
| Options for PCL-813B: |
| [0] - IO Base |
| [1] - 0= bipolar inputs |
| 1= unipolar inputs |
| |
| Options for ACL-8113, ISO-813: |
| [0] - IO Base |
| [1] - 0= 10V bipolar inputs |
| 1= 10V unipolar inputs |
| 2= 20V bipolar inputs |
| 3= 20V unipolar inputs |
| */ |
| |
| #include <linux/interrupt.h> |
| #include <linux/gfp.h> |
| #include "../comedidev.h" |
| |
| #include <linux/delay.h> |
| #include <linux/ioport.h> |
| #include <asm/dma.h> |
| |
| #include "8253.h" |
| |
| #undef PCL812_EXTDEBUG /* if this is defined then a lot of messages is printed */ |
| |
| /* hardware types of the cards */ |
| #define boardPCL812PG 0 /* and ACL-8112PG */ |
| #define boardPCL813B 1 |
| #define boardPCL812 2 |
| #define boardPCL813 3 |
| #define boardISO813 5 |
| #define boardACL8113 6 |
| #define boardACL8112 7 /* ACL-8112DG/HG, A-822PGL/PGH, A-823PGL/PGH */ |
| #define boardACL8216 8 /* and ICP DAS A-826PG */ |
| #define boardA821 9 /* PGH, PGL, PGL/NDA versions */ |
| |
| #define PCLx1x_IORANGE 16 |
| |
| #define PCL812_CTR0 0 |
| #define PCL812_CTR1 1 |
| #define PCL812_CTR2 2 |
| #define PCL812_CTRCTL 3 |
| #define PCL812_AD_LO 4 |
| #define PCL812_DA1_LO 4 |
| #define PCL812_AD_HI 5 |
| #define PCL812_DA1_HI 5 |
| #define PCL812_DA2_LO 6 |
| #define PCL812_DI_LO 6 |
| #define PCL812_DA2_HI 7 |
| #define PCL812_DI_HI 7 |
| #define PCL812_CLRINT 8 |
| #define PCL812_GAIN 9 |
| #define PCL812_MUX 10 |
| #define PCL812_MODE 11 |
| #define PCL812_CNTENABLE 10 |
| #define PCL812_SOFTTRIG 12 |
| #define PCL812_DO_LO 13 |
| #define PCL812_DO_HI 14 |
| |
| #define PCL812_DRDY 0x10 /* =0 data ready */ |
| |
| #define ACL8216_STATUS 8 /* 5. bit signalize data ready */ |
| |
| #define ACL8216_DRDY 0x20 /* =0 data ready */ |
| |
| #define MAX_CHANLIST_LEN 256 /* length of scan list */ |
| |
| static const struct comedi_lrange range_pcl812pg_ai = { 5, { |
| BIP_RANGE(5), |
| BIP_RANGE(2.5), |
| BIP_RANGE(1.25), |
| BIP_RANGE(0.625), |
| BIP_RANGE(0.3125), |
| } |
| }; |
| |
| static const struct comedi_lrange range_pcl812pg2_ai = { 5, { |
| BIP_RANGE(10), |
| BIP_RANGE(5), |
| BIP_RANGE(2.5), |
| BIP_RANGE(1.25), |
| BIP_RANGE(0.625), |
| } |
| }; |
| |
| static const struct comedi_lrange range812_bipolar1_25 = { 1, { |
| BIP_RANGE(1.25), |
| } |
| }; |
| |
| static const struct comedi_lrange range812_bipolar0_625 = { 1, { |
| BIP_RANGE |
| (0.625), |
| } |
| }; |
| |
| static const struct comedi_lrange range812_bipolar0_3125 = { 1, { |
| BIP_RANGE |
| (0.3125), |
| } |
| }; |
| |
| static const struct comedi_lrange range_pcl813b_ai = { 4, { |
| BIP_RANGE(5), |
| BIP_RANGE(2.5), |
| BIP_RANGE(1.25), |
| BIP_RANGE(0.625), |
| } |
| }; |
| |
| static const struct comedi_lrange range_pcl813b2_ai = { 4, { |
| UNI_RANGE(10), |
| UNI_RANGE(5), |
| UNI_RANGE(2.5), |
| UNI_RANGE(1.25), |
| } |
| }; |
| |
| static const struct comedi_lrange range_iso813_1_ai = { 5, { |
| BIP_RANGE(5), |
| BIP_RANGE(2.5), |
| BIP_RANGE(1.25), |
| BIP_RANGE(0.625), |
| BIP_RANGE(0.3125), |
| } |
| }; |
| |
| static const struct comedi_lrange range_iso813_1_2_ai = { 5, { |
| UNI_RANGE(10), |
| UNI_RANGE(5), |
| UNI_RANGE(2.5), |
| UNI_RANGE(1.25), |
| UNI_RANGE(0.625), |
| } |
| }; |
| |
| static const struct comedi_lrange range_iso813_2_ai = { 4, { |
| BIP_RANGE(5), |
| BIP_RANGE(2.5), |
| BIP_RANGE(1.25), |
| BIP_RANGE(0.625), |
| } |
| }; |
| |
| static const struct comedi_lrange range_iso813_2_2_ai = { 4, { |
| UNI_RANGE(10), |
| UNI_RANGE(5), |
| UNI_RANGE(2.5), |
| UNI_RANGE(1.25), |
| } |
| }; |
| |
| static const struct comedi_lrange range_acl8113_1_ai = { 4, { |
| BIP_RANGE(5), |
| BIP_RANGE(2.5), |
| BIP_RANGE(1.25), |
| BIP_RANGE(0.625), |
| } |
| }; |
| |
| static const struct comedi_lrange range_acl8113_1_2_ai = { 4, { |
| UNI_RANGE(10), |
| UNI_RANGE(5), |
| UNI_RANGE(2.5), |
| UNI_RANGE(1.25), |
| } |
| }; |
| |
| static const struct comedi_lrange range_acl8113_2_ai = { 3, { |
| BIP_RANGE(5), |
| BIP_RANGE(2.5), |
| BIP_RANGE(1.25), |
| } |
| }; |
| |
| static const struct comedi_lrange range_acl8113_2_2_ai = { 3, { |
| UNI_RANGE(10), |
| UNI_RANGE(5), |
| UNI_RANGE(2.5), |
| } |
| }; |
| |
| static const struct comedi_lrange range_acl8112dg_ai = { 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 const struct comedi_lrange range_acl8112hg_ai = { 12, { |
| BIP_RANGE(5), |
| BIP_RANGE(0.5), |
| BIP_RANGE(0.05), |
| BIP_RANGE(0.005), |
| UNI_RANGE(10), |
| UNI_RANGE(1), |
| UNI_RANGE(0.1), |
| UNI_RANGE(0.01), |
| BIP_RANGE(10), |
| BIP_RANGE(1), |
| BIP_RANGE(0.1), |
| BIP_RANGE(0.01), |
| } |
| }; |
| |
| static const struct comedi_lrange range_a821pgh_ai = { 4, { |
| BIP_RANGE(5), |
| BIP_RANGE(0.5), |
| BIP_RANGE(0.05), |
| BIP_RANGE(0.005), |
| } |
| }; |
| |
| static int pcl812_attach(struct comedi_device *dev, |
| struct comedi_devconfig *it); |
| static int pcl812_detach(struct comedi_device *dev); |
| |
| struct pcl812_board { |
| |
| const char *name; /* board name */ |
| int board_type; /* type of this board */ |
| int n_aichan; /* num of AI chans in S.E. */ |
| int n_aichan_diff; /* DIFF num of chans */ |
| int n_aochan; /* num of DA chans */ |
| int n_dichan; /* DI and DO chans */ |
| int n_dochan; |
| int ai_maxdata; /* AI resolution */ |
| unsigned int ai_ns_min; /* max sample speed of card v ns */ |
| unsigned int i8254_osc_base; /* clock base */ |
| const struct comedi_lrange *rangelist_ai; /* rangelist for A/D */ |
| const struct comedi_lrange *rangelist_ao; /* rangelist for D/A */ |
| unsigned int IRQbits; /* allowed IRQ */ |
| unsigned char DMAbits; /* allowed DMA chans */ |
| unsigned char io_range; /* iorange for this board */ |
| unsigned char haveMPC508; /* 1=board use MPC508A multiplexor */ |
| }; |
| |
| static const struct pcl812_board boardtypes[] = { |
| {"pcl812", boardPCL812, 16, 0, 2, 16, 16, 0x0fff, |
| 33000, 500, &range_bipolar10, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 0}, |
| {"pcl812pg", boardPCL812PG, 16, 0, 2, 16, 16, 0x0fff, |
| 33000, 500, &range_pcl812pg_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 0}, |
| {"acl8112pg", boardPCL812PG, 16, 0, 2, 16, 16, 0x0fff, |
| 10000, 500, &range_pcl812pg_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 0}, |
| {"acl8112dg", boardACL8112, 16, 8, 2, 16, 16, 0x0fff, |
| 10000, 500, &range_acl8112dg_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 1}, |
| {"acl8112hg", boardACL8112, 16, 8, 2, 16, 16, 0x0fff, |
| 10000, 500, &range_acl8112hg_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 1}, |
| {"a821pgl", boardA821, 16, 8, 1, 16, 16, 0x0fff, |
| 10000, 500, &range_pcl813b_ai, &range_unipolar5, |
| 0x000c, 0x00, PCLx1x_IORANGE, 0}, |
| {"a821pglnda", boardA821, 16, 8, 0, 0, 0, 0x0fff, |
| 10000, 500, &range_pcl813b_ai, NULL, |
| 0x000c, 0x00, PCLx1x_IORANGE, 0}, |
| {"a821pgh", boardA821, 16, 8, 1, 16, 16, 0x0fff, |
| 10000, 500, &range_a821pgh_ai, &range_unipolar5, |
| 0x000c, 0x00, PCLx1x_IORANGE, 0}, |
| {"a822pgl", boardACL8112, 16, 8, 2, 16, 16, 0x0fff, |
| 10000, 500, &range_acl8112dg_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 0}, |
| {"a822pgh", boardACL8112, 16, 8, 2, 16, 16, 0x0fff, |
| 10000, 500, &range_acl8112hg_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 0}, |
| {"a823pgl", boardACL8112, 16, 8, 2, 16, 16, 0x0fff, |
| 8000, 500, &range_acl8112dg_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 0}, |
| {"a823pgh", boardACL8112, 16, 8, 2, 16, 16, 0x0fff, |
| 8000, 500, &range_acl8112hg_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 0}, |
| {"pcl813", boardPCL813, 32, 0, 0, 0, 0, 0x0fff, |
| 0, 0, &range_pcl813b_ai, NULL, |
| 0x0000, 0x00, PCLx1x_IORANGE, 0}, |
| {"pcl813b", boardPCL813B, 32, 0, 0, 0, 0, 0x0fff, |
| 0, 0, &range_pcl813b_ai, NULL, |
| 0x0000, 0x00, PCLx1x_IORANGE, 0}, |
| {"acl8113", boardACL8113, 32, 0, 0, 0, 0, 0x0fff, |
| 0, 0, &range_acl8113_1_ai, NULL, |
| 0x0000, 0x00, PCLx1x_IORANGE, 0}, |
| {"iso813", boardISO813, 32, 0, 0, 0, 0, 0x0fff, |
| 0, 0, &range_iso813_1_ai, NULL, |
| 0x0000, 0x00, PCLx1x_IORANGE, 0}, |
| {"acl8216", boardACL8216, 16, 8, 2, 16, 16, 0xffff, |
| 10000, 500, &range_pcl813b2_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 1}, |
| {"a826pg", boardACL8216, 16, 8, 2, 16, 16, 0xffff, |
| 10000, 500, &range_pcl813b2_ai, &range_unipolar5, |
| 0xdcfc, 0x0a, PCLx1x_IORANGE, 0}, |
| }; |
| |
| #define n_boardtypes (sizeof(boardtypes)/sizeof(struct pcl812_board)) |
| #define this_board ((const struct pcl812_board *)dev->board_ptr) |
| |
| static struct comedi_driver driver_pcl812 = { |
| .driver_name = "pcl812", |
| .module = THIS_MODULE, |
| .attach = pcl812_attach, |
| .detach = pcl812_detach, |
| .board_name = &boardtypes[0].name, |
| .num_names = n_boardtypes, |
| .offset = sizeof(struct pcl812_board), |
| }; |
| |
| COMEDI_INITCLEANUP(driver_pcl812); |
| |
| struct pcl812_private { |
| |
| unsigned char valid; /* =1 device is OK */ |
| unsigned char dma; /* >0 use dma ( usedDMA channel) */ |
| unsigned char use_diff; /* =1 diff inputs */ |
| unsigned char use_MPC; /* 1=board uses MPC508A multiplexor */ |
| unsigned char use_ext_trg; /* 1=board uses external trigger */ |
| unsigned char range_correction; /* =1 we must add 1 to range number */ |
| unsigned char old_chan_reg; /* lastly used chan/gain pair */ |
| unsigned char old_gain_reg; |
| unsigned char mode_reg_int; /* there is stored INT number for some card */ |
| unsigned char ai_neverending; /* =1 we do unlimited AI */ |
| unsigned char ai_eos; /* 1=EOS wake up */ |
| unsigned char ai_dma; /* =1 we use DMA */ |
| unsigned int ai_poll_ptr; /* how many sampes transfer poll */ |
| unsigned int ai_scans; /* len of scanlist */ |
| unsigned int ai_act_scan; /* how many scans we finished */ |
| unsigned int ai_chanlist[MAX_CHANLIST_LEN]; /* our copy of channel/range list */ |
| unsigned int ai_n_chan; /* how many channels is measured */ |
| unsigned int ai_flags; /* flaglist */ |
| unsigned int ai_data_len; /* len of data buffer */ |
| short *ai_data; /* data buffer */ |
| unsigned int ai_is16b; /* =1 we have 16 bit card */ |
| unsigned long dmabuf[2]; /* PTR to DMA buf */ |
| unsigned int dmapages[2]; /* how many pages we have allocated */ |
| unsigned int hwdmaptr[2]; /* HW PTR to DMA buf */ |
| unsigned int hwdmasize[2]; /* DMA buf size in bytes */ |
| unsigned int dmabytestomove[2]; /* how many bytes DMA transfer */ |
| int next_dma_buf; /* which buffer is next to use */ |
| unsigned int dma_runs_to_end; /* how many times we must switch DMA buffers */ |
| unsigned int last_dma_run; /* how many bytes to transfer on last DMA buffer */ |
| unsigned int max_812_ai_mode0_rangewait; /* setling time for gain */ |
| unsigned int ao_readback[2]; /* data for AO readback */ |
| }; |
| |
| #define devpriv ((struct pcl812_private *)dev->private) |
| |
| /* |
| ============================================================================== |
| */ |
| static void start_pacer(struct comedi_device *dev, int mode, |
| unsigned int divisor1, unsigned int divisor2); |
| static void setup_range_channel(struct comedi_device *dev, |
| struct comedi_subdevice *s, |
| unsigned int rangechan, char wait); |
| static int pcl812_ai_cancel(struct comedi_device *dev, |
| struct comedi_subdevice *s); |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_ai_insn_read(struct comedi_device *dev, |
| struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| int n; |
| int timeout, hi; |
| |
| outb(devpriv->mode_reg_int | 1, dev->iobase + PCL812_MODE); /* select software trigger */ |
| setup_range_channel(dev, s, insn->chanspec, 1); /* select channel and renge */ |
| for (n = 0; n < insn->n; n++) { |
| outb(255, dev->iobase + PCL812_SOFTTRIG); /* start conversion */ |
| udelay(5); |
| timeout = 50; /* wait max 50us, it must finish under 33us */ |
| while (timeout--) { |
| hi = inb(dev->iobase + PCL812_AD_HI); |
| if (!(hi & PCL812_DRDY)) |
| goto conv_finish; |
| udelay(1); |
| } |
| printk |
| ("comedi%d: pcl812: (%s at 0x%lx) A/D insn read timeout\n", |
| dev->minor, dev->board_name, dev->iobase); |
| outb(devpriv->mode_reg_int | 0, dev->iobase + PCL812_MODE); |
| return -ETIME; |
| |
| conv_finish: |
| data[n] = ((hi & 0xf) << 8) | inb(dev->iobase + PCL812_AD_LO); |
| } |
| outb(devpriv->mode_reg_int | 0, dev->iobase + PCL812_MODE); |
| return n; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int acl8216_ai_insn_read(struct comedi_device *dev, |
| struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| int n; |
| int timeout; |
| |
| outb(1, dev->iobase + PCL812_MODE); /* select software trigger */ |
| setup_range_channel(dev, s, insn->chanspec, 1); /* select channel and renge */ |
| for (n = 0; n < insn->n; n++) { |
| outb(255, dev->iobase + PCL812_SOFTTRIG); /* start conversion */ |
| udelay(5); |
| timeout = 50; /* wait max 50us, it must finish under 33us */ |
| while (timeout--) { |
| if (!(inb(dev->iobase + ACL8216_STATUS) & ACL8216_DRDY)) |
| goto conv_finish; |
| udelay(1); |
| } |
| printk |
| ("comedi%d: pcl812: (%s at 0x%lx) A/D insn read timeout\n", |
| dev->minor, dev->board_name, dev->iobase); |
| outb(0, dev->iobase + PCL812_MODE); |
| return -ETIME; |
| |
| conv_finish: |
| data[n] = |
| (inb(dev->iobase + |
| PCL812_AD_HI) << 8) | inb(dev->iobase + PCL812_AD_LO); |
| } |
| outb(0, dev->iobase + PCL812_MODE); |
| return n; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_ao_insn_write(struct comedi_device *dev, |
| struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| int chan = CR_CHAN(insn->chanspec); |
| int i; |
| |
| for (i = 0; i < insn->n; i++) { |
| outb((data[i] & 0xff), |
| dev->iobase + (chan ? PCL812_DA2_LO : PCL812_DA1_LO)); |
| outb((data[i] >> 8) & 0x0f, |
| dev->iobase + (chan ? PCL812_DA2_HI : PCL812_DA1_HI)); |
| devpriv->ao_readback[chan] = data[i]; |
| } |
| |
| return i; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_ao_insn_read(struct comedi_device *dev, |
| struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| int chan = CR_CHAN(insn->chanspec); |
| int i; |
| |
| for (i = 0; i < insn->n; i++) { |
| data[i] = devpriv->ao_readback[chan]; |
| } |
| |
| return i; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_di_insn_bits(struct comedi_device *dev, |
| struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| if (insn->n != 2) |
| return -EINVAL; |
| |
| data[1] = inb(dev->iobase + PCL812_DI_LO); |
| data[1] |= inb(dev->iobase + PCL812_DI_HI) << 8; |
| |
| return 2; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_do_insn_bits(struct comedi_device *dev, |
| struct comedi_subdevice *s, |
| struct comedi_insn *insn, unsigned int *data) |
| { |
| if (insn->n != 2) |
| return -EINVAL; |
| |
| if (data[0]) { |
| s->state &= ~data[0]; |
| s->state |= data[0] & data[1]; |
| outb(s->state & 0xff, dev->iobase + PCL812_DO_LO); |
| outb((s->state >> 8), dev->iobase + PCL812_DO_HI); |
| } |
| data[1] = s->state; |
| |
| return 2; |
| } |
| |
| #ifdef PCL812_EXTDEBUG |
| /* |
| ============================================================================== |
| */ |
| static void pcl812_cmdtest_out(int e, struct comedi_cmd *cmd) |
| { |
| printk("pcl812 e=%d startsrc=%x scansrc=%x convsrc=%x\n", e, |
| cmd->start_src, cmd->scan_begin_src, cmd->convert_src); |
| printk("pcl812 e=%d startarg=%d scanarg=%d convarg=%d\n", e, |
| cmd->start_arg, cmd->scan_begin_arg, cmd->convert_arg); |
| printk("pcl812 e=%d stopsrc=%x scanend=%x\n", e, cmd->stop_src, |
| cmd->scan_end_src); |
| printk("pcl812 e=%d stoparg=%d scanendarg=%d chanlistlen=%d\n", e, |
| cmd->stop_arg, cmd->scan_end_arg, cmd->chanlist_len); |
| } |
| #endif |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_ai_cmdtest(struct comedi_device *dev, |
| struct comedi_subdevice *s, struct comedi_cmd *cmd) |
| { |
| int err = 0; |
| int tmp, divisor1, divisor2; |
| |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: BGN: pcl812_ai_cmdtest(...)\n"); |
| pcl812_cmdtest_out(-1, cmd); |
| #endif |
| /* step 1: make sure trigger sources are trivially valid */ |
| |
| tmp = cmd->start_src; |
| cmd->start_src &= TRIG_NOW; |
| 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; |
| if (devpriv->use_ext_trg) { |
| cmd->convert_src &= TRIG_EXT; |
| } else { |
| cmd->convert_src &= TRIG_TIMER; |
| } |
| 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) { |
| #ifdef PCL812_EXTDEBUG |
| pcl812_cmdtest_out(1, cmd); |
| printk |
| ("pcl812 EDBG: BGN: pcl812_ai_cmdtest(...) err=%d ret=1\n", |
| err); |
| #endif |
| return 1; |
| } |
| |
| /* step 2: make sure trigger sources are unique and mutually compatible */ |
| |
| if (cmd->start_src != TRIG_NOW) { |
| cmd->start_src = TRIG_NOW; |
| err++; |
| } |
| |
| if (cmd->scan_begin_src != TRIG_FOLLOW) { |
| cmd->scan_begin_src = TRIG_FOLLOW; |
| err++; |
| } |
| |
| if (devpriv->use_ext_trg) { |
| if (cmd->convert_src != TRIG_EXT) { |
| cmd->convert_src = TRIG_EXT; |
| err++; |
| } |
| } else { |
| if (cmd->convert_src != TRIG_TIMER) { |
| cmd->convert_src = TRIG_TIMER; |
| err++; |
| } |
| } |
| |
| if (cmd->scan_end_src != TRIG_COUNT) { |
| cmd->scan_end_src = TRIG_COUNT; |
| err++; |
| } |
| |
| if (cmd->stop_src != TRIG_NONE && cmd->stop_src != TRIG_COUNT) |
| err++; |
| |
| if (err) { |
| #ifdef PCL812_EXTDEBUG |
| pcl812_cmdtest_out(2, cmd); |
| printk |
| ("pcl812 EDBG: BGN: pcl812_ai_cmdtest(...) err=%d ret=2\n", |
| err); |
| #endif |
| return 2; |
| } |
| |
| /* step 3: make sure arguments are trivially compatible */ |
| |
| if (cmd->start_arg != 0) { |
| cmd->start_arg = 0; |
| err++; |
| } |
| |
| if (cmd->scan_begin_arg != 0) { |
| cmd->scan_begin_arg = 0; |
| err++; |
| } |
| |
| if (cmd->convert_src == TRIG_TIMER) { |
| if (cmd->convert_arg < this_board->ai_ns_min) { |
| cmd->convert_arg = this_board->ai_ns_min; |
| err++; |
| } |
| } else { /* TRIG_EXT */ |
| if (cmd->convert_arg != 0) { |
| cmd->convert_arg = 0; |
| err++; |
| } |
| } |
| |
| if (!cmd->chanlist_len) { |
| cmd->chanlist_len = 1; |
| err++; |
| } |
| if (cmd->chanlist_len > MAX_CHANLIST_LEN) { |
| cmd->chanlist_len = this_board->n_aichan; |
| err++; |
| } |
| if (cmd->scan_end_arg != cmd->chanlist_len) { |
| cmd->scan_end_arg = cmd->chanlist_len; |
| err++; |
| } |
| if (cmd->stop_src == TRIG_COUNT) { |
| if (!cmd->stop_arg) { |
| cmd->stop_arg = 1; |
| err++; |
| } |
| } else { /* TRIG_NONE */ |
| if (cmd->stop_arg != 0) { |
| cmd->stop_arg = 0; |
| err++; |
| } |
| } |
| |
| if (err) { |
| #ifdef PCL812_EXTDEBUG |
| pcl812_cmdtest_out(3, cmd); |
| printk |
| ("pcl812 EDBG: BGN: pcl812_ai_cmdtest(...) err=%d ret=3\n", |
| err); |
| #endif |
| return 3; |
| } |
| |
| /* step 4: fix up any arguments */ |
| |
| if (cmd->convert_src == TRIG_TIMER) { |
| tmp = cmd->convert_arg; |
| i8253_cascade_ns_to_timer(this_board->i8254_osc_base, &divisor1, |
| &divisor2, &cmd->convert_arg, |
| cmd->flags & TRIG_ROUND_MASK); |
| if (cmd->convert_arg < this_board->ai_ns_min) |
| cmd->convert_arg = this_board->ai_ns_min; |
| if (tmp != cmd->convert_arg) |
| err++; |
| } |
| |
| if (err) { |
| #ifdef PCL812_EXTDEBUG |
| printk |
| ("pcl812 EDBG: BGN: pcl812_ai_cmdtest(...) err=%d ret=4\n", |
| err); |
| #endif |
| return 4; |
| } |
| |
| return 0; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_ai_cmd(struct comedi_device *dev, struct comedi_subdevice *s) |
| { |
| unsigned int divisor1 = 0, divisor2 = 0, i, dma_flags, bytes; |
| struct comedi_cmd *cmd = &s->async->cmd; |
| |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: BGN: pcl812_ai_cmd(...)\n"); |
| #endif |
| |
| if (cmd->start_src != TRIG_NOW) |
| return -EINVAL; |
| if (cmd->scan_begin_src != TRIG_FOLLOW) |
| return -EINVAL; |
| if (devpriv->use_ext_trg) { |
| if (cmd->convert_src != TRIG_EXT) |
| return -EINVAL; |
| } else { |
| if (cmd->convert_src != TRIG_TIMER) |
| return -EINVAL; |
| } |
| if (cmd->scan_end_src != TRIG_COUNT) |
| return -EINVAL; |
| if (cmd->scan_end_arg != cmd->chanlist_len) |
| return -EINVAL; |
| if (cmd->chanlist_len > MAX_CHANLIST_LEN) |
| return -EINVAL; |
| |
| if (cmd->convert_src == TRIG_TIMER) { |
| if (cmd->convert_arg < this_board->ai_ns_min) |
| cmd->convert_arg = this_board->ai_ns_min; |
| i8253_cascade_ns_to_timer(this_board->i8254_osc_base, |
| &divisor1, &divisor2, |
| &cmd->convert_arg, |
| cmd->flags & TRIG_ROUND_MASK); |
| } |
| |
| start_pacer(dev, -1, 0, 0); /* stop pacer */ |
| |
| devpriv->ai_n_chan = cmd->chanlist_len; |
| memcpy(devpriv->ai_chanlist, cmd->chanlist, |
| sizeof(unsigned int) * cmd->scan_end_arg); |
| setup_range_channel(dev, s, devpriv->ai_chanlist[0], 1); /* select first channel and range */ |
| |
| if (devpriv->dma) { /* check if we can use DMA transfer */ |
| devpriv->ai_dma = 1; |
| for (i = 1; i < devpriv->ai_n_chan; i++) |
| if (devpriv->ai_chanlist[0] != devpriv->ai_chanlist[i]) { |
| devpriv->ai_dma = 0; /* we cann't use DMA :-( */ |
| break; |
| } |
| } else |
| devpriv->ai_dma = 0; |
| |
| devpriv->ai_flags = cmd->flags; |
| devpriv->ai_data_len = s->async->prealloc_bufsz; |
| devpriv->ai_data = s->async->prealloc_buf; |
| if (cmd->stop_src == TRIG_COUNT) { |
| devpriv->ai_scans = cmd->stop_arg; |
| devpriv->ai_neverending = 0; |
| } else { |
| devpriv->ai_scans = 0; |
| devpriv->ai_neverending = 1; |
| } |
| |
| devpriv->ai_act_scan = 0; |
| devpriv->ai_poll_ptr = 0; |
| s->async->cur_chan = 0; |
| |
| if ((devpriv->ai_flags & TRIG_WAKE_EOS)) { /* don't we want wake up every scan? */ |
| devpriv->ai_eos = 1; |
| if (devpriv->ai_n_chan == 1) |
| devpriv->ai_dma = 0; /* DMA is useless for this situation */ |
| } |
| |
| if (devpriv->ai_dma) { |
| if (devpriv->ai_eos) { /* we use EOS, so adapt DMA buffer to one scan */ |
| devpriv->dmabytestomove[0] = |
| devpriv->ai_n_chan * sizeof(short); |
| devpriv->dmabytestomove[1] = |
| devpriv->ai_n_chan * sizeof(short); |
| devpriv->dma_runs_to_end = 1; |
| } else { |
| devpriv->dmabytestomove[0] = devpriv->hwdmasize[0]; |
| devpriv->dmabytestomove[1] = devpriv->hwdmasize[1]; |
| if (devpriv->ai_data_len < devpriv->hwdmasize[0]) |
| devpriv->dmabytestomove[0] = |
| devpriv->ai_data_len; |
| if (devpriv->ai_data_len < devpriv->hwdmasize[1]) |
| devpriv->dmabytestomove[1] = |
| devpriv->ai_data_len; |
| if (devpriv->ai_neverending) { |
| devpriv->dma_runs_to_end = 1; |
| } else { |
| bytes = devpriv->ai_n_chan * devpriv->ai_scans * sizeof(short); /* how many samples we must transfer? */ |
| devpriv->dma_runs_to_end = bytes / devpriv->dmabytestomove[0]; /* how many DMA pages we must fill */ |
| devpriv->last_dma_run = bytes % devpriv->dmabytestomove[0]; /* on last dma transfer must be moved */ |
| if (devpriv->dma_runs_to_end == 0) |
| devpriv->dmabytestomove[0] = |
| devpriv->last_dma_run; |
| devpriv->dma_runs_to_end--; |
| } |
| } |
| if (devpriv->dmabytestomove[0] > devpriv->hwdmasize[0]) { |
| devpriv->dmabytestomove[0] = devpriv->hwdmasize[0]; |
| devpriv->ai_eos = 0; |
| } |
| if (devpriv->dmabytestomove[1] > devpriv->hwdmasize[1]) { |
| devpriv->dmabytestomove[1] = devpriv->hwdmasize[1]; |
| devpriv->ai_eos = 0; |
| } |
| devpriv->next_dma_buf = 0; |
| set_dma_mode(devpriv->dma, DMA_MODE_READ); |
| dma_flags = claim_dma_lock(); |
| clear_dma_ff(devpriv->dma); |
| set_dma_addr(devpriv->dma, devpriv->hwdmaptr[0]); |
| set_dma_count(devpriv->dma, devpriv->dmabytestomove[0]); |
| release_dma_lock(dma_flags); |
| enable_dma(devpriv->dma); |
| #ifdef PCL812_EXTDEBUG |
| printk |
| ("pcl812 EDBG: DMA %d PTR 0x%0x/0x%0x LEN %u/%u EOS %d\n", |
| devpriv->dma, devpriv->hwdmaptr[0], |
| devpriv->hwdmaptr[1], devpriv->dmabytestomove[0], |
| devpriv->dmabytestomove[1], devpriv->ai_eos); |
| #endif |
| } |
| |
| switch (cmd->convert_src) { |
| case TRIG_TIMER: |
| start_pacer(dev, 1, divisor1, divisor2); |
| break; |
| } |
| |
| if (devpriv->ai_dma) { |
| outb(devpriv->mode_reg_int | 2, dev->iobase + PCL812_MODE); /* let's go! */ |
| } else { |
| outb(devpriv->mode_reg_int | 6, dev->iobase + PCL812_MODE); /* let's go! */ |
| } |
| |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: END: pcl812_ai_cmd(...)\n"); |
| #endif |
| |
| return 0; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static irqreturn_t interrupt_pcl812_ai_int(int irq, void *d) |
| { |
| char err = 1; |
| unsigned int mask, timeout; |
| struct comedi_device *dev = d; |
| struct comedi_subdevice *s = dev->subdevices + 0; |
| unsigned int next_chan; |
| |
| s->async->events = 0; |
| |
| timeout = 50; /* wait max 50us, it must finish under 33us */ |
| if (devpriv->ai_is16b) { |
| mask = 0xffff; |
| while (timeout--) { |
| if (!(inb(dev->iobase + ACL8216_STATUS) & ACL8216_DRDY)) { |
| err = 0; |
| break; |
| } |
| udelay(1); |
| } |
| } else { |
| mask = 0x0fff; |
| while (timeout--) { |
| if (!(inb(dev->iobase + PCL812_AD_HI) & PCL812_DRDY)) { |
| err = 0; |
| break; |
| } |
| udelay(1); |
| } |
| } |
| |
| if (err) { |
| printk |
| ("comedi%d: pcl812: (%s at 0x%lx) A/D cmd IRQ without DRDY!\n", |
| dev->minor, dev->board_name, dev->iobase); |
| pcl812_ai_cancel(dev, s); |
| s->async->events |= COMEDI_CB_EOA | COMEDI_CB_ERROR; |
| comedi_event(dev, s); |
| return IRQ_HANDLED; |
| } |
| |
| comedi_buf_put(s->async, |
| ((inb(dev->iobase + PCL812_AD_HI) << 8) | |
| inb(dev->iobase + PCL812_AD_LO)) & mask); |
| |
| /* Set up next channel. Added by abbotti 2010-01-20, but untested. */ |
| next_chan = s->async->cur_chan + 1; |
| if (next_chan >= devpriv->ai_n_chan) |
| next_chan = 0; |
| if (devpriv->ai_chanlist[s->async->cur_chan] != |
| devpriv->ai_chanlist[next_chan]) |
| setup_range_channel(dev, s, devpriv->ai_chanlist[next_chan], 0); |
| |
| outb(0, dev->iobase + PCL812_CLRINT); /* clear INT request */ |
| |
| s->async->cur_chan = next_chan; |
| if (next_chan == 0) { /* one scan done */ |
| devpriv->ai_act_scan++; |
| if (!(devpriv->ai_neverending)) |
| if (devpriv->ai_act_scan >= devpriv->ai_scans) { /* all data sampled */ |
| pcl812_ai_cancel(dev, s); |
| s->async->events |= COMEDI_CB_EOA; |
| } |
| } |
| |
| comedi_event(dev, s); |
| return IRQ_HANDLED; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static void transfer_from_dma_buf(struct comedi_device *dev, |
| struct comedi_subdevice *s, short *ptr, |
| unsigned int bufptr, unsigned int len) |
| { |
| unsigned int i; |
| |
| s->async->events = 0; |
| for (i = len; i; i--) { |
| comedi_buf_put(s->async, ptr[bufptr++]); /* get one sample */ |
| |
| s->async->cur_chan++; |
| if (s->async->cur_chan >= devpriv->ai_n_chan) { |
| s->async->cur_chan = 0; |
| devpriv->ai_act_scan++; |
| if (!devpriv->ai_neverending) |
| if (devpriv->ai_act_scan >= devpriv->ai_scans) { /* all data sampled */ |
| pcl812_ai_cancel(dev, s); |
| s->async->events |= COMEDI_CB_EOA; |
| break; |
| } |
| } |
| } |
| |
| comedi_event(dev, s); |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static irqreturn_t interrupt_pcl812_ai_dma(int irq, void *d) |
| { |
| struct comedi_device *dev = d; |
| struct comedi_subdevice *s = dev->subdevices + 0; |
| unsigned long dma_flags; |
| int len, bufptr; |
| short *ptr; |
| |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: BGN: interrupt_pcl812_ai_dma(...)\n"); |
| #endif |
| ptr = (short *)devpriv->dmabuf[devpriv->next_dma_buf]; |
| len = (devpriv->dmabytestomove[devpriv->next_dma_buf] >> 1) - |
| devpriv->ai_poll_ptr; |
| |
| devpriv->next_dma_buf = 1 - devpriv->next_dma_buf; |
| disable_dma(devpriv->dma); |
| set_dma_mode(devpriv->dma, DMA_MODE_READ); |
| dma_flags = claim_dma_lock(); |
| set_dma_addr(devpriv->dma, devpriv->hwdmaptr[devpriv->next_dma_buf]); |
| if (devpriv->ai_eos) { |
| set_dma_count(devpriv->dma, |
| devpriv->dmabytestomove[devpriv->next_dma_buf]); |
| } else { |
| if (devpriv->dma_runs_to_end) { |
| set_dma_count(devpriv->dma, |
| devpriv->dmabytestomove[devpriv-> |
| next_dma_buf]); |
| } else { |
| set_dma_count(devpriv->dma, devpriv->last_dma_run); |
| } |
| devpriv->dma_runs_to_end--; |
| } |
| release_dma_lock(dma_flags); |
| enable_dma(devpriv->dma); |
| |
| outb(0, dev->iobase + PCL812_CLRINT); /* clear INT request */ |
| |
| bufptr = devpriv->ai_poll_ptr; |
| devpriv->ai_poll_ptr = 0; |
| |
| transfer_from_dma_buf(dev, s, ptr, bufptr, len); |
| |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: END: interrupt_pcl812_ai_dma(...)\n"); |
| #endif |
| return IRQ_HANDLED; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static irqreturn_t interrupt_pcl812(int irq, void *d) |
| { |
| struct comedi_device *dev = d; |
| |
| if (!dev->attached) { |
| comedi_error(dev, "spurious interrupt"); |
| return IRQ_HANDLED; |
| } |
| if (devpriv->ai_dma) { |
| return interrupt_pcl812_ai_dma(irq, d); |
| } else { |
| return interrupt_pcl812_ai_int(irq, d); |
| }; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_ai_poll(struct comedi_device *dev, struct comedi_subdevice *s) |
| { |
| unsigned long flags; |
| unsigned int top1, top2, i; |
| |
| if (!devpriv->ai_dma) |
| return 0; /* poll is valid only for DMA transfer */ |
| |
| spin_lock_irqsave(&dev->spinlock, flags); |
| |
| for (i = 0; i < 10; i++) { |
| top1 = get_dma_residue(devpriv->ai_dma); /* where is now DMA */ |
| top2 = get_dma_residue(devpriv->ai_dma); |
| if (top1 == top2) |
| break; |
| } |
| |
| if (top1 != top2) { |
| spin_unlock_irqrestore(&dev->spinlock, flags); |
| return 0; |
| } |
| |
| top1 = devpriv->dmabytestomove[1 - devpriv->next_dma_buf] - top1; /* where is now DMA in buffer */ |
| top1 >>= 1; /* sample position */ |
| top2 = top1 - devpriv->ai_poll_ptr; |
| if (top2 < 1) { /* no new samples */ |
| spin_unlock_irqrestore(&dev->spinlock, flags); |
| return 0; |
| } |
| |
| transfer_from_dma_buf(dev, s, |
| (void *)devpriv->dmabuf[1 - |
| devpriv->next_dma_buf], |
| devpriv->ai_poll_ptr, top2); |
| |
| devpriv->ai_poll_ptr = top1; /* new buffer position */ |
| |
| spin_unlock_irqrestore(&dev->spinlock, flags); |
| |
| return s->async->buf_write_count - s->async->buf_read_count; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static void setup_range_channel(struct comedi_device *dev, |
| struct comedi_subdevice *s, |
| unsigned int rangechan, char wait) |
| { |
| unsigned char chan_reg = CR_CHAN(rangechan); /* normal board */ |
| unsigned char gain_reg = CR_RANGE(rangechan) + devpriv->range_correction; /* gain index */ |
| |
| if ((chan_reg == devpriv->old_chan_reg) |
| && (gain_reg == devpriv->old_gain_reg)) |
| return; /* we can return, no change */ |
| |
| devpriv->old_chan_reg = chan_reg; |
| devpriv->old_gain_reg = gain_reg; |
| |
| if (devpriv->use_MPC) { |
| if (devpriv->use_diff) { |
| chan_reg = chan_reg | 0x30; /* DIFF inputs */ |
| } else { |
| if (chan_reg & 0x80) { |
| chan_reg = chan_reg | 0x20; /* SE inputs 8-15 */ |
| } else { |
| chan_reg = chan_reg | 0x10; /* SE inputs 0-7 */ |
| } |
| } |
| } |
| |
| outb(chan_reg, dev->iobase + PCL812_MUX); /* select channel */ |
| outb(gain_reg, dev->iobase + PCL812_GAIN); /* select gain */ |
| |
| if (wait) { |
| udelay(devpriv->max_812_ai_mode0_rangewait); /* XXX this depends on selected range and can be very long for some high gain ranges! */ |
| } |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static void start_pacer(struct comedi_device *dev, int mode, |
| unsigned int divisor1, unsigned int divisor2) |
| { |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: BGN: start_pacer(%d,%u,%u)\n", mode, divisor1, |
| divisor2); |
| #endif |
| outb(0xb4, dev->iobase + PCL812_CTRCTL); |
| outb(0x74, dev->iobase + PCL812_CTRCTL); |
| udelay(1); |
| |
| if (mode == 1) { |
| outb(divisor2 & 0xff, dev->iobase + PCL812_CTR2); |
| outb((divisor2 >> 8) & 0xff, dev->iobase + PCL812_CTR2); |
| outb(divisor1 & 0xff, dev->iobase + PCL812_CTR1); |
| outb((divisor1 >> 8) & 0xff, dev->iobase + PCL812_CTR1); |
| } |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: END: start_pacer(...)\n"); |
| #endif |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static void free_resources(struct comedi_device *dev) |
| { |
| |
| if (dev->private) { |
| if (devpriv->dmabuf[0]) |
| free_pages(devpriv->dmabuf[0], devpriv->dmapages[0]); |
| if (devpriv->dmabuf[1]) |
| free_pages(devpriv->dmabuf[1], devpriv->dmapages[1]); |
| if (devpriv->dma) |
| free_dma(devpriv->dma); |
| } |
| if (dev->irq) |
| free_irq(dev->irq, dev); |
| if (dev->iobase) |
| release_region(dev->iobase, this_board->io_range); |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_ai_cancel(struct comedi_device *dev, |
| struct comedi_subdevice *s) |
| { |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: BGN: pcl812_ai_cancel(...)\n"); |
| #endif |
| if (devpriv->ai_dma) |
| disable_dma(devpriv->dma); |
| outb(0, dev->iobase + PCL812_CLRINT); /* clear INT request */ |
| outb(devpriv->mode_reg_int | 0, dev->iobase + PCL812_MODE); /* Stop A/D */ |
| start_pacer(dev, -1, 0, 0); /* stop 8254 */ |
| outb(0, dev->iobase + PCL812_CLRINT); /* clear INT request */ |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: END: pcl812_ai_cancel(...)\n"); |
| #endif |
| return 0; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static void pcl812_reset(struct comedi_device *dev) |
| { |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: BGN: pcl812_reset(...)\n"); |
| #endif |
| outb(0, dev->iobase + PCL812_MUX); |
| outb(0 + devpriv->range_correction, dev->iobase + PCL812_GAIN); |
| devpriv->old_chan_reg = -1; /* invalidate chain/gain memory */ |
| devpriv->old_gain_reg = -1; |
| |
| switch (this_board->board_type) { |
| case boardPCL812PG: |
| case boardPCL812: |
| case boardACL8112: |
| case boardACL8216: |
| outb(0, dev->iobase + PCL812_DA2_LO); |
| outb(0, dev->iobase + PCL812_DA2_HI); |
| case boardA821: |
| outb(0, dev->iobase + PCL812_DA1_LO); |
| outb(0, dev->iobase + PCL812_DA1_HI); |
| start_pacer(dev, -1, 0, 0); /* stop 8254 */ |
| outb(0, dev->iobase + PCL812_DO_HI); |
| outb(0, dev->iobase + PCL812_DO_LO); |
| outb(devpriv->mode_reg_int | 0, dev->iobase + PCL812_MODE); |
| outb(0, dev->iobase + PCL812_CLRINT); |
| break; |
| case boardPCL813B: |
| case boardPCL813: |
| case boardISO813: |
| case boardACL8113: |
| udelay(5); |
| break; |
| } |
| udelay(5); |
| #ifdef PCL812_EXTDEBUG |
| printk("pcl812 EDBG: END: pcl812_reset(...)\n"); |
| #endif |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_attach(struct comedi_device *dev, struct comedi_devconfig *it) |
| { |
| int ret, subdev; |
| unsigned long iobase; |
| unsigned int irq; |
| unsigned int dma; |
| unsigned long pages; |
| struct comedi_subdevice *s; |
| int n_subdevices; |
| |
| iobase = it->options[0]; |
| printk("comedi%d: pcl812: board=%s, ioport=0x%03lx", dev->minor, |
| this_board->name, iobase); |
| |
| if (!request_region(iobase, this_board->io_range, "pcl812")) { |
| printk("I/O port conflict\n"); |
| return -EIO; |
| } |
| dev->iobase = iobase; |
| |
| ret = alloc_private(dev, sizeof(struct pcl812_private)); |
| if (ret < 0) { |
| free_resources(dev); |
| return ret; /* Can't alloc mem */ |
| } |
| |
| dev->board_name = this_board->name; |
| |
| irq = 0; |
| if (this_board->IRQbits != 0) { /* board support IRQ */ |
| irq = it->options[1]; |
| if (irq) { /* we want to use IRQ */ |
| if (((1 << irq) & this_board->IRQbits) == 0) { |
| printk |
| (", IRQ %u is out of allowed range, DISABLING IT", |
| irq); |
| irq = 0; /* Bad IRQ */ |
| } else { |
| if (request_irq |
| (irq, interrupt_pcl812, 0, "pcl812", dev)) { |
| printk |
| (", unable to allocate IRQ %u, DISABLING IT", |
| irq); |
| irq = 0; /* Can't use IRQ */ |
| } else { |
| printk(", irq=%u", irq); |
| } |
| } |
| } |
| } |
| |
| dev->irq = irq; |
| |
| dma = 0; |
| devpriv->dma = dma; |
| if (!dev->irq) |
| goto no_dma; /* if we haven't IRQ, we can't use DMA */ |
| if (this_board->DMAbits != 0) { /* board support DMA */ |
| dma = it->options[2]; |
| if (((1 << dma) & this_board->DMAbits) == 0) { |
| printk(", DMA is out of allowed range, FAIL!\n"); |
| return -EINVAL; /* Bad DMA */ |
| } |
| ret = request_dma(dma, "pcl812"); |
| if (ret) { |
| printk(", unable to allocate DMA %u, FAIL!\n", dma); |
| return -EBUSY; /* DMA isn't free */ |
| } |
| devpriv->dma = dma; |
| printk(", dma=%u", dma); |
| pages = 1; /* we want 8KB */ |
| devpriv->dmabuf[0] = __get_dma_pages(GFP_KERNEL, pages); |
| if (!devpriv->dmabuf[0]) { |
| printk(", unable to allocate DMA buffer, FAIL!\n"); |
| /* maybe experiment with try_to_free_pages() will help .... */ |
| free_resources(dev); |
| return -EBUSY; /* no buffer :-( */ |
| } |
| devpriv->dmapages[0] = pages; |
| devpriv->hwdmaptr[0] = virt_to_bus((void *)devpriv->dmabuf[0]); |
| devpriv->hwdmasize[0] = PAGE_SIZE * (1 << pages); |
| devpriv->dmabuf[1] = __get_dma_pages(GFP_KERNEL, pages); |
| if (!devpriv->dmabuf[1]) { |
| printk(", unable to allocate DMA buffer, FAIL!\n"); |
| free_resources(dev); |
| return -EBUSY; |
| } |
| devpriv->dmapages[1] = pages; |
| devpriv->hwdmaptr[1] = virt_to_bus((void *)devpriv->dmabuf[1]); |
| devpriv->hwdmasize[1] = PAGE_SIZE * (1 << pages); |
| } |
| no_dma: |
| |
| n_subdevices = 0; |
| if (this_board->n_aichan > 0) |
| n_subdevices++; |
| if (this_board->n_aochan > 0) |
| n_subdevices++; |
| if (this_board->n_dichan > 0) |
| n_subdevices++; |
| if (this_board->n_dochan > 0) |
| n_subdevices++; |
| |
| ret = alloc_subdevices(dev, n_subdevices); |
| if (ret < 0) { |
| free_resources(dev); |
| return ret; |
| } |
| |
| subdev = 0; |
| |
| /* analog input */ |
| if (this_board->n_aichan > 0) { |
| s = dev->subdevices + subdev; |
| s->type = COMEDI_SUBD_AI; |
| s->subdev_flags = SDF_READABLE; |
| switch (this_board->board_type) { |
| case boardA821: |
| if (it->options[2] == 1) { |
| s->n_chan = this_board->n_aichan_diff; |
| s->subdev_flags |= SDF_DIFF; |
| devpriv->use_diff = 1; |
| } else { |
| s->n_chan = this_board->n_aichan; |
| s->subdev_flags |= SDF_GROUND; |
| } |
| break; |
| case boardACL8112: |
| case boardACL8216: |
| if (it->options[4] == 1) { |
| s->n_chan = this_board->n_aichan_diff; |
| s->subdev_flags |= SDF_DIFF; |
| devpriv->use_diff = 1; |
| } else { |
| s->n_chan = this_board->n_aichan; |
| s->subdev_flags |= SDF_GROUND; |
| } |
| break; |
| default: |
| s->n_chan = this_board->n_aichan; |
| s->subdev_flags |= SDF_GROUND; |
| break; |
| } |
| s->maxdata = this_board->ai_maxdata; |
| s->len_chanlist = MAX_CHANLIST_LEN; |
| s->range_table = this_board->rangelist_ai; |
| if (this_board->board_type == boardACL8216) { |
| s->insn_read = acl8216_ai_insn_read; |
| } else { |
| s->insn_read = pcl812_ai_insn_read; |
| } |
| devpriv->use_MPC = this_board->haveMPC508; |
| s->cancel = pcl812_ai_cancel; |
| if (dev->irq) { |
| dev->read_subdev = s; |
| s->subdev_flags |= SDF_CMD_READ; |
| s->do_cmdtest = pcl812_ai_cmdtest; |
| s->do_cmd = pcl812_ai_cmd; |
| s->poll = pcl812_ai_poll; |
| } |
| switch (this_board->board_type) { |
| case boardPCL812PG: |
| if (it->options[4] == 1) |
| s->range_table = &range_pcl812pg2_ai; |
| break; |
| case boardPCL812: |
| switch (it->options[4]) { |
| case 0: |
| s->range_table = &range_bipolar10; |
| break; |
| case 1: |
| s->range_table = &range_bipolar5; |
| break; |
| case 2: |
| s->range_table = &range_bipolar2_5; |
| break; |
| case 3: |
| s->range_table = &range812_bipolar1_25; |
| break; |
| case 4: |
| s->range_table = &range812_bipolar0_625; |
| break; |
| case 5: |
| s->range_table = &range812_bipolar0_3125; |
| break; |
| default: |
| s->range_table = &range_bipolar10; |
| break; |
| printk |
| (", incorrect range number %d, changing to 0 (+/-10V)", |
| it->options[4]); |
| break; |
| } |
| break; |
| break; |
| case boardPCL813B: |
| if (it->options[1] == 1) |
| s->range_table = &range_pcl813b2_ai; |
| break; |
| case boardISO813: |
| switch (it->options[1]) { |
| case 0: |
| s->range_table = &range_iso813_1_ai; |
| break; |
| case 1: |
| s->range_table = &range_iso813_1_2_ai; |
| break; |
| case 2: |
| s->range_table = &range_iso813_2_ai; |
| devpriv->range_correction = 1; |
| break; |
| case 3: |
| s->range_table = &range_iso813_2_2_ai; |
| devpriv->range_correction = 1; |
| break; |
| default: |
| s->range_table = &range_iso813_1_ai; |
| break; |
| printk |
| (", incorrect range number %d, changing to 0 ", |
| it->options[1]); |
| break; |
| } |
| break; |
| case boardACL8113: |
| switch (it->options[1]) { |
| case 0: |
| s->range_table = &range_acl8113_1_ai; |
| break; |
| case 1: |
| s->range_table = &range_acl8113_1_2_ai; |
| break; |
| case 2: |
| s->range_table = &range_acl8113_2_ai; |
| devpriv->range_correction = 1; |
| break; |
| case 3: |
| s->range_table = &range_acl8113_2_2_ai; |
| devpriv->range_correction = 1; |
| break; |
| default: |
| s->range_table = &range_acl8113_1_ai; |
| break; |
| printk |
| (", incorrect range number %d, changing to 0 ", |
| it->options[1]); |
| break; |
| } |
| break; |
| } |
| subdev++; |
| } |
| |
| /* analog output */ |
| if (this_board->n_aochan > 0) { |
| s = dev->subdevices + subdev; |
| s->type = COMEDI_SUBD_AO; |
| s->subdev_flags = SDF_WRITABLE | SDF_GROUND; |
| s->n_chan = this_board->n_aochan; |
| s->maxdata = 0xfff; |
| s->len_chanlist = 1; |
| s->range_table = this_board->rangelist_ao; |
| s->insn_read = pcl812_ao_insn_read; |
| s->insn_write = pcl812_ao_insn_write; |
| switch (this_board->board_type) { |
| case boardA821: |
| if (it->options[3] == 1) |
| s->range_table = &range_unipolar10; |
| break; |
| case boardPCL812: |
| case boardACL8112: |
| case boardPCL812PG: |
| case boardACL8216: |
| if (it->options[5] == 1) |
| s->range_table = &range_unipolar10; |
| if (it->options[5] == 2) |
| s->range_table = &range_unknown; |
| break; |
| } |
| subdev++; |
| } |
| |
| /* digital input */ |
| if (this_board->n_dichan > 0) { |
| s = dev->subdevices + subdev; |
| s->type = COMEDI_SUBD_DI; |
| s->subdev_flags = SDF_READABLE; |
| s->n_chan = this_board->n_dichan; |
| s->maxdata = 1; |
| s->len_chanlist = this_board->n_dichan; |
| s->range_table = &range_digital; |
| s->insn_bits = pcl812_di_insn_bits; |
| subdev++; |
| } |
| |
| /* digital output */ |
| if (this_board->n_dochan > 0) { |
| s = dev->subdevices + subdev; |
| s->type = COMEDI_SUBD_DO; |
| s->subdev_flags = SDF_WRITABLE; |
| s->n_chan = this_board->n_dochan; |
| s->maxdata = 1; |
| s->len_chanlist = this_board->n_dochan; |
| s->range_table = &range_digital; |
| s->insn_bits = pcl812_do_insn_bits; |
| subdev++; |
| } |
| |
| switch (this_board->board_type) { |
| case boardACL8216: |
| devpriv->ai_is16b = 1; |
| case boardPCL812PG: |
| case boardPCL812: |
| case boardACL8112: |
| devpriv->max_812_ai_mode0_rangewait = 1; |
| if (it->options[3] > 0) |
| devpriv->use_ext_trg = 1; /* we use external trigger */ |
| case boardA821: |
| devpriv->max_812_ai_mode0_rangewait = 1; |
| devpriv->mode_reg_int = (irq << 4) & 0xf0; |
| break; |
| case boardPCL813B: |
| case boardPCL813: |
| case boardISO813: |
| case boardACL8113: |
| devpriv->max_812_ai_mode0_rangewait = 5; /* maybe there must by greatest timeout */ |
| break; |
| } |
| |
| printk("\n"); |
| devpriv->valid = 1; |
| |
| pcl812_reset(dev); |
| |
| return 0; |
| } |
| |
| /* |
| ============================================================================== |
| */ |
| static int pcl812_detach(struct comedi_device *dev) |
| { |
| |
| #ifdef PCL812_EXTDEBUG |
| printk("comedi%d: pcl812: remove\n", dev->minor); |
| #endif |
| free_resources(dev); |
| return 0; |
| } |