3 * Comedi driver the General Standards Corporation
4 * High Speed Parallel Digital Interface rs485 boards.
6 * Author: Frank Mori Hess <fmhess@users.sourceforge.net>
7 * Copyright (C) 2003 Coherent Imaging Systems
9 * COMEDI - Linux Control and Measurement Device Interface
10 * Copyright (C) 1997-8 David A. Schleef <ds@schleef.org>
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or
15 * (at your option) any later version.
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
25 * Description: General Standards Corporation High
26 * Speed Parallel Digital Interface rs485 boards
27 * Author: Frank Mori Hess <fmhess@users.sourceforge.net>
28 * Status: only receive mode works, transmit not supported
29 * Updated: Thu, 01 Nov 2012 16:17:38 +0000
30 * Devices: [General Standards Corporation] PCI-HPDI32 (gsc_hpdi),
33 * Configuration options:
36 * Manual configuration of supported devices is not supported; they are
37 * configured automatically.
39 * There are some additional hpdi models available from GSC for which
40 * support could be added to this driver.
43 #include <linux/module.h>
44 #include <linux/delay.h>
45 #include <linux/interrupt.h>
47 #include "../comedi_pci.h"
52 * PCI BAR2 Register map (dev->mmio)
54 #define FIRMWARE_REV_REG 0x00
55 #define FEATURES_REG_PRESENT_BIT BIT(15)
56 #define BOARD_CONTROL_REG 0x04
57 #define BOARD_RESET_BIT BIT(0)
58 #define TX_FIFO_RESET_BIT BIT(1)
59 #define RX_FIFO_RESET_BIT BIT(2)
60 #define TX_ENABLE_BIT BIT(4)
61 #define RX_ENABLE_BIT BIT(5)
62 #define DEMAND_DMA_DIRECTION_TX_BIT BIT(6) /* ch 0 only */
63 #define LINE_VALID_ON_STATUS_VALID_BIT BIT(7)
64 #define START_TX_BIT BIT(8)
65 #define CABLE_THROTTLE_ENABLE_BIT BIT(9)
66 #define TEST_MODE_ENABLE_BIT BIT(31)
67 #define BOARD_STATUS_REG 0x08
68 #define COMMAND_LINE_STATUS_MASK (0x7f << 0)
69 #define TX_IN_PROGRESS_BIT BIT(7)
70 #define TX_NOT_EMPTY_BIT BIT(8)
71 #define TX_NOT_ALMOST_EMPTY_BIT BIT(9)
72 #define TX_NOT_ALMOST_FULL_BIT BIT(10)
73 #define TX_NOT_FULL_BIT BIT(11)
74 #define RX_NOT_EMPTY_BIT BIT(12)
75 #define RX_NOT_ALMOST_EMPTY_BIT BIT(13)
76 #define RX_NOT_ALMOST_FULL_BIT BIT(14)
77 #define RX_NOT_FULL_BIT BIT(15)
78 #define BOARD_JUMPER0_INSTALLED_BIT BIT(16)
79 #define BOARD_JUMPER1_INSTALLED_BIT BIT(17)
80 #define TX_OVERRUN_BIT BIT(21)
81 #define RX_UNDERRUN_BIT BIT(22)
82 #define RX_OVERRUN_BIT BIT(23)
83 #define TX_PROG_ALMOST_REG 0x0c
84 #define RX_PROG_ALMOST_REG 0x10
85 #define ALMOST_EMPTY_BITS(x) (((x) & 0xffff) << 0)
86 #define ALMOST_FULL_BITS(x) (((x) & 0xff) << 16)
87 #define FEATURES_REG 0x14
88 #define FIFO_SIZE_PRESENT_BIT BIT(0)
89 #define FIFO_WORDS_PRESENT_BIT BIT(1)
90 #define LEVEL_EDGE_INTERRUPTS_PRESENT_BIT BIT(2)
91 #define GPIO_SUPPORTED_BIT BIT(3)
92 #define PLX_DMA_CH1_SUPPORTED_BIT BIT(4)
93 #define OVERRUN_UNDERRUN_SUPPORTED_BIT BIT(5)
95 #define TX_STATUS_COUNT_REG 0x1c
96 #define TX_LINE_VALID_COUNT_REG 0x20,
97 #define TX_LINE_INVALID_COUNT_REG 0x24
98 #define RX_STATUS_COUNT_REG 0x28
99 #define RX_LINE_COUNT_REG 0x2c
100 #define INTERRUPT_CONTROL_REG 0x30
101 #define FRAME_VALID_START_INTR BIT(0)
102 #define FRAME_VALID_END_INTR BIT(1)
103 #define TX_FIFO_EMPTY_INTR BIT(8)
104 #define TX_FIFO_ALMOST_EMPTY_INTR BIT(9)
105 #define TX_FIFO_ALMOST_FULL_INTR BIT(10)
106 #define TX_FIFO_FULL_INTR BIT(11)
107 #define RX_EMPTY_INTR BIT(12)
108 #define RX_ALMOST_EMPTY_INTR BIT(13)
109 #define RX_ALMOST_FULL_INTR BIT(14)
110 #define RX_FULL_INTR BIT(15)
111 #define INTERRUPT_STATUS_REG 0x34
112 #define TX_CLOCK_DIVIDER_REG 0x38
113 #define TX_FIFO_SIZE_REG 0x40
114 #define RX_FIFO_SIZE_REG 0x44
115 #define FIFO_SIZE_MASK (0xfffff << 0)
116 #define TX_FIFO_WORDS_REG 0x48
117 #define RX_FIFO_WORDS_REG 0x4c
118 #define INTERRUPT_EDGE_LEVEL_REG 0x50
119 #define INTERRUPT_POLARITY_REG 0x54
121 #define TIMER_BASE 50 /* 20MHz master clock */
122 #define DMA_BUFFER_SIZE 0x10000
123 #define NUM_DMA_BUFFERS 4
124 #define NUM_DMA_DESCRIPTORS 256
126 struct hpdi_private
{
127 void __iomem
*plx9080_mmio
;
128 u32
*dio_buffer
[NUM_DMA_BUFFERS
]; /* dma buffers */
129 /* physical addresses of dma buffers */
130 dma_addr_t dio_buffer_phys_addr
[NUM_DMA_BUFFERS
];
132 * array of dma descriptors read by plx9080, allocated to get proper
135 struct plx_dma_desc
*dma_desc
;
136 /* physical address of dma descriptor array */
137 dma_addr_t dma_desc_phys_addr
;
138 unsigned int num_dma_descriptors
;
139 /* pointer to start of buffers indexed by descriptor */
140 u32
*desc_dio_buffer
[NUM_DMA_DESCRIPTORS
];
141 /* index of the dma descriptor that is currently being used */
142 unsigned int dma_desc_index
;
143 unsigned int tx_fifo_size
;
144 unsigned int rx_fifo_size
;
145 unsigned long dio_count
;
146 /* number of bytes at which to generate COMEDI_CB_BLOCK events */
147 unsigned int block_size
;
150 static void gsc_hpdi_drain_dma(struct comedi_device
*dev
, unsigned int channel
)
152 struct hpdi_private
*devpriv
= dev
->private;
153 struct comedi_subdevice
*s
= dev
->read_subdev
;
154 struct comedi_cmd
*cmd
= &s
->async
->cmd
;
162 next
= readl(devpriv
->plx9080_mmio
+ PLX_DMA1_PCI_ADDRESS_REG
);
164 next
= readl(devpriv
->plx9080_mmio
+ PLX_DMA0_PCI_ADDRESS_REG
);
166 idx
= devpriv
->dma_desc_index
;
167 start
= le32_to_cpu(devpriv
->dma_desc
[idx
].pci_start_addr
);
168 /* loop until we have read all the full buffers */
169 for (desc
= 0; (next
< start
|| next
>= start
+ devpriv
->block_size
) &&
170 desc
< devpriv
->num_dma_descriptors
; desc
++) {
171 /* transfer data from dma buffer to comedi buffer */
172 size
= devpriv
->block_size
/ sizeof(u32
);
173 if (cmd
->stop_src
== TRIG_COUNT
) {
174 if (size
> devpriv
->dio_count
)
175 size
= devpriv
->dio_count
;
176 devpriv
->dio_count
-= size
;
178 comedi_buf_write_samples(s
, devpriv
->desc_dio_buffer
[idx
],
181 idx
%= devpriv
->num_dma_descriptors
;
182 start
= le32_to_cpu(devpriv
->dma_desc
[idx
].pci_start_addr
);
184 devpriv
->dma_desc_index
= idx
;
186 /* XXX check for buffer overrun somehow */
189 static irqreturn_t
gsc_hpdi_interrupt(int irq
, void *d
)
191 struct comedi_device
*dev
= d
;
192 struct hpdi_private
*devpriv
= dev
->private;
193 struct comedi_subdevice
*s
= dev
->read_subdev
;
194 struct comedi_async
*async
= s
->async
;
195 u32 hpdi_intr_status
, hpdi_board_status
;
198 u8 dma0_status
, dma1_status
;
204 plx_status
= readl(devpriv
->plx9080_mmio
+ PLX_INTRCS_REG
);
205 if ((plx_status
& (ICS_DMA0_A
| ICS_DMA1_A
| ICS_LIA
)) == 0)
208 hpdi_intr_status
= readl(dev
->mmio
+ INTERRUPT_STATUS_REG
);
209 hpdi_board_status
= readl(dev
->mmio
+ BOARD_STATUS_REG
);
211 if (hpdi_intr_status
)
212 writel(hpdi_intr_status
, dev
->mmio
+ INTERRUPT_STATUS_REG
);
214 /* spin lock makes sure no one else changes plx dma control reg */
215 spin_lock_irqsave(&dev
->spinlock
, flags
);
216 dma0_status
= readb(devpriv
->plx9080_mmio
+ PLX_DMA0_CS_REG
);
217 if (plx_status
& ICS_DMA0_A
) {
218 /* dma chan 0 interrupt */
219 writeb((dma0_status
& PLX_DMA_EN_BIT
) | PLX_CLEAR_DMA_INTR_BIT
,
220 devpriv
->plx9080_mmio
+ PLX_DMA0_CS_REG
);
222 if (dma0_status
& PLX_DMA_EN_BIT
)
223 gsc_hpdi_drain_dma(dev
, 0);
225 spin_unlock_irqrestore(&dev
->spinlock
, flags
);
227 /* spin lock makes sure no one else changes plx dma control reg */
228 spin_lock_irqsave(&dev
->spinlock
, flags
);
229 dma1_status
= readb(devpriv
->plx9080_mmio
+ PLX_DMA1_CS_REG
);
230 if (plx_status
& ICS_DMA1_A
) {
231 /* XXX */ /* dma chan 1 interrupt */
232 writeb((dma1_status
& PLX_DMA_EN_BIT
) | PLX_CLEAR_DMA_INTR_BIT
,
233 devpriv
->plx9080_mmio
+ PLX_DMA1_CS_REG
);
235 spin_unlock_irqrestore(&dev
->spinlock
, flags
);
237 /* clear possible plx9080 interrupt sources */
238 if (plx_status
& ICS_LDIA
) {
239 /* clear local doorbell interrupt */
240 plx_bits
= readl(devpriv
->plx9080_mmio
+ PLX_DBR_OUT_REG
);
241 writel(plx_bits
, devpriv
->plx9080_mmio
+ PLX_DBR_OUT_REG
);
244 if (hpdi_board_status
& RX_OVERRUN_BIT
) {
245 dev_err(dev
->class_dev
, "rx fifo overrun\n");
246 async
->events
|= COMEDI_CB_ERROR
;
249 if (hpdi_board_status
& RX_UNDERRUN_BIT
) {
250 dev_err(dev
->class_dev
, "rx fifo underrun\n");
251 async
->events
|= COMEDI_CB_ERROR
;
254 if (devpriv
->dio_count
== 0)
255 async
->events
|= COMEDI_CB_EOA
;
257 comedi_handle_events(dev
, s
);
262 static void gsc_hpdi_abort_dma(struct comedi_device
*dev
, unsigned int channel
)
264 struct hpdi_private
*devpriv
= dev
->private;
267 /* spinlock for plx dma control/status reg */
268 spin_lock_irqsave(&dev
->spinlock
, flags
);
270 plx9080_abort_dma(devpriv
->plx9080_mmio
, channel
);
272 spin_unlock_irqrestore(&dev
->spinlock
, flags
);
275 static int gsc_hpdi_cancel(struct comedi_device
*dev
,
276 struct comedi_subdevice
*s
)
278 writel(0, dev
->mmio
+ BOARD_CONTROL_REG
);
279 writel(0, dev
->mmio
+ INTERRUPT_CONTROL_REG
);
281 gsc_hpdi_abort_dma(dev
, 0);
286 static int gsc_hpdi_cmd(struct comedi_device
*dev
,
287 struct comedi_subdevice
*s
)
289 struct hpdi_private
*devpriv
= dev
->private;
290 struct comedi_async
*async
= s
->async
;
291 struct comedi_cmd
*cmd
= &async
->cmd
;
298 writel(RX_FIFO_RESET_BIT
, dev
->mmio
+ BOARD_CONTROL_REG
);
300 gsc_hpdi_abort_dma(dev
, 0);
302 devpriv
->dma_desc_index
= 0;
305 * These register are supposedly unused during chained dma,
306 * but I have found that left over values from last operation
307 * occasionally cause problems with transfer of first dma
308 * block. Initializing them to zero seems to fix the problem.
310 writel(0, devpriv
->plx9080_mmio
+ PLX_DMA0_TRANSFER_SIZE_REG
);
311 writel(0, devpriv
->plx9080_mmio
+ PLX_DMA0_PCI_ADDRESS_REG
);
312 writel(0, devpriv
->plx9080_mmio
+ PLX_DMA0_LOCAL_ADDRESS_REG
);
314 /* give location of first dma descriptor */
315 bits
= devpriv
->dma_desc_phys_addr
| PLX_DESC_IN_PCI_BIT
|
316 PLX_INTR_TERM_COUNT
| PLX_XFER_LOCAL_TO_PCI
;
317 writel(bits
, devpriv
->plx9080_mmio
+ PLX_DMA0_DESCRIPTOR_REG
);
319 /* enable dma transfer */
320 spin_lock_irqsave(&dev
->spinlock
, flags
);
321 writeb(PLX_DMA_EN_BIT
| PLX_DMA_START_BIT
| PLX_CLEAR_DMA_INTR_BIT
,
322 devpriv
->plx9080_mmio
+ PLX_DMA0_CS_REG
);
323 spin_unlock_irqrestore(&dev
->spinlock
, flags
);
325 if (cmd
->stop_src
== TRIG_COUNT
)
326 devpriv
->dio_count
= cmd
->stop_arg
;
328 devpriv
->dio_count
= 1;
330 /* clear over/under run status flags */
331 writel(RX_UNDERRUN_BIT
| RX_OVERRUN_BIT
, dev
->mmio
+ BOARD_STATUS_REG
);
333 /* enable interrupts */
334 writel(RX_FULL_INTR
, dev
->mmio
+ INTERRUPT_CONTROL_REG
);
336 writel(RX_ENABLE_BIT
, dev
->mmio
+ BOARD_CONTROL_REG
);
341 static int gsc_hpdi_check_chanlist(struct comedi_device
*dev
,
342 struct comedi_subdevice
*s
,
343 struct comedi_cmd
*cmd
)
347 for (i
= 0; i
< cmd
->chanlist_len
; i
++) {
348 unsigned int chan
= CR_CHAN(cmd
->chanlist
[i
]);
351 dev_dbg(dev
->class_dev
,
352 "chanlist must be ch 0 to 31 in order\n");
360 static int gsc_hpdi_cmd_test(struct comedi_device
*dev
,
361 struct comedi_subdevice
*s
,
362 struct comedi_cmd
*cmd
)
369 /* Step 1 : check if triggers are trivially valid */
371 err
|= comedi_check_trigger_src(&cmd
->start_src
, TRIG_NOW
);
372 err
|= comedi_check_trigger_src(&cmd
->scan_begin_src
, TRIG_EXT
);
373 err
|= comedi_check_trigger_src(&cmd
->convert_src
, TRIG_NOW
);
374 err
|= comedi_check_trigger_src(&cmd
->scan_end_src
, TRIG_COUNT
);
375 err
|= comedi_check_trigger_src(&cmd
->stop_src
, TRIG_COUNT
| TRIG_NONE
);
380 /* Step 2a : make sure trigger sources are unique */
382 err
|= comedi_check_trigger_is_unique(cmd
->stop_src
);
384 /* Step 2b : and mutually compatible */
389 /* Step 3: check if arguments are trivially valid */
391 err
|= comedi_check_trigger_arg_is(&cmd
->start_arg
, 0);
393 if (!cmd
->chanlist_len
|| !cmd
->chanlist
) {
394 cmd
->chanlist_len
= 32;
397 err
|= comedi_check_trigger_arg_is(&cmd
->scan_end_arg
,
400 if (cmd
->stop_src
== TRIG_COUNT
)
401 err
|= comedi_check_trigger_arg_min(&cmd
->stop_arg
, 1);
403 err
|= comedi_check_trigger_arg_is(&cmd
->stop_arg
, 0);
408 /* Step 4: fix up any arguments */
410 /* Step 5: check channel list if it exists */
412 if (cmd
->chanlist
&& cmd
->chanlist_len
> 0)
413 err
|= gsc_hpdi_check_chanlist(dev
, s
, cmd
);
421 /* setup dma descriptors so a link completes every 'len' bytes */
422 static int gsc_hpdi_setup_dma_descriptors(struct comedi_device
*dev
,
425 struct hpdi_private
*devpriv
= dev
->private;
426 dma_addr_t phys_addr
= devpriv
->dma_desc_phys_addr
;
427 u32 next_bits
= PLX_DESC_IN_PCI_BIT
| PLX_INTR_TERM_COUNT
|
428 PLX_XFER_LOCAL_TO_PCI
;
429 unsigned int offset
= 0;
430 unsigned int idx
= 0;
433 if (len
> DMA_BUFFER_SIZE
)
434 len
= DMA_BUFFER_SIZE
;
435 len
-= len
% sizeof(u32
);
439 for (i
= 0; i
< NUM_DMA_DESCRIPTORS
&& idx
< NUM_DMA_BUFFERS
; i
++) {
440 devpriv
->dma_desc
[i
].pci_start_addr
=
441 cpu_to_le32(devpriv
->dio_buffer_phys_addr
[idx
] + offset
);
442 devpriv
->dma_desc
[i
].local_start_addr
= cpu_to_le32(FIFO_REG
);
443 devpriv
->dma_desc
[i
].transfer_size
= cpu_to_le32(len
);
444 devpriv
->dma_desc
[i
].next
= cpu_to_le32((phys_addr
+
445 (i
+ 1) * sizeof(devpriv
->dma_desc
[0])) | next_bits
);
447 devpriv
->desc_dio_buffer
[i
] = devpriv
->dio_buffer
[idx
] +
448 (offset
/ sizeof(u32
));
451 if (len
+ offset
> DMA_BUFFER_SIZE
) {
456 devpriv
->num_dma_descriptors
= i
;
457 /* fix last descriptor to point back to first */
458 devpriv
->dma_desc
[i
- 1].next
= cpu_to_le32(phys_addr
| next_bits
);
460 devpriv
->block_size
= len
;
465 static int gsc_hpdi_dio_insn_config(struct comedi_device
*dev
,
466 struct comedi_subdevice
*s
,
467 struct comedi_insn
*insn
,
473 case INSN_CONFIG_BLOCK_SIZE
:
474 ret
= gsc_hpdi_setup_dma_descriptors(dev
, data
[1]);
481 ret
= comedi_dio_insn_config(dev
, s
, insn
, data
, 0xffffffff);
490 static void gsc_hpdi_free_dma(struct comedi_device
*dev
)
492 struct pci_dev
*pcidev
= comedi_to_pci_dev(dev
);
493 struct hpdi_private
*devpriv
= dev
->private;
499 /* free pci dma buffers */
500 for (i
= 0; i
< NUM_DMA_BUFFERS
; i
++) {
501 if (devpriv
->dio_buffer
[i
])
502 pci_free_consistent(pcidev
,
504 devpriv
->dio_buffer
[i
],
505 devpriv
->dio_buffer_phys_addr
[i
]);
507 /* free dma descriptors */
508 if (devpriv
->dma_desc
)
509 pci_free_consistent(pcidev
,
510 sizeof(struct plx_dma_desc
) *
513 devpriv
->dma_desc_phys_addr
);
516 static int gsc_hpdi_init(struct comedi_device
*dev
)
518 struct hpdi_private
*devpriv
= dev
->private;
521 /* wait 10usec after reset before accessing fifos */
522 writel(BOARD_RESET_BIT
, dev
->mmio
+ BOARD_CONTROL_REG
);
523 usleep_range(10, 1000);
525 writel(ALMOST_EMPTY_BITS(32) | ALMOST_FULL_BITS(32),
526 dev
->mmio
+ RX_PROG_ALMOST_REG
);
527 writel(ALMOST_EMPTY_BITS(32) | ALMOST_FULL_BITS(32),
528 dev
->mmio
+ TX_PROG_ALMOST_REG
);
530 devpriv
->tx_fifo_size
= readl(dev
->mmio
+ TX_FIFO_SIZE_REG
) &
532 devpriv
->rx_fifo_size
= readl(dev
->mmio
+ RX_FIFO_SIZE_REG
) &
535 writel(0, dev
->mmio
+ INTERRUPT_CONTROL_REG
);
537 /* enable interrupts */
539 ICS_AERR
| ICS_PERR
| ICS_PIE
| ICS_PLIE
| ICS_PAIE
| ICS_LIE
|
541 writel(plx_intcsr_bits
, devpriv
->plx9080_mmio
+ PLX_INTRCS_REG
);
546 static void gsc_hpdi_init_plx9080(struct comedi_device
*dev
)
548 struct hpdi_private
*devpriv
= dev
->private;
550 void __iomem
*plx_iobase
= devpriv
->plx9080_mmio
;
553 bits
= BIGEND_DMA0
| BIGEND_DMA1
;
557 writel(bits
, devpriv
->plx9080_mmio
+ PLX_BIGEND_REG
);
559 writel(0, devpriv
->plx9080_mmio
+ PLX_INTRCS_REG
);
561 gsc_hpdi_abort_dma(dev
, 0);
562 gsc_hpdi_abort_dma(dev
, 1);
564 /* configure dma0 mode */
566 /* enable ready input */
567 bits
|= PLX_DMA_EN_READYIN_BIT
;
568 /* enable dma chaining */
569 bits
|= PLX_EN_CHAIN_BIT
;
571 * enable interrupt on dma done
572 * (probably don't need this, since chain never finishes)
574 bits
|= PLX_EN_DMA_DONE_INTR_BIT
;
576 * don't increment local address during transfers
577 * (we are transferring from a fixed fifo register)
579 bits
|= PLX_LOCAL_ADDR_CONST_BIT
;
580 /* route dma interrupt to pci bus */
581 bits
|= PLX_DMA_INTR_PCI_BIT
;
582 /* enable demand mode */
583 bits
|= PLX_DEMAND_MODE_BIT
;
584 /* enable local burst mode */
585 bits
|= PLX_DMA_LOCAL_BURST_EN_BIT
;
586 bits
|= PLX_LOCAL_BUS_32_WIDE_BITS
;
587 writel(bits
, plx_iobase
+ PLX_DMA0_MODE_REG
);
590 static int gsc_hpdi_auto_attach(struct comedi_device
*dev
,
591 unsigned long context_unused
)
593 struct pci_dev
*pcidev
= comedi_to_pci_dev(dev
);
594 struct hpdi_private
*devpriv
;
595 struct comedi_subdevice
*s
;
599 dev
->board_name
= "pci-hpdi32";
601 devpriv
= comedi_alloc_devpriv(dev
, sizeof(*devpriv
));
605 retval
= comedi_pci_enable(dev
);
608 pci_set_master(pcidev
);
610 devpriv
->plx9080_mmio
= pci_ioremap_bar(pcidev
, 0);
611 dev
->mmio
= pci_ioremap_bar(pcidev
, 2);
612 if (!devpriv
->plx9080_mmio
|| !dev
->mmio
) {
613 dev_warn(dev
->class_dev
, "failed to remap io memory\n");
617 gsc_hpdi_init_plx9080(dev
);
620 if (request_irq(pcidev
->irq
, gsc_hpdi_interrupt
, IRQF_SHARED
,
621 dev
->board_name
, dev
)) {
622 dev_warn(dev
->class_dev
,
623 "unable to allocate irq %u\n", pcidev
->irq
);
626 dev
->irq
= pcidev
->irq
;
628 dev_dbg(dev
->class_dev
, " irq %u\n", dev
->irq
);
630 /* allocate pci dma buffers */
631 for (i
= 0; i
< NUM_DMA_BUFFERS
; i
++) {
632 devpriv
->dio_buffer
[i
] =
633 pci_alloc_consistent(pcidev
, DMA_BUFFER_SIZE
,
634 &devpriv
->dio_buffer_phys_addr
[i
]);
636 /* allocate dma descriptors */
637 devpriv
->dma_desc
= pci_alloc_consistent(pcidev
,
638 sizeof(struct plx_dma_desc
) *
640 &devpriv
->dma_desc_phys_addr
);
641 if (devpriv
->dma_desc_phys_addr
& 0xf) {
642 dev_warn(dev
->class_dev
,
643 " dma descriptors not quad-word aligned (bug)\n");
647 retval
= gsc_hpdi_setup_dma_descriptors(dev
, 0x1000);
651 retval
= comedi_alloc_subdevices(dev
, 1);
655 /* Digital I/O subdevice */
656 s
= &dev
->subdevices
[0];
657 dev
->read_subdev
= s
;
658 s
->type
= COMEDI_SUBD_DIO
;
659 s
->subdev_flags
= SDF_READABLE
| SDF_WRITABLE
| SDF_LSAMPL
|
662 s
->len_chanlist
= 32;
664 s
->range_table
= &range_digital
;
665 s
->insn_config
= gsc_hpdi_dio_insn_config
;
666 s
->do_cmd
= gsc_hpdi_cmd
;
667 s
->do_cmdtest
= gsc_hpdi_cmd_test
;
668 s
->cancel
= gsc_hpdi_cancel
;
670 return gsc_hpdi_init(dev
);
673 static void gsc_hpdi_detach(struct comedi_device
*dev
)
675 struct hpdi_private
*devpriv
= dev
->private;
678 free_irq(dev
->irq
, dev
);
680 if (devpriv
->plx9080_mmio
) {
681 writel(0, devpriv
->plx9080_mmio
+ PLX_INTRCS_REG
);
682 iounmap(devpriv
->plx9080_mmio
);
687 comedi_pci_disable(dev
);
688 gsc_hpdi_free_dma(dev
);
691 static struct comedi_driver gsc_hpdi_driver
= {
692 .driver_name
= "gsc_hpdi",
693 .module
= THIS_MODULE
,
694 .auto_attach
= gsc_hpdi_auto_attach
,
695 .detach
= gsc_hpdi_detach
,
698 static int gsc_hpdi_pci_probe(struct pci_dev
*dev
,
699 const struct pci_device_id
*id
)
701 return comedi_pci_auto_config(dev
, &gsc_hpdi_driver
, id
->driver_data
);
704 static const struct pci_device_id gsc_hpdi_pci_table
[] = {
705 { PCI_DEVICE_SUB(PCI_VENDOR_ID_PLX
, PCI_DEVICE_ID_PLX_9080
,
706 PCI_VENDOR_ID_PLX
, 0x2400) },
709 MODULE_DEVICE_TABLE(pci
, gsc_hpdi_pci_table
);
711 static struct pci_driver gsc_hpdi_pci_driver
= {
713 .id_table
= gsc_hpdi_pci_table
,
714 .probe
= gsc_hpdi_pci_probe
,
715 .remove
= comedi_pci_auto_unconfig
,
717 module_comedi_pci_driver(gsc_hpdi_driver
, gsc_hpdi_pci_driver
);
719 MODULE_AUTHOR("Comedi http://www.comedi.org");
720 MODULE_DESCRIPTION("Comedi driver for General Standards PCI-HPDI32/PMC-HPDI32");
721 MODULE_LICENSE("GPL");