?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
GUI: Fix Tomato RAF theme for all builds. Compilation typo.
[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / drivers / staging / comedi / drivers / ni_pcidio.c
blobb9e4f84d355211045329dabe2f34a75c7b15ddb4
1 /*
2 comedi/drivers/ni_pcidio.c
3 driver for National Instruments PCI-DIO-96/PCI-6508
4 National Instruments PCI-DIO-32HS
5 National Instruments PCI-6503
6
7 COMEDI - Linux Control and Measurement Device Interface
8 Copyright (C) 1999,2002 David A. Schleef <ds@schleef.org>
9
10 This program is free software; you can redistribute it and/or modify
11 it under the terms of the GNU General Public License as published by
12 the Free Software Foundation; either version 2 of the License, or
13 (at your option) any later version.
14
15 This program is distributed in the hope that it will be useful,
16 but WITHOUT ANY WARRANTY; without even the implied warranty of
17 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 GNU General Public License for more details.
19
20 You should have received a copy of the GNU General Public License
21 along with this program; if not, write to the Free Software
22 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23
24 */
25 /*
26 Driver: ni_pcidio
27 Description: National Instruments PCI-DIO32HS, PCI-DIO96, PCI-6533, PCI-6503
28 Author: ds
29 Status: works
30 Devices: [National Instruments] PCI-DIO-32HS (ni_pcidio), PXI-6533,
31 PCI-DIO-96, PCI-DIO-96B, PXI-6508, PCI-6503, PCI-6503B, PCI-6503X,
32 PXI-6503, PCI-6533, PCI-6534
33 Updated: Sun, 21 Apr 2002 21:03:38 -0700
34
35 The DIO-96 appears as four 8255 subdevices. See the 8255
36 driver notes for details.
37
38 The DIO32HS board appears as one subdevice, with 32 channels.
39 Each channel is individually I/O configurable. The channel order
40 is 0=A0, 1=A1, 2=A2, ... 8=B0, 16=C0, 24=D0. The driver only
41 supports simple digital I/O; no handshaking is supported.
42
43 DMA mostly works for the PCI-DIO32HS, but only in timed input mode.
44
45 This driver could be easily modified to support AT-MIO32HS and
46 AT-MIO96.
47
48 The PCI-6534 requires a firmware upload after power-up to work, the
49 firmware data and instructions for loading it with comedi_config
50 it are contained in the
51 comedi_nonfree_firmware tarball available from http://www.comedi.org
52 */
53
54 /*
55 This driver is for both the NI PCI-DIO-32HS and the PCI-DIO-96,
56 which have very different architectures. But, since the '96 is
57 so simple, it is included here.
58
59 Manuals (available from ftp://ftp.natinst.com/support/manuals)
60
61 320938c.pdf PCI-DIO-96/PXI-6508/PCI-6503 User Manual
62 321464b.pdf AT/PCI-DIO-32HS User Manual
63 341329A.pdf PCI-6533 Register-Level Programmer Manual
64 341330A.pdf DAQ-DIO Technical Reference Manual
65
66 */
67
68 #define USE_DMA
69 /* #define DEBUG 1 */
70 /* #define DEBUG_FLAGS */
71
72 #include <linux/interrupt.h>
73 #include <linux/sched.h>
74 #include "../comedidev.h"
75
76 #include "mite.h"
77 #include "8255.h"
78
79 #undef DPRINTK
80 #ifdef DEBUG
81 #define DPRINTK(format, args...) printk(format, ## args)
82 #else
83 #define DPRINTK(format, args...)
84 #endif
85
86 #define PCI_DIO_SIZE 4096
87 #define PCI_MITE_SIZE 4096
88
89 /* defines for the PCI-DIO-96 */
90
91 #define NIDIO_8255_BASE(x) ((x)*4)
92 #define NIDIO_A 0
93 #define NIDIO_B 4
94 #define NIDIO_C 8
95 #define NIDIO_D 12
96
97 /* defines for the PCI-DIO-32HS */
98
99 #define Window_Address 4 /* W */
100 #define Interrupt_And_Window_Status 4 /* R */
101 #define IntStatus1 (1<<0)
102 #define IntStatus2 (1<<1)
103 #define WindowAddressStatus_mask 0x7c
104
105 #define Master_DMA_And_Interrupt_Control 5 /* W */
106 #define InterruptLine(x) ((x)&3)
107 #define OpenInt (1<<2)
108 #define Group_Status 5 /* R */
109 #define DataLeft (1<<0)
110 #define Req (1<<2)
111 #define StopTrig (1<<3)
112
113 #define Group_1_Flags 6 /* R */
114 #define Group_2_Flags 7 /* R */
115 #define TransferReady (1<<0)
116 #define CountExpired (1<<1)
117 #define Waited (1<<5)
118 #define PrimaryTC (1<<6)
119 #define SecondaryTC (1<<7)
120 /* #define SerialRose */
121 /* #define ReqRose */
122 /* #define Paused */
123
124 #define Group_1_First_Clear 6 /* W */
125 #define Group_2_First_Clear 7 /* W */
126 #define ClearWaited (1<<3)
127 #define ClearPrimaryTC (1<<4)
128 #define ClearSecondaryTC (1<<5)
129 #define DMAReset (1<<6)
130 #define FIFOReset (1<<7)
131 #define ClearAll 0xf8
132
133 #define Group_1_FIFO 8 /* W */
134 #define Group_2_FIFO 12 /* W */
135
136 #define Transfer_Count 20
137 #define Chip_ID_D 24
138 #define Chip_ID_I 25
139 #define Chip_ID_O 26
140 #define Chip_Version 27
141 #define Port_IO(x) (28+(x))
142 #define Port_Pin_Directions(x) (32+(x))
143 #define Port_Pin_Mask(x) (36+(x))
144 #define Port_Pin_Polarities(x) (40+(x))
145
146 #define Master_Clock_Routing 45
147 #define RTSIClocking(x) (((x)&3)<<4)
148
149 #define Group_1_Second_Clear 46 /* W */
150 #define Group_2_Second_Clear 47 /* W */
151 #define ClearExpired (1<<0)
152
153 #define Port_Pattern(x) (48+(x))
154
155 #define Data_Path 64
156 #define FIFOEnableA (1<<0)
157 #define FIFOEnableB (1<<1)
158 #define FIFOEnableC (1<<2)
159 #define FIFOEnableD (1<<3)
160 #define Funneling(x) (((x)&3)<<4)
161 #define GroupDirection (1<<7)
162
163 #define Protocol_Register_1 65
164 #define OpMode Protocol_Register_1
165 #define RunMode(x) ((x)&7)
166 #define Numbered (1<<3)
167
168 #define Protocol_Register_2 66
169 #define ClockReg Protocol_Register_2
170 #define ClockLine(x) (((x)&3)<<5)
171 #define InvertStopTrig (1<<7)
172 #define DataLatching(x) (((x)&3)<<5)
173
174 #define Protocol_Register_3 67
175 #define Sequence Protocol_Register_3
176
177 #define Protocol_Register_14 68 /* 16 bit */
178 #define ClockSpeed Protocol_Register_14
179
180 #define Protocol_Register_4 70
181 #define ReqReg Protocol_Register_4
182 #define ReqConditioning(x) (((x)&7)<<3)
183
184 #define Protocol_Register_5 71
185 #define BlockMode Protocol_Register_5
186
187 #define FIFO_Control 72
188 #define ReadyLevel(x) ((x)&7)
189
190 #define Protocol_Register_6 73
191 #define LinePolarities Protocol_Register_6
192 #define InvertAck (1<<0)
193 #define InvertReq (1<<1)
194 #define InvertClock (1<<2)
195 #define InvertSerial (1<<3)
196 #define OpenAck (1<<4)
197 #define OpenClock (1<<5)
198
199 #define Protocol_Register_7 74
200 #define AckSer Protocol_Register_7
201 #define AckLine(x) (((x)&3)<<2)
202 #define ExchangePins (1<<7)
203
204 #define Interrupt_Control 75
205 /* bits same as flags */
206
207 #define DMA_Line_Control_Group1 76
208 #define DMA_Line_Control_Group2 108
209 /* channel zero is none */
210 static inline unsigned primary_DMAChannel_bits(unsigned channel)
211 {
212 return channel & 0x3;
213 }
214
215 static inline unsigned secondary_DMAChannel_bits(unsigned channel)
216 {
217 return (channel << 2) & 0xc;
218 }
219
220 #define Transfer_Size_Control 77
221 #define TransferWidth(x) ((x)&3)
222 #define TransferLength(x) (((x)&3)<<3)
223 #define RequireRLevel (1<<5)
224
225 #define Protocol_Register_15 79
226 #define DAQOptions Protocol_Register_15
227 #define StartSource(x) ((x)&0x3)
228 #define InvertStart (1<<2)
229 #define StopSource(x) (((x)&0x3)<<3)
230 #define ReqStart (1<<6)
231 #define PreStart (1<<7)
232
233 #define Pattern_Detection 81
234 #define DetectionMethod (1<<0)
235 #define InvertMatch (1<<1)
236 #define IE_Pattern_Detection (1<<2)
237
238 #define Protocol_Register_9 82
239 #define ReqDelay Protocol_Register_9
240
241 #define Protocol_Register_10 83
242 #define ReqNotDelay Protocol_Register_10
243
244 #define Protocol_Register_11 84
245 #define AckDelay Protocol_Register_11
246
247 #define Protocol_Register_12 85
248 #define AckNotDelay Protocol_Register_12
249
250 #define Protocol_Register_13 86
251 #define Data1Delay Protocol_Register_13
252
253 #define Protocol_Register_8 88 /* 32 bit */
254 #define StartDelay Protocol_Register_8
255
256 enum pci_6534_firmware_registers { /* 16 bit */
257 Firmware_Control_Register = 0x100,
258 Firmware_Status_Register = 0x104,
259 Firmware_Data_Register = 0x108,
260 Firmware_Mask_Register = 0x10c,
261 Firmware_Debug_Register = 0x110,
262 };
263 /* main fpga registers (32 bit)*/
264 enum pci_6534_fpga_registers {
265 FPGA_Control1_Register = 0x200,
266 FPGA_Control2_Register = 0x204,
267 FPGA_Irq_Mask_Register = 0x208,
268 FPGA_Status_Register = 0x20c,
269 FPGA_Signature_Register = 0x210,
270 FPGA_SCALS_Counter_Register = 0x280, /*write-clear */
271 FPGA_SCAMS_Counter_Register = 0x284, /*write-clear */
272 FPGA_SCBLS_Counter_Register = 0x288, /*write-clear */
273 FPGA_SCBMS_Counter_Register = 0x28c, /*write-clear */
274 FPGA_Temp_Control_Register = 0x2a0,
275 FPGA_DAR_Register = 0x2a8,
276 FPGA_ELC_Read_Register = 0x2b8,
277 FPGA_ELC_Write_Register = 0x2bc,
278 };
279 enum FPGA_Control_Bits {
280 FPGA_Enable_Bit = 0x8000,
281 };
282
283 #define TIMER_BASE 50 /* nanoseconds */
284
285 #ifdef USE_DMA
286 #define IntEn (CountExpired|Waited|PrimaryTC|SecondaryTC)
287 #else
288 #define IntEn (TransferReady|CountExpired|Waited|PrimaryTC|SecondaryTC)
289 #endif
290
291 static int nidio_attach(struct comedi_device *dev, struct comedi_devconfig *it);
292 static int nidio_detach(struct comedi_device *dev);
293 static int ni_pcidio_cancel(struct comedi_device *dev,
294 struct comedi_subdevice *s);
295
296 static struct comedi_driver driver_pcidio = {
297 .driver_name = "ni_pcidio",
298 .module = THIS_MODULE,
299 .attach = nidio_attach,
300 .detach = nidio_detach,
301 };
302
303 struct nidio_board {
304
305 int dev_id;
306 const char *name;
307 int n_8255;
308 unsigned int is_diodaq:1;
309 unsigned int uses_firmware:1;
310 };
311
312 static const struct nidio_board nidio_boards[] = {
313 {
314 .dev_id = 0x1150,
315 .name = "pci-dio-32hs",
316 .n_8255 = 0,
317 .is_diodaq = 1,
318 },
319 {
320 .dev_id = 0x1320,
321 .name = "pxi-6533",
322 .n_8255 = 0,
323 .is_diodaq = 1,
324 },
325 {
326 .dev_id = 0x12b0,
327 .name = "pci-6534",
328 .n_8255 = 0,
329 .is_diodaq = 1,
330 .uses_firmware = 1,
331 },
332 {
333 .dev_id = 0x0160,
334 .name = "pci-dio-96",
335 .n_8255 = 4,
336 .is_diodaq = 0,
337 },
338 {
339 .dev_id = 0x1630,
340 .name = "pci-dio-96b",
341 .n_8255 = 4,
342 .is_diodaq = 0,
343 },
344 {
345 .dev_id = 0x13c0,
346 .name = "pxi-6508",
347 .n_8255 = 4,
348 .is_diodaq = 0,
349 },
350 {
351 .dev_id = 0x0400,
352 .name = "pci-6503",
353 .n_8255 = 1,
354 .is_diodaq = 0,
355 },
356 {
357 .dev_id = 0x1250,
358 .name = "pci-6503b",
359 .n_8255 = 1,
360 .is_diodaq = 0,
361 },
362 {
363 .dev_id = 0x17d0,
364 .name = "pci-6503x",
365 .n_8255 = 1,
366 .is_diodaq = 0,
367 },
368 {
369 .dev_id = 0x1800,
370 .name = "pxi-6503",
371 .n_8255 = 1,
372 .is_diodaq = 0,
373 },
374 };
375
376 #define n_nidio_boards ARRAY_SIZE(nidio_boards)
377 #define this_board ((const struct nidio_board *)dev->board_ptr)
378
379 static DEFINE_PCI_DEVICE_TABLE(ni_pcidio_pci_table) = {
380 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1150)},
381 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1320)},
382 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x12b0)},
383 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x0160)},
384 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1630)},
385 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x13c0)},
386 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x0400)},
387 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1250)},
388 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x17d0)},
389 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1800)},
390 {0}
391 };
392
393 MODULE_DEVICE_TABLE(pci, ni_pcidio_pci_table);
394
395 struct nidio96_private {
396 struct mite_struct *mite;
397 int boardtype;
398 int dio;
399 unsigned short OpModeBits;
400 struct mite_channel *di_mite_chan;
401 struct mite_dma_descriptor_ring *di_mite_ring;
402 spinlock_t mite_channel_lock;
403 };
404 #define devpriv ((struct nidio96_private *)dev->private)
405
406 static int ni_pcidio_cmdtest(struct comedi_device *dev,
407 struct comedi_subdevice *s,
408 struct comedi_cmd *cmd);
409 static int ni_pcidio_cmd(struct comedi_device *dev, struct comedi_subdevice *s);
410 static int ni_pcidio_inttrig(struct comedi_device *dev,
411 struct comedi_subdevice *s, unsigned int trignum);
412 static int nidio_find_device(struct comedi_device *dev, int bus, int slot);
413 static int ni_pcidio_ns_to_timer(int *nanosec, int round_mode);
414 static int setup_mite_dma(struct comedi_device *dev,
415 struct comedi_subdevice *s);
416
417 #ifdef DEBUG_FLAGS
418 static void ni_pcidio_print_flags(unsigned int flags);
419 static void ni_pcidio_print_status(unsigned int status);
420 #else
421 #define ni_pcidio_print_flags(x)
422 #define ni_pcidio_print_status(x)
423 #endif
424
425 static int ni_pcidio_request_di_mite_channel(struct comedi_device *dev)
426 {
427 unsigned long flags;
428
429 spin_lock_irqsave(&devpriv->mite_channel_lock, flags);
430 BUG_ON(devpriv->di_mite_chan);
431 devpriv->di_mite_chan =
432 mite_request_channel_in_range(devpriv->mite,
433 devpriv->di_mite_ring, 1, 2);
434 if (devpriv->di_mite_chan == NULL) {
435 spin_unlock_irqrestore(&devpriv->mite_channel_lock, flags);
436 comedi_error(dev, "failed to reserve mite dma channel.");
437 return -EBUSY;
438 }
439 writeb(primary_DMAChannel_bits(devpriv->di_mite_chan->channel) |
440 secondary_DMAChannel_bits(devpriv->di_mite_chan->channel),
441 devpriv->mite->daq_io_addr + DMA_Line_Control_Group1);
442 mmiowb();
443 spin_unlock_irqrestore(&devpriv->mite_channel_lock, flags);
444 return 0;
445 }
446
447 static void ni_pcidio_release_di_mite_channel(struct comedi_device *dev)
448 {
449 unsigned long flags;
450
451 spin_lock_irqsave(&devpriv->mite_channel_lock, flags);
452 if (devpriv->di_mite_chan) {
453 mite_dma_disarm(devpriv->di_mite_chan);
454 mite_dma_reset(devpriv->di_mite_chan);
455 mite_release_channel(devpriv->di_mite_chan);
456 devpriv->di_mite_chan = NULL;
457 writeb(primary_DMAChannel_bits(0) |
458 secondary_DMAChannel_bits(0),
459 devpriv->mite->daq_io_addr + DMA_Line_Control_Group1);
460 mmiowb();
461 }
462 spin_unlock_irqrestore(&devpriv->mite_channel_lock, flags);
463 }
464
465 static int nidio96_8255_cb(int dir, int port, int data, unsigned long iobase)
466 {
467 if (dir) {
468 writeb(data, (void *)(iobase + port));
469 return 0;
470 } else {
471 return readb((void *)(iobase + port));
472 }
473 }
474
475 void ni_pcidio_event(struct comedi_device *dev, struct comedi_subdevice *s)
476 {
477 if (s->
478 async->events & (COMEDI_CB_EOA | COMEDI_CB_ERROR |
479 COMEDI_CB_OVERFLOW)) {
480 ni_pcidio_cancel(dev, s);
481 }
482 comedi_event(dev, s);
483 }
484
485 static irqreturn_t nidio_interrupt(int irq, void *d)
486 {
487 struct comedi_device *dev = d;
488 struct comedi_subdevice *s = dev->subdevices;
489 struct comedi_async *async = s->async;
490 struct mite_struct *mite = devpriv->mite;
491
492 /* int i, j; */
493 long int AuxData = 0;
494 short data1 = 0;
495 short data2 = 0;
496 int flags;
497 int status;
498 int work = 0;
499 unsigned int m_status = 0;
500 unsigned long irq_flags;
501
502 /* interrupcions parasites */
503 if (dev->attached == 0) {
504 /* assume it's from another card */
505 return IRQ_NONE;
506 }
507
508 status = readb(devpriv->mite->daq_io_addr +
509 Interrupt_And_Window_Status);
510 flags = readb(devpriv->mite->daq_io_addr + Group_1_Flags);
511
512 DPRINTK("ni_pcidio_interrupt: status=0x%02x,flags=0x%02x\n",
513 status, flags);
514 ni_pcidio_print_flags(flags);
515 ni_pcidio_print_status(status);
516
517 /* printk("buf[0]=%08x\n",*(unsigned int *)async->prealloc_buf); */
518 /* printk("buf[4096]=%08x\n",
519 *(unsigned int *)(async->prealloc_buf+4096)); */
520
521 spin_lock_irqsave(&devpriv->mite_channel_lock, irq_flags);
522 if (devpriv->di_mite_chan)
523 m_status = mite_get_status(devpriv->di_mite_chan);
524 #ifdef MITE_DEBUG
525 mite_print_chsr(m_status);
526 #endif
527 /* printk("mite_bytes_transferred: %d\n",
528 mite_bytes_transferred(mite,DI_DMA_CHAN)); */
529
530 /* mite_dump_regs(mite); */
531 if (m_status & CHSR_INT) {
532 if (m_status & CHSR_LINKC) {
533 writel(CHOR_CLRLC,
534 mite->mite_io_addr +
535 MITE_CHOR(devpriv->di_mite_chan->channel));
536 mite_sync_input_dma(devpriv->di_mite_chan, s->async);
537 }
538 if (m_status & ~(CHSR_INT | CHSR_LINKC | CHSR_DONE | CHSR_DRDY |
539 CHSR_DRQ1 | CHSR_MRDY)) {
540 DPRINTK("unknown mite interrupt, disabling IRQ\n");
541 async->events |= COMEDI_CB_EOA | COMEDI_CB_ERROR;
542 disable_irq(dev->irq);
543 }
544 }
545 spin_unlock_irqrestore(&devpriv->mite_channel_lock, irq_flags);
546
547 while (status & DataLeft) {
548 work++;
549 if (work > 20) {
550 DPRINTK("too much work in interrupt\n");
551 writeb(0x00,
552 devpriv->mite->daq_io_addr +
553 Master_DMA_And_Interrupt_Control);
554 break;
555 }
556
557 flags &= IntEn;
558
559 if (flags & TransferReady) {
560 /* DPRINTK("TransferReady\n"); */
561 while (flags & TransferReady) {
562 work++;
563 if (work > 100) {
564 DPRINTK("too much work in interrupt\n");
565 writeb(0x00,
566 devpriv->mite->daq_io_addr +
567 Master_DMA_And_Interrupt_Control
568 );
569 goto out;
570 }
571 AuxData =
572 readl(devpriv->mite->daq_io_addr +
573 Group_1_FIFO);
574 data1 = AuxData & 0xffff;
575 data2 = (AuxData & 0xffff0000) >> 16;
576 comedi_buf_put(async, data1);
577 comedi_buf_put(async, data2);
578 /* DPRINTK("read:%d, %d\n",data1,data2); */
579 flags = readb(devpriv->mite->daq_io_addr +
580 Group_1_Flags);
581 }
582 /* DPRINTK("buf_int_count: %d\n",
583 async->buf_int_count); */
584 /* DPRINTK("1) IntEn=%d,flags=%d,status=%d\n",
585 IntEn,flags,status); */
586 /* ni_pcidio_print_flags(flags); */
587 /* ni_pcidio_print_status(status); */
588 async->events |= COMEDI_CB_BLOCK;
589 }
590
591 if (flags & CountExpired) {
592 DPRINTK("CountExpired\n");
593 writeb(ClearExpired,
594 devpriv->mite->daq_io_addr +
595 Group_1_Second_Clear);
596 async->events |= COMEDI_CB_EOA;
597
598 writeb(0x00, devpriv->mite->daq_io_addr + OpMode);
599 break;
600 } else if (flags & Waited) {
601 DPRINTK("Waited\n");
602 writeb(ClearWaited,
603 devpriv->mite->daq_io_addr +
604 Group_1_First_Clear);
605 async->events |= COMEDI_CB_EOA | COMEDI_CB_ERROR;
606 break;
607 } else if (flags & PrimaryTC) {
608 DPRINTK("PrimaryTC\n");
609 writeb(ClearPrimaryTC,
610 devpriv->mite->daq_io_addr +
611 Group_1_First_Clear);
612 async->events |= COMEDI_CB_EOA;
613 } else if (flags & SecondaryTC) {
614 DPRINTK("SecondaryTC\n");
615 writeb(ClearSecondaryTC,
616 devpriv->mite->daq_io_addr +
617 Group_1_First_Clear);
618 async->events |= COMEDI_CB_EOA;
619 }
620 flags = readb(devpriv->mite->daq_io_addr + Group_1_Flags);
621 status = readb(devpriv->mite->daq_io_addr +
622 Interrupt_And_Window_Status);
623 /* DPRINTK("loop end: IntEn=0x%02x,flags=0x%02x,"
624 "status=0x%02x\n", IntEn, flags, status); */
625 /* ni_pcidio_print_flags(flags); */
626 /* ni_pcidio_print_status(status); */
627 }
628
629 out:
630 ni_pcidio_event(dev, s);
631 return IRQ_HANDLED;
632 }
633
634 #ifdef DEBUG_FLAGS
635 static const char *const flags_strings[] = {
636 "TransferReady", "CountExpired", "2", "3",
637 "4", "Waited", "PrimaryTC", "SecondaryTC",
638 };
639
640 static void ni_pcidio_print_flags(unsigned int flags)
641 {
642 int i;
643
644 printk(KERN_INFO "group_1_flags:");
645 for (i = 7; i >= 0; i--) {
646 if (flags & (1 << i))
647 printk(" %s", flags_strings[i]);
648 }
649 printk("\n");
650 }
651
652 static char *status_strings[] = {
653 "DataLeft1", "Reserved1", "Req1", "StopTrig1",
654 "DataLeft2", "Reserved2", "Req2", "StopTrig2",
655 };
656
657 static void ni_pcidio_print_status(unsigned int flags)
658 {
659 int i;
660
661 printk(KERN_INFO "group_status:");
662 for (i = 7; i >= 0; i--) {
663 if (flags & (1 << i))
664 printk(" %s", status_strings[i]);
665 }
666 printk("\n");
667 }
668 #endif
669
670 #ifdef unused
671 static void debug_int(struct comedi_device *dev)
672 {
673 int a, b;
674 static int n_int = 0;
675 struct timeval tv;
676
677 do_gettimeofday(&tv);
678 a = readb(devpriv->mite->daq_io_addr + Group_Status);
679 b = readb(devpriv->mite->daq_io_addr + Group_1_Flags);
680
681 if (n_int < 10) {
682 DPRINTK("status 0x%02x flags 0x%02x time %06d\n", a, b,
683 (int)tv.tv_usec);
684 }
685
686 while (b & 1) {
687 writew(0xff, devpriv->mite->daq_io_addr + Group_1_FIFO);
688 b = readb(devpriv->mite->daq_io_addr + Group_1_Flags);
689 }
690
691 b = readb(devpriv->mite->daq_io_addr + Group_1_Flags);
692
693 if (n_int < 10) {
694 DPRINTK("new status 0x%02x\n", b);
695 n_int++;
696 }
697 }
698 #endif
699
700 static int ni_pcidio_insn_config(struct comedi_device *dev,
701 struct comedi_subdevice *s,
702 struct comedi_insn *insn, unsigned int *data)
703 {
704 if (insn->n != 1)
705 return -EINVAL;
706 switch (data[0]) {
707 case INSN_CONFIG_DIO_OUTPUT:
708 s->io_bits |= 1 << CR_CHAN(insn->chanspec);
709 break;
710 case INSN_CONFIG_DIO_INPUT:
711 s->io_bits &= ~(1 << CR_CHAN(insn->chanspec));
712 break;
713 case INSN_CONFIG_DIO_QUERY:
714 data[1] =
715 (s->
716 io_bits & (1 << CR_CHAN(insn->chanspec))) ? COMEDI_OUTPUT :
717 COMEDI_INPUT;
718 return insn->n;
719 break;
720 default:
721 return -EINVAL;
722 }
723 writel(s->io_bits, devpriv->mite->daq_io_addr + Port_Pin_Directions(0));
724
725 return 1;
726 }
727
728 static int ni_pcidio_insn_bits(struct comedi_device *dev,
729 struct comedi_subdevice *s,
730 struct comedi_insn *insn, unsigned int *data)
731 {
732 if (insn->n != 2)
733 return -EINVAL;
734 if (data[0]) {
735 s->state &= ~data[0];
736 s->state |= (data[0] & data[1]);
737 writel(s->state, devpriv->mite->daq_io_addr + Port_IO(0));
738 }
739 data[1] = readl(devpriv->mite->daq_io_addr + Port_IO(0));
740
741 return 2;
742 }
743
744 static int ni_pcidio_cmdtest(struct comedi_device *dev,
745 struct comedi_subdevice *s, struct comedi_cmd *cmd)
746 {
747 int err = 0;
748 int tmp;
749
750 /* step 1: make sure trigger sources are trivially valid */
751
752 tmp = cmd->start_src;
753 cmd->start_src &= TRIG_NOW | TRIG_INT;
754 if (!cmd->start_src || tmp != cmd->start_src)
755 err++;
756
757 tmp = cmd->scan_begin_src;
758 cmd->scan_begin_src &= TRIG_TIMER | TRIG_EXT;
759 if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
760 err++;
761
762 tmp = cmd->convert_src;
763 cmd->convert_src &= TRIG_NOW;
764 if (!cmd->convert_src || tmp != cmd->convert_src)
765 err++;
766
767 tmp = cmd->scan_end_src;
768 cmd->scan_end_src &= TRIG_COUNT;
769 if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
770 err++;
771
772 tmp = cmd->stop_src;
773 cmd->stop_src &= TRIG_COUNT | TRIG_NONE;
774 if (!cmd->stop_src || tmp != cmd->stop_src)
775 err++;
776
777 if (err)
778 return 1;
779
780 /* step 2: make sure trigger sources are unique and mutually
781 compatible */
782
783 /* note that mutual compatibility is not an issue here */
784 if (cmd->start_src != TRIG_NOW && cmd->start_src != TRIG_INT)
785 err++;
786 if (cmd->scan_begin_src != TRIG_TIMER &&
787 cmd->scan_begin_src != TRIG_EXT)
788 err++;
789
790 if (err)
791 return 2;
792
793 /* step 3: make sure arguments are trivially compatible */
794
795 if (cmd->start_arg != 0) {
796 /* same for both TRIG_INT and TRIG_NOW */
797 cmd->start_arg = 0;
798 err++;
799 }
800 #define MAX_SPEED (TIMER_BASE) /* in nanoseconds */
801
802 if (cmd->scan_begin_src == TRIG_TIMER) {
803 if (cmd->scan_begin_arg < MAX_SPEED) {
804 cmd->scan_begin_arg = MAX_SPEED;
805 err++;
806 }
807 /* no minumum speed */
808 } else {
809 /* TRIG_EXT */
810 /* should be level/edge, hi/lo specification here */
811 if (cmd->scan_begin_arg != 0) {
812 cmd->scan_begin_arg = 0;
813 err++;
814 }
815 }
816 if (cmd->convert_arg != 0) {
817 cmd->convert_arg = 0;
818 err++;
819 }
820
821 if (cmd->scan_end_arg != cmd->chanlist_len) {
822 cmd->scan_end_arg = cmd->chanlist_len;
823 err++;
824 }
825 if (cmd->stop_src == TRIG_COUNT) {
826 /* no limit */
827 } else {
828 /* TRIG_NONE */
829 if (cmd->stop_arg != 0) {
830 cmd->stop_arg = 0;
831 err++;
832 }
833 }
834
835 if (err)
836 return 3;
837
838 /* step 4: fix up any arguments */
839
840 if (cmd->scan_begin_src == TRIG_TIMER) {
841 tmp = cmd->scan_begin_arg;
842 ni_pcidio_ns_to_timer(&cmd->scan_begin_arg,
843 cmd->flags & TRIG_ROUND_MASK);
844 if (tmp != cmd->scan_begin_arg)
845 err++;
846 }
847
848 if (err)
849 return 4;
850
851 return 0;
852 }
853
854 static int ni_pcidio_ns_to_timer(int *nanosec, int round_mode)
855 {
856 int divider, base;
857
858 base = TIMER_BASE;
859
860 switch (round_mode) {
861 case TRIG_ROUND_NEAREST:
862 default:
863 divider = (*nanosec + base / 2) / base;
864 break;
865 case TRIG_ROUND_DOWN:
866 divider = (*nanosec) / base;
867 break;
868 case TRIG_ROUND_UP:
869 divider = (*nanosec + base - 1) / base;
870 break;
871 }
872
873 *nanosec = base * divider;
874 return divider;
875 }
876
877 static int ni_pcidio_cmd(struct comedi_device *dev, struct comedi_subdevice *s)
878 {
879 struct comedi_cmd *cmd = &s->async->cmd;
880
881 writel(0x0000, devpriv->mite->daq_io_addr + Port_Pin_Directions(0));
882
883 if (1) {
884 /* enable fifos A B C D */
885 writeb(0x0f, devpriv->mite->daq_io_addr + Data_Path);
886
887 /* set transfer width a 32 bits */
888 writeb(TransferWidth(0) | TransferLength(0),
889 devpriv->mite->daq_io_addr + Transfer_Size_Control);
890 } else {
891 writeb(0x03, devpriv->mite->daq_io_addr + Data_Path);
892 writeb(TransferWidth(3) | TransferLength(0),
893 devpriv->mite->daq_io_addr + Transfer_Size_Control);
894 }
895
896 /* protocol configuration */
897 if (cmd->scan_begin_src == TRIG_TIMER) {
898 /* page 4-5, "input with internal REQs" */
899 writeb(0, devpriv->mite->daq_io_addr + OpMode);
900 writeb(0x00, devpriv->mite->daq_io_addr + ClockReg);
901 writeb(1, devpriv->mite->daq_io_addr + Sequence);
902 writeb(0x04, devpriv->mite->daq_io_addr + ReqReg);
903 writeb(4, devpriv->mite->daq_io_addr + BlockMode);
904 writeb(3, devpriv->mite->daq_io_addr + LinePolarities);
905 writeb(0xc0, devpriv->mite->daq_io_addr + AckSer);
906 writel(ni_pcidio_ns_to_timer(&cmd->scan_begin_arg,
907 TRIG_ROUND_NEAREST),
908 devpriv->mite->daq_io_addr + StartDelay);
909 writeb(1, devpriv->mite->daq_io_addr + ReqDelay);
910 writeb(1, devpriv->mite->daq_io_addr + ReqNotDelay);
911 writeb(1, devpriv->mite->daq_io_addr + AckDelay);
912 writeb(0x0b, devpriv->mite->daq_io_addr + AckNotDelay);
913 writeb(0x01, devpriv->mite->daq_io_addr + Data1Delay);
914 /* manual, page 4-5: ClockSpeed comment is incorrectly listed
915 * on DAQOptions */
916 writew(0, devpriv->mite->daq_io_addr + ClockSpeed);
917 writeb(0, devpriv->mite->daq_io_addr + DAQOptions);
918 } else {
919 /* TRIG_EXT */
920 /* page 4-5, "input with external REQs" */
921 writeb(0, devpriv->mite->daq_io_addr + OpMode);
922 writeb(0x00, devpriv->mite->daq_io_addr + ClockReg);
923 writeb(0, devpriv->mite->daq_io_addr + Sequence);
924 writeb(0x00, devpriv->mite->daq_io_addr + ReqReg);
925 writeb(4, devpriv->mite->daq_io_addr + BlockMode);
926 writeb(0, devpriv->mite->daq_io_addr + LinePolarities);
927 writeb(0x00, devpriv->mite->daq_io_addr + AckSer);
928 writel(1, devpriv->mite->daq_io_addr + StartDelay);
929 writeb(1, devpriv->mite->daq_io_addr + ReqDelay);
930 writeb(1, devpriv->mite->daq_io_addr + ReqNotDelay);
931 writeb(1, devpriv->mite->daq_io_addr + AckDelay);
932 writeb(0x0C, devpriv->mite->daq_io_addr + AckNotDelay);
933 writeb(0x10, devpriv->mite->daq_io_addr + Data1Delay);
934 writew(0, devpriv->mite->daq_io_addr + ClockSpeed);
935 writeb(0x60, devpriv->mite->daq_io_addr + DAQOptions);
936 }
937
938 if (cmd->stop_src == TRIG_COUNT) {
939 writel(cmd->stop_arg,
940 devpriv->mite->daq_io_addr + Transfer_Count);
941 } else {
942 }
943
944 #ifdef USE_DMA
945 writeb(ClearPrimaryTC | ClearSecondaryTC,
946 devpriv->mite->daq_io_addr + Group_1_First_Clear);
947
948 {
949 int retval = setup_mite_dma(dev, s);
950 if (retval)
951 return retval;
952 }
953 #else
954 writeb(0x00, devpriv->mite->daq_io_addr + DMA_Line_Control_Group1);
955 #endif
956 writeb(0x00, devpriv->mite->daq_io_addr + DMA_Line_Control_Group2);
957
958 /* clear and enable interrupts */
959 writeb(0xff, devpriv->mite->daq_io_addr + Group_1_First_Clear);
960 /* writeb(ClearExpired,
961 devpriv->mite->daq_io_addr+Group_1_Second_Clear); */
962
963 writeb(IntEn, devpriv->mite->daq_io_addr + Interrupt_Control);
964 writeb(0x03,
965 devpriv->mite->daq_io_addr + Master_DMA_And_Interrupt_Control);
966
967 if (cmd->stop_src == TRIG_NONE) {
968 devpriv->OpModeBits = DataLatching(0) | RunMode(7);
969 } else { /* TRIG_TIMER */
970 devpriv->OpModeBits = Numbered | RunMode(7);
971 }
972 if (cmd->start_src == TRIG_NOW) {
973 /* start */
974 writeb(devpriv->OpModeBits,
975 devpriv->mite->daq_io_addr + OpMode);
976 s->async->inttrig = NULL;
977 } else {
978 /* TRIG_INT */
979 s->async->inttrig = ni_pcidio_inttrig;
980 }
981
982 DPRINTK("ni_pcidio: command started\n");
983 return 0;
984 }
985
986 static int setup_mite_dma(struct comedi_device *dev, struct comedi_subdevice *s)
987 {
988 int retval;
989
990 retval = ni_pcidio_request_di_mite_channel(dev);
991 if (retval)
992 return retval;
993
994 devpriv->di_mite_chan->dir = COMEDI_INPUT;
995
996 mite_prep_dma(devpriv->di_mite_chan, 32, 32);
997
998 mite_dma_arm(devpriv->di_mite_chan);
999 return 0;
1000 }
1001
1002 static int ni_pcidio_inttrig(struct comedi_device *dev,
1003 struct comedi_subdevice *s, unsigned int trignum)
1004 {
1005 if (trignum != 0)
1006 return -EINVAL;
1007
1008 writeb(devpriv->OpModeBits, devpriv->mite->daq_io_addr + OpMode);
1009 s->async->inttrig = NULL;
1010
1011 return 1;
1012 }
1013
1014 static int ni_pcidio_cancel(struct comedi_device *dev,
1015 struct comedi_subdevice *s)
1016 {
1017 writeb(0x00,
1018 devpriv->mite->daq_io_addr + Master_DMA_And_Interrupt_Control);
1019 ni_pcidio_release_di_mite_channel(dev);
1020
1021 return 0;
1022 }
1023
1024 static int ni_pcidio_change(struct comedi_device *dev,
1025 struct comedi_subdevice *s, unsigned long new_size)
1026 {
1027 int ret;
1028
1029 ret = mite_buf_change(devpriv->di_mite_ring, s->async);
1030 if (ret < 0)
1031 return ret;
1032
1033 memset(s->async->prealloc_buf, 0xaa, s->async->prealloc_bufsz);
1034
1035 return 0;
1036 }
1037
1038 static int pci_6534_load_fpga(struct comedi_device *dev, int fpga_index,
1039 u8 *data, int data_len)
1040 {
1041 static const int timeout = 1000;
1042 int i, j;
1043 writew(0x80 | fpga_index,
1044 devpriv->mite->daq_io_addr + Firmware_Control_Register);
1045 writew(0xc0 | fpga_index,
1046 devpriv->mite->daq_io_addr + Firmware_Control_Register);
1047 for (i = 0;
1048 (readw(devpriv->mite->daq_io_addr +
1049 Firmware_Status_Register) & 0x2) == 0 && i < timeout; ++i) {
1050 udelay(1);
1051 }
1052 if (i == timeout) {
1053 printk(KERN_WARNING "ni_pcidio: failed to load fpga %i, "
1054 "waiting for status 0x2\n", fpga_index);
1055 return -EIO;
1056 }
1057 writew(0x80 | fpga_index,
1058 devpriv->mite->daq_io_addr + Firmware_Control_Register);
1059 for (i = 0;
1060 readw(devpriv->mite->daq_io_addr + Firmware_Status_Register) !=
1061 0x3 && i < timeout; ++i) {
1062 udelay(1);
1063 }
1064 if (i == timeout) {
1065 printk(KERN_WARNING "ni_pcidio: failed to load fpga %i, "
1066 "waiting for status 0x3\n", fpga_index);
1067 return -EIO;
1068 }
1069 for (j = 0; j + 1 < data_len;) {
1070 unsigned int value = data[j++];
1071 value |= data[j++] << 8;
1072 writew(value,
1073 devpriv->mite->daq_io_addr + Firmware_Data_Register);
1074 for (i = 0;
1075 (readw(devpriv->mite->daq_io_addr +
1076 Firmware_Status_Register) & 0x2) == 0
1077 && i < timeout; ++i) {
1078 udelay(1);
1079 }
1080 if (i == timeout) {
1081 printk("ni_pcidio: failed to load word into fpga %i\n",
1082 fpga_index);
1083 return -EIO;
1084 }
1085 if (need_resched())
1086 schedule();
1087 }
1088 writew(0x0, devpriv->mite->daq_io_addr + Firmware_Control_Register);
1089 return 0;
1090 }
1091
1092 static int pci_6534_reset_fpga(struct comedi_device *dev, int fpga_index)
1093 {
1094 return pci_6534_load_fpga(dev, fpga_index, NULL, 0);
1095 }
1096
1097 static int pci_6534_reset_fpgas(struct comedi_device *dev)
1098 {
1099 int ret;
1100 int i;
1101 writew(0x0, devpriv->mite->daq_io_addr + Firmware_Control_Register);
1102 for (i = 0; i < 3; ++i) {
1103 ret = pci_6534_reset_fpga(dev, i);
1104 if (ret < 0)
1105 break;
1106 }
1107 writew(0x0, devpriv->mite->daq_io_addr + Firmware_Mask_Register);
1108 return ret;
1109 }
1110
1111 static void pci_6534_init_main_fpga(struct comedi_device *dev)
1112 {
1113 writel(0, devpriv->mite->daq_io_addr + FPGA_Control1_Register);
1114 writel(0, devpriv->mite->daq_io_addr + FPGA_Control2_Register);
1115 writel(0, devpriv->mite->daq_io_addr + FPGA_SCALS_Counter_Register);
1116 writel(0, devpriv->mite->daq_io_addr + FPGA_SCAMS_Counter_Register);
1117 writel(0, devpriv->mite->daq_io_addr + FPGA_SCBLS_Counter_Register);
1118 writel(0, devpriv->mite->daq_io_addr + FPGA_SCBMS_Counter_Register);
1119 }
1120
1121 static int pci_6534_upload_firmware(struct comedi_device *dev, int options[])
1122 {
1123 int ret;
1124 void *main_fpga_data, *scarab_a_data, *scarab_b_data;
1125 int main_fpga_data_len, scarab_a_data_len, scarab_b_data_len;
1126
1127 if (options[COMEDI_DEVCONF_AUX_DATA_LENGTH] == 0)
1128 return 0;
1129 ret = pci_6534_reset_fpgas(dev);
1130 if (ret < 0)
1131 return ret;
1132 main_fpga_data = comedi_aux_data(options, 0);
1133 main_fpga_data_len = options[COMEDI_DEVCONF_AUX_DATA0_LENGTH];
1134 ret = pci_6534_load_fpga(dev, 2, main_fpga_data, main_fpga_data_len);
1135 if (ret < 0)
1136 return ret;
1137 pci_6534_init_main_fpga(dev);
1138 scarab_a_data = comedi_aux_data(options, 1);
1139 scarab_a_data_len = options[COMEDI_DEVCONF_AUX_DATA1_LENGTH];
1140 ret = pci_6534_load_fpga(dev, 0, scarab_a_data, scarab_a_data_len);
1141 if (ret < 0)
1142 return ret;
1143 scarab_b_data = comedi_aux_data(options, 2);
1144 scarab_b_data_len = options[COMEDI_DEVCONF_AUX_DATA2_LENGTH];
1145 ret = pci_6534_load_fpga(dev, 1, scarab_b_data, scarab_b_data_len);
1146 if (ret < 0)
1147 return ret;
1148 return 0;
1149 }
1150
1151 static int nidio_attach(struct comedi_device *dev, struct comedi_devconfig *it)
1152 {
1153 struct comedi_subdevice *s;
1154 int i;
1155 int ret;
1156 int n_subdevices;
1157 unsigned int irq;
1158
1159 printk(KERN_INFO "comedi%d: nidio:", dev->minor);
1160
1161 ret = alloc_private(dev, sizeof(struct nidio96_private));
1162 if (ret < 0)
1163 return ret;
1164 spin_lock_init(&devpriv->mite_channel_lock);
1165
1166 ret = nidio_find_device(dev, it->options[0], it->options[1]);
1167 if (ret < 0)
1168 return ret;
1169
1170 ret = mite_setup(devpriv->mite);
1171 if (ret < 0) {
1172 printk(KERN_WARNING "error setting up mite\n");
1173 return ret;
1174 }
1175 comedi_set_hw_dev(dev, &devpriv->mite->pcidev->dev);
1176 devpriv->di_mite_ring = mite_alloc_ring(devpriv->mite);
1177 if (devpriv->di_mite_ring == NULL)
1178 return -ENOMEM;
1179
1180 dev->board_name = this_board->name;
1181 irq = mite_irq(devpriv->mite);
1182 printk(KERN_INFO " %s", dev->board_name);
1183 if (this_board->uses_firmware) {
1184 ret = pci_6534_upload_firmware(dev, it->options);
1185 if (ret < 0)
1186 return ret;
1187 }
1188 if (!this_board->is_diodaq)
1189 n_subdevices = this_board->n_8255;
1190 else
1191 n_subdevices = 1;
1192
1193 ret = alloc_subdevices(dev, n_subdevices);
1194 if (ret < 0)
1195 return ret;
1196
1197 if (!this_board->is_diodaq) {
1198 for (i = 0; i < this_board->n_8255; i++) {
1199 subdev_8255_init(dev, dev->subdevices + i,
1200 nidio96_8255_cb,
1201 (unsigned long)(devpriv->mite->
1202 daq_io_addr +
1203 NIDIO_8255_BASE(i)));
1204 }
1205 } else {
1206
1207 printk(KERN_INFO " rev=%d",
1208 readb(devpriv->mite->daq_io_addr + Chip_Version));
1209
1210 s = dev->subdevices + 0;
1211
1212 dev->read_subdev = s;
1213 s->type = COMEDI_SUBD_DIO;
1214 s->subdev_flags =
1215 SDF_READABLE | SDF_WRITABLE | SDF_LSAMPL | SDF_PACKED |
1216 SDF_CMD_READ;
1217 s->n_chan = 32;
1218 s->range_table = &range_digital;
1219 s->maxdata = 1;
1220 s->insn_config = &ni_pcidio_insn_config;
1221 s->insn_bits = &ni_pcidio_insn_bits;
1222 s->do_cmd = &ni_pcidio_cmd;
1223 s->do_cmdtest = &ni_pcidio_cmdtest;
1224 s->cancel = &ni_pcidio_cancel;
1225 s->len_chanlist = 32;
1226 s->buf_change = &ni_pcidio_change;
1227 s->async_dma_dir = DMA_BIDIRECTIONAL;
1228
1229 writel(0, devpriv->mite->daq_io_addr + Port_IO(0));
1230 writel(0, devpriv->mite->daq_io_addr + Port_Pin_Directions(0));
1231 writel(0, devpriv->mite->daq_io_addr + Port_Pin_Mask(0));
1232
1233 /* disable interrupts on board */
1234 writeb(0x00,
1235 devpriv->mite->daq_io_addr +
1236 Master_DMA_And_Interrupt_Control);
1237
1238 ret = request_irq(irq, nidio_interrupt, IRQF_SHARED,
1239 "ni_pcidio", dev);
1240 if (ret < 0)
1241 printk(KERN_WARNING " irq not available");
1242
1243 dev->irq = irq;
1244 }
1245
1246 printk("\n");
1247
1248 return 0;
1249 }
1250
1251 static int nidio_detach(struct comedi_device *dev)
1252 {
1253 int i;
1254
1255 if (this_board && !this_board->is_diodaq) {
1256 for (i = 0; i < this_board->n_8255; i++)
1257 subdev_8255_cleanup(dev, dev->subdevices + i);
1258 }
1259
1260 if (dev->irq)
1261 free_irq(dev->irq, dev);
1262
1263 if (devpriv) {
1264 if (devpriv->di_mite_ring) {
1265 mite_free_ring(devpriv->di_mite_ring);
1266 devpriv->di_mite_ring = NULL;
1267 }
1268 if (devpriv->mite)
1269 mite_unsetup(devpriv->mite);
1270 }
1271 return 0;
1272 }
1273
1274 static int nidio_find_device(struct comedi_device *dev, int bus, int slot)
1275 {
1276 struct mite_struct *mite;
1277 int i;
1278
1279 for (mite = mite_devices; mite; mite = mite->next) {
1280 if (mite->used)
1281 continue;
1282 if (bus || slot) {
1283 if (bus != mite->pcidev->bus->number ||
1284 slot != PCI_SLOT(mite->pcidev->devfn))
1285 continue;
1286 }
1287 for (i = 0; i < n_nidio_boards; i++) {
1288 if (mite_device_id(mite) == nidio_boards[i].dev_id) {
1289 dev->board_ptr = nidio_boards + i;
1290 devpriv->mite = mite;
1291
1292 return 0;
1293 }
1294 }
1295 }
1296 printk(KERN_WARNING "no device found\n");
1297 mite_list_devices();
1298 return -EIO;
1299 }
1300
1301 static int __devinit driver_pcidio_pci_probe(struct pci_dev *dev,
1302 const struct pci_device_id *ent)
1303 {
1304 return comedi_pci_auto_config(dev, driver_pcidio.driver_name);
1305 }
1306
1307 static void __devexit driver_pcidio_pci_remove(struct pci_dev *dev)
1308 {
1309 comedi_pci_auto_unconfig(dev);
1310 }
1311
1312 static struct pci_driver driver_pcidio_pci_driver = {
1313 .id_table = ni_pcidio_pci_table,
1314 .probe = &driver_pcidio_pci_probe,
1315 .remove = __devexit_p(&driver_pcidio_pci_remove)
1316 };
1317
1318 static int __init driver_pcidio_init_module(void)
1319 {
1320 int retval;
1321
1322 retval = comedi_driver_register(&driver_pcidio);
1323 if (retval < 0)
1324 return retval;
1325
1326 driver_pcidio_pci_driver.name = (char *)driver_pcidio.driver_name;
1327 return pci_register_driver(&driver_pcidio_pci_driver);
1328 }
1329
1330 static void __exit driver_pcidio_cleanup_module(void)
1331 {
1332 pci_unregister_driver(&driver_pcidio_pci_driver);
1333 comedi_driver_unregister(&driver_pcidio);
1334 }
1335
1336 module_init(driver_pcidio_init_module);
1337 module_exit(driver_pcidio_cleanup_module);
Tomato firmware and modifications.