2 comedi/drivers/ni_660x.c
3 Hardware driver for NI 660x devices
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU General Public License for more details.
15 You should have received a copy of the GNU General Public License
16 along with this program; if not, write to the Free Software
17 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 Description: National Instruments 660x counter/timer boards
24 [National Instruments] PCI-6601 (ni_660x), PCI-6602, PXI-6602,
26 Author: J.P. Mellor <jpmellor@rose-hulman.edu>,
27 Herman.Bruyninckx@mech.kuleuven.ac.be,
28 Wim.Meeussen@mech.kuleuven.ac.be,
29 Klaas.Gadeyne@mech.kuleuven.ac.be,
30 Frank Mori Hess <fmhess@users.sourceforge.net>
31 Updated: Thu Oct 18 12:56:06 EDT 2007
34 Encoders work. PulseGeneration (both single pulse and pulse train)
35 works. Buffered commands work for input but not output.
38 DAQ 660x Register-Level Programmer Manual (NI 370505A-01)
39 DAQ 6601/6602 User Manual (NI 322137B-01)
43 #include <linux/interrupt.h>
44 #include "../comedidev.h"
48 enum ni_660x_constants {
49 min_counter_pfi_chan = 8,
50 max_dio_pfi_chan = 31,
54 #define NUM_PFI_CHANNELS 40
55 /* really there are only up to 3 dma channels, but the register layout allows
57 #define MAX_DMA_CHANNEL 4
59 /* See Register-Level Programmer Manual page 3.1 */
60 enum NI_660x_Register {
61 G0InterruptAcknowledge,
63 G1InterruptAcknowledge,
76 G01JointStatus1Register,
80 G01JointStatus2Register,
84 G0InputSelectRegister,
85 G1InputSelectRegister,
86 G0AutoincrementRegister,
87 G1AutoincrementRegister,
88 G01JointResetRegister,
91 G0CountingModeRegister,
92 G1CountingModeRegister,
99 G2InterruptAcknowledge,
101 G3InterruptAcknowledge,
111 G23JointStatus1Register,
114 G23JointStatus2Register,
118 G2InputSelectRegister,
119 G3InputSelectRegister,
120 G2AutoincrementRegister,
121 G3AutoincrementRegister,
122 G23JointResetRegister,
125 G2CountingModeRegister,
126 G3CountingModeRegister,
127 G3SecondGateRegister,
128 G2SecondGateRegister,
136 GlobalInterruptStatusRegister,
138 GlobalInterruptConfigRegister,
162 static inline unsigned IOConfigReg(unsigned pfi_channel)
164 unsigned reg = IOConfigReg0_1 + pfi_channel / 2;
165 BUG_ON(reg > IOConfigReg38_39);
169 enum ni_660x_register_width {
175 enum ni_660x_register_direction {
181 enum ni_660x_pfi_output_select {
182 pfi_output_select_high_Z = 0,
183 pfi_output_select_counter = 1,
184 pfi_output_select_do = 2,
185 num_pfi_output_selects
188 enum ni_660x_subdevices {
189 NI_660X_DIO_SUBDEV = 1,
190 NI_660X_GPCT_SUBDEV_0 = 2
192 static inline unsigned NI_660X_GPCT_SUBDEV(unsigned index)
194 return NI_660X_GPCT_SUBDEV_0 + index;
197 struct NI_660xRegisterData {
199 const char *name; /* Register Name */
200 int offset; /* Offset from base address from GPCT chip */
201 enum ni_660x_register_direction direction;
202 enum ni_660x_register_width size; /* 1 byte, 2 bytes, or 4 bytes */
205 static const struct NI_660xRegisterData registerData[NumRegisters] = {
206 {"G0 Interrupt Acknowledge", 0x004, NI_660x_WRITE, DATA_2B},
207 {"G0 Status Register", 0x004, NI_660x_READ, DATA_2B},
208 {"G1 Interrupt Acknowledge", 0x006, NI_660x_WRITE, DATA_2B},
209 {"G1 Status Register", 0x006, NI_660x_READ, DATA_2B},
210 {"G01 Status Register ", 0x008, NI_660x_READ, DATA_2B},
211 {"G0 Command Register", 0x00C, NI_660x_WRITE, DATA_2B},
212 {"STC DIO Parallel Input", 0x00E, NI_660x_READ, DATA_2B},
213 {"G1 Command Register", 0x00E, NI_660x_WRITE, DATA_2B},
214 {"G0 HW Save Register", 0x010, NI_660x_READ, DATA_4B},
215 {"G1 HW Save Register", 0x014, NI_660x_READ, DATA_4B},
216 {"STC DIO Output", 0x014, NI_660x_WRITE, DATA_2B},
217 {"STC DIO Control", 0x016, NI_660x_WRITE, DATA_2B},
218 {"G0 SW Save Register", 0x018, NI_660x_READ, DATA_4B},
219 {"G1 SW Save Register", 0x01C, NI_660x_READ, DATA_4B},
220 {"G0 Mode Register", 0x034, NI_660x_WRITE, DATA_2B},
221 {"G01 Joint Status 1 Register", 0x036, NI_660x_READ, DATA_2B},
222 {"G1 Mode Register", 0x036, NI_660x_WRITE, DATA_2B},
223 {"STC DIO Serial Input", 0x038, NI_660x_READ, DATA_2B},
224 {"G0 Load A Register", 0x038, NI_660x_WRITE, DATA_4B},
225 {"G01 Joint Status 2 Register", 0x03A, NI_660x_READ, DATA_2B},
226 {"G0 Load B Register", 0x03C, NI_660x_WRITE, DATA_4B},
227 {"G1 Load A Register", 0x040, NI_660x_WRITE, DATA_4B},
228 {"G1 Load B Register", 0x044, NI_660x_WRITE, DATA_4B},
229 {"G0 Input Select Register", 0x048, NI_660x_WRITE, DATA_2B},
230 {"G1 Input Select Register", 0x04A, NI_660x_WRITE, DATA_2B},
231 {"G0 Autoincrement Register", 0x088, NI_660x_WRITE, DATA_2B},
232 {"G1 Autoincrement Register", 0x08A, NI_660x_WRITE, DATA_2B},
233 {"G01 Joint Reset Register", 0x090, NI_660x_WRITE, DATA_2B},
234 {"G0 Interrupt Enable", 0x092, NI_660x_WRITE, DATA_2B},
235 {"G1 Interrupt Enable", 0x096, NI_660x_WRITE, DATA_2B},
236 {"G0 Counting Mode Register", 0x0B0, NI_660x_WRITE, DATA_2B},
237 {"G1 Counting Mode Register", 0x0B2, NI_660x_WRITE, DATA_2B},
238 {"G0 Second Gate Register", 0x0B4, NI_660x_WRITE, DATA_2B},
239 {"G1 Second Gate Register", 0x0B6, NI_660x_WRITE, DATA_2B},
240 {"G0 DMA Config Register", 0x0B8, NI_660x_WRITE, DATA_2B},
241 {"G0 DMA Status Register", 0x0B8, NI_660x_READ, DATA_2B},
242 {"G1 DMA Config Register", 0x0BA, NI_660x_WRITE, DATA_2B},
243 {"G1 DMA Status Register", 0x0BA, NI_660x_READ, DATA_2B},
244 {"G2 Interrupt Acknowledge", 0x104, NI_660x_WRITE, DATA_2B},
245 {"G2 Status Register", 0x104, NI_660x_READ, DATA_2B},
246 {"G3 Interrupt Acknowledge", 0x106, NI_660x_WRITE, DATA_2B},
247 {"G3 Status Register", 0x106, NI_660x_READ, DATA_2B},
248 {"G23 Status Register", 0x108, NI_660x_READ, DATA_2B},
249 {"G2 Command Register", 0x10C, NI_660x_WRITE, DATA_2B},
250 {"G3 Command Register", 0x10E, NI_660x_WRITE, DATA_2B},
251 {"G2 HW Save Register", 0x110, NI_660x_READ, DATA_4B},
252 {"G3 HW Save Register", 0x114, NI_660x_READ, DATA_4B},
253 {"G2 SW Save Register", 0x118, NI_660x_READ, DATA_4B},
254 {"G3 SW Save Register", 0x11C, NI_660x_READ, DATA_4B},
255 {"G2 Mode Register", 0x134, NI_660x_WRITE, DATA_2B},
256 {"G23 Joint Status 1 Register", 0x136, NI_660x_READ, DATA_2B},
257 {"G3 Mode Register", 0x136, NI_660x_WRITE, DATA_2B},
258 {"G2 Load A Register", 0x138, NI_660x_WRITE, DATA_4B},
259 {"G23 Joint Status 2 Register", 0x13A, NI_660x_READ, DATA_2B},
260 {"G2 Load B Register", 0x13C, NI_660x_WRITE, DATA_4B},
261 {"G3 Load A Register", 0x140, NI_660x_WRITE, DATA_4B},
262 {"G3 Load B Register", 0x144, NI_660x_WRITE, DATA_4B},
263 {"G2 Input Select Register", 0x148, NI_660x_WRITE, DATA_2B},
264 {"G3 Input Select Register", 0x14A, NI_660x_WRITE, DATA_2B},
265 {"G2 Autoincrement Register", 0x188, NI_660x_WRITE, DATA_2B},
266 {"G3 Autoincrement Register", 0x18A, NI_660x_WRITE, DATA_2B},
267 {"G23 Joint Reset Register", 0x190, NI_660x_WRITE, DATA_2B},
268 {"G2 Interrupt Enable", 0x192, NI_660x_WRITE, DATA_2B},
269 {"G3 Interrupt Enable", 0x196, NI_660x_WRITE, DATA_2B},
270 {"G2 Counting Mode Register", 0x1B0, NI_660x_WRITE, DATA_2B},
271 {"G3 Counting Mode Register", 0x1B2, NI_660x_WRITE, DATA_2B},
272 {"G3 Second Gate Register", 0x1B6, NI_660x_WRITE, DATA_2B},
273 {"G2 Second Gate Register", 0x1B4, NI_660x_WRITE, DATA_2B},
274 {"G2 DMA Config Register", 0x1B8, NI_660x_WRITE, DATA_2B},
275 {"G2 DMA Status Register", 0x1B8, NI_660x_READ, DATA_2B},
276 {"G3 DMA Config Register", 0x1BA, NI_660x_WRITE, DATA_2B},
277 {"G3 DMA Status Register", 0x1BA, NI_660x_READ, DATA_2B},
278 {"32 bit Digital Input", 0x414, NI_660x_READ, DATA_4B},
279 {"32 bit Digital Output", 0x510, NI_660x_WRITE, DATA_4B},
280 {"Clock Config Register", 0x73C, NI_660x_WRITE, DATA_4B},
281 {"Global Interrupt Status Register", 0x754, NI_660x_READ, DATA_4B},
282 {"DMA Configuration Register", 0x76C, NI_660x_WRITE, DATA_4B},
283 {"Global Interrupt Config Register", 0x770, NI_660x_WRITE, DATA_4B},
284 {"IO Config Register 0-1", 0x77C, NI_660x_READ_WRITE, DATA_2B},
285 {"IO Config Register 2-3", 0x77E, NI_660x_READ_WRITE, DATA_2B},
286 {"IO Config Register 4-5", 0x780, NI_660x_READ_WRITE, DATA_2B},
287 {"IO Config Register 6-7", 0x782, NI_660x_READ_WRITE, DATA_2B},
288 {"IO Config Register 8-9", 0x784, NI_660x_READ_WRITE, DATA_2B},
289 {"IO Config Register 10-11", 0x786, NI_660x_READ_WRITE, DATA_2B},
290 {"IO Config Register 12-13", 0x788, NI_660x_READ_WRITE, DATA_2B},
291 {"IO Config Register 14-15", 0x78A, NI_660x_READ_WRITE, DATA_2B},
292 {"IO Config Register 16-17", 0x78C, NI_660x_READ_WRITE, DATA_2B},
293 {"IO Config Register 18-19", 0x78E, NI_660x_READ_WRITE, DATA_2B},
294 {"IO Config Register 20-21", 0x790, NI_660x_READ_WRITE, DATA_2B},
295 {"IO Config Register 22-23", 0x792, NI_660x_READ_WRITE, DATA_2B},
296 {"IO Config Register 24-25", 0x794, NI_660x_READ_WRITE, DATA_2B},
297 {"IO Config Register 26-27", 0x796, NI_660x_READ_WRITE, DATA_2B},
298 {"IO Config Register 28-29", 0x798, NI_660x_READ_WRITE, DATA_2B},
299 {"IO Config Register 30-31", 0x79A, NI_660x_READ_WRITE, DATA_2B},
300 {"IO Config Register 32-33", 0x79C, NI_660x_READ_WRITE, DATA_2B},
301 {"IO Config Register 34-35", 0x79E, NI_660x_READ_WRITE, DATA_2B},
302 {"IO Config Register 36-37", 0x7A0, NI_660x_READ_WRITE, DATA_2B},
303 {"IO Config Register 38-39", 0x7A2, NI_660x_READ_WRITE, DATA_2B}
306 /* kind of ENABLE for the second counter */
307 enum clock_config_register_bits {
308 CounterSwap = 0x1 << 21
312 static inline unsigned ioconfig_bitshift(unsigned pfi_channel)
320 static inline unsigned pfi_output_select_mask(unsigned pfi_channel)
322 return 0x3 << ioconfig_bitshift(pfi_channel);
325 static inline unsigned pfi_output_select_bits(unsigned pfi_channel,
326 unsigned output_select)
328 return (output_select & 0x3) << ioconfig_bitshift(pfi_channel);
331 static inline unsigned pfi_input_select_mask(unsigned pfi_channel)
333 return 0x7 << (4 + ioconfig_bitshift(pfi_channel));
336 static inline unsigned pfi_input_select_bits(unsigned pfi_channel,
337 unsigned input_select)
339 return (input_select & 0x7) << (4 + ioconfig_bitshift(pfi_channel));
342 /* dma configuration register bits */
343 static inline unsigned dma_select_mask(unsigned dma_channel)
345 BUG_ON(dma_channel >= MAX_DMA_CHANNEL);
346 return 0x1f << (8 * dma_channel);
350 dma_selection_none = 0x1f,
352 static inline unsigned dma_selection_counter(unsigned counter_index)
354 BUG_ON(counter_index >= counters_per_chip);
355 return counter_index;
358 static inline unsigned dma_select_bits(unsigned dma_channel, unsigned selection)
360 BUG_ON(dma_channel >= MAX_DMA_CHANNEL);
361 return (selection << (8 * dma_channel)) & dma_select_mask(dma_channel);
364 static inline unsigned dma_reset_bit(unsigned dma_channel)
366 BUG_ON(dma_channel >= MAX_DMA_CHANNEL);
367 return 0x80 << (8 * dma_channel);
370 enum global_interrupt_status_register_bits {
371 Counter_0_Int_Bit = 0x100,
372 Counter_1_Int_Bit = 0x200,
373 Counter_2_Int_Bit = 0x400,
374 Counter_3_Int_Bit = 0x800,
375 Cascade_Int_Bit = 0x20000000,
376 Global_Int_Bit = 0x80000000
379 enum global_interrupt_config_register_bits {
380 Cascade_Int_Enable_Bit = 0x20000000,
381 Global_Int_Polarity_Bit = 0x40000000,
382 Global_Int_Enable_Bit = 0x80000000
385 /* Offset of the GPCT chips from the base-adress of the card */
386 /* First chip is at base-address + 0x00, etc. */
387 static const unsigned GPCT_OFFSET[2] = { 0x0, 0x800 };
389 /* Board description*/
390 struct ni_660x_board {
391 unsigned short dev_id; /* `lspci` will show you this */
393 unsigned n_chips; /* total number of TIO chips */
396 static const struct ni_660x_board ni_660x_boards[] = {
419 #define NI_660X_MAX_NUM_CHIPS 2
420 #define NI_660X_MAX_NUM_COUNTERS (NI_660X_MAX_NUM_CHIPS * counters_per_chip)
422 static DEFINE_PCI_DEVICE_TABLE(ni_660x_pci_table) = {
423 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x2c60)},
424 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1310)},
425 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1360)},
426 {PCI_DEVICE(PCI_VENDOR_ID_NI, 0x2cc0)},
430 MODULE_DEVICE_TABLE(pci, ni_660x_pci_table);
432 struct ni_660x_private {
433 struct mite_struct *mite;
434 struct ni_gpct_device *counter_dev;
435 uint64_t pfi_direction_bits;
436 struct mite_dma_descriptor_ring
437 *mite_rings[NI_660X_MAX_NUM_CHIPS][counters_per_chip];
438 spinlock_t mite_channel_lock;
439 /* interrupt_lock prevents races between interrupt and comedi_poll */
440 spinlock_t interrupt_lock;
441 unsigned dma_configuration_soft_copies[NI_660X_MAX_NUM_CHIPS];
442 spinlock_t soft_reg_copy_lock;
443 unsigned short pfi_output_selects[NUM_PFI_CHANNELS];
446 static inline struct ni_660x_private *private(struct comedi_device *dev)
451 /* initialized in ni_660x_find_device() */
452 static inline const struct ni_660x_board *board(struct comedi_device *dev)
454 return dev->board_ptr;
457 #define n_ni_660x_boards ARRAY_SIZE(ni_660x_boards)
459 static int ni_660x_attach(struct comedi_device *dev,
460 struct comedi_devconfig *it);
461 static int ni_660x_detach(struct comedi_device *dev);
462 static void init_tio_chip(struct comedi_device *dev, int chipset);
463 static void ni_660x_select_pfi_output(struct comedi_device *dev,
464 unsigned pfi_channel,
465 unsigned output_select);
467 static struct comedi_driver driver_ni_660x = {
468 .driver_name = "ni_660x",
469 .module = THIS_MODULE,
470 .attach = ni_660x_attach,
471 .detach = ni_660x_detach,
474 COMEDI_PCI_INITCLEANUP(driver_ni_660x, ni_660x_pci_table);
476 static int ni_660x_find_device(struct comedi_device *dev, int bus, int slot);
477 static int ni_660x_set_pfi_routing(struct comedi_device *dev, unsigned chan,
480 /* Possible instructions for a GPCT */
481 static int ni_660x_GPCT_rinsn(struct comedi_device *dev,
482 struct comedi_subdevice *s,
483 struct comedi_insn *insn, unsigned int *data);
484 static int ni_660x_GPCT_insn_config(struct comedi_device *dev,
485 struct comedi_subdevice *s,
486 struct comedi_insn *insn,
488 static int ni_660x_GPCT_winsn(struct comedi_device *dev,
489 struct comedi_subdevice *s,
490 struct comedi_insn *insn, unsigned int *data);
492 /* Possible instructions for Digital IO */
493 static int ni_660x_dio_insn_config(struct comedi_device *dev,
494 struct comedi_subdevice *s,
495 struct comedi_insn *insn,
497 static int ni_660x_dio_insn_bits(struct comedi_device *dev,
498 struct comedi_subdevice *s,
499 struct comedi_insn *insn, unsigned int *data);
501 static inline unsigned ni_660x_num_counters(struct comedi_device *dev)
503 return board(dev)->n_chips * counters_per_chip;
506 static enum NI_660x_Register ni_gpct_to_660x_register(enum ni_gpct_register reg)
508 enum NI_660x_Register ni_660x_register;
510 case NITIO_G0_Autoincrement_Reg:
511 ni_660x_register = G0AutoincrementRegister;
513 case NITIO_G1_Autoincrement_Reg:
514 ni_660x_register = G1AutoincrementRegister;
516 case NITIO_G2_Autoincrement_Reg:
517 ni_660x_register = G2AutoincrementRegister;
519 case NITIO_G3_Autoincrement_Reg:
520 ni_660x_register = G3AutoincrementRegister;
522 case NITIO_G0_Command_Reg:
523 ni_660x_register = G0CommandRegister;
525 case NITIO_G1_Command_Reg:
526 ni_660x_register = G1CommandRegister;
528 case NITIO_G2_Command_Reg:
529 ni_660x_register = G2CommandRegister;
531 case NITIO_G3_Command_Reg:
532 ni_660x_register = G3CommandRegister;
534 case NITIO_G0_HW_Save_Reg:
535 ni_660x_register = G0HWSaveRegister;
537 case NITIO_G1_HW_Save_Reg:
538 ni_660x_register = G1HWSaveRegister;
540 case NITIO_G2_HW_Save_Reg:
541 ni_660x_register = G2HWSaveRegister;
543 case NITIO_G3_HW_Save_Reg:
544 ni_660x_register = G3HWSaveRegister;
546 case NITIO_G0_SW_Save_Reg:
547 ni_660x_register = G0SWSaveRegister;
549 case NITIO_G1_SW_Save_Reg:
550 ni_660x_register = G1SWSaveRegister;
552 case NITIO_G2_SW_Save_Reg:
553 ni_660x_register = G2SWSaveRegister;
555 case NITIO_G3_SW_Save_Reg:
556 ni_660x_register = G3SWSaveRegister;
558 case NITIO_G0_Mode_Reg:
559 ni_660x_register = G0ModeRegister;
561 case NITIO_G1_Mode_Reg:
562 ni_660x_register = G1ModeRegister;
564 case NITIO_G2_Mode_Reg:
565 ni_660x_register = G2ModeRegister;
567 case NITIO_G3_Mode_Reg:
568 ni_660x_register = G3ModeRegister;
570 case NITIO_G0_LoadA_Reg:
571 ni_660x_register = G0LoadARegister;
573 case NITIO_G1_LoadA_Reg:
574 ni_660x_register = G1LoadARegister;
576 case NITIO_G2_LoadA_Reg:
577 ni_660x_register = G2LoadARegister;
579 case NITIO_G3_LoadA_Reg:
580 ni_660x_register = G3LoadARegister;
582 case NITIO_G0_LoadB_Reg:
583 ni_660x_register = G0LoadBRegister;
585 case NITIO_G1_LoadB_Reg:
586 ni_660x_register = G1LoadBRegister;
588 case NITIO_G2_LoadB_Reg:
589 ni_660x_register = G2LoadBRegister;
591 case NITIO_G3_LoadB_Reg:
592 ni_660x_register = G3LoadBRegister;
594 case NITIO_G0_Input_Select_Reg:
595 ni_660x_register = G0InputSelectRegister;
597 case NITIO_G1_Input_Select_Reg:
598 ni_660x_register = G1InputSelectRegister;
600 case NITIO_G2_Input_Select_Reg:
601 ni_660x_register = G2InputSelectRegister;
603 case NITIO_G3_Input_Select_Reg:
604 ni_660x_register = G3InputSelectRegister;
606 case NITIO_G01_Status_Reg:
607 ni_660x_register = G01StatusRegister;
609 case NITIO_G23_Status_Reg:
610 ni_660x_register = G23StatusRegister;
612 case NITIO_G01_Joint_Reset_Reg:
613 ni_660x_register = G01JointResetRegister;
615 case NITIO_G23_Joint_Reset_Reg:
616 ni_660x_register = G23JointResetRegister;
618 case NITIO_G01_Joint_Status1_Reg:
619 ni_660x_register = G01JointStatus1Register;
621 case NITIO_G23_Joint_Status1_Reg:
622 ni_660x_register = G23JointStatus1Register;
624 case NITIO_G01_Joint_Status2_Reg:
625 ni_660x_register = G01JointStatus2Register;
627 case NITIO_G23_Joint_Status2_Reg:
628 ni_660x_register = G23JointStatus2Register;
630 case NITIO_G0_Counting_Mode_Reg:
631 ni_660x_register = G0CountingModeRegister;
633 case NITIO_G1_Counting_Mode_Reg:
634 ni_660x_register = G1CountingModeRegister;
636 case NITIO_G2_Counting_Mode_Reg:
637 ni_660x_register = G2CountingModeRegister;
639 case NITIO_G3_Counting_Mode_Reg:
640 ni_660x_register = G3CountingModeRegister;
642 case NITIO_G0_Second_Gate_Reg:
643 ni_660x_register = G0SecondGateRegister;
645 case NITIO_G1_Second_Gate_Reg:
646 ni_660x_register = G1SecondGateRegister;
648 case NITIO_G2_Second_Gate_Reg:
649 ni_660x_register = G2SecondGateRegister;
651 case NITIO_G3_Second_Gate_Reg:
652 ni_660x_register = G3SecondGateRegister;
654 case NITIO_G0_DMA_Config_Reg:
655 ni_660x_register = G0DMAConfigRegister;
657 case NITIO_G0_DMA_Status_Reg:
658 ni_660x_register = G0DMAStatusRegister;
660 case NITIO_G1_DMA_Config_Reg:
661 ni_660x_register = G1DMAConfigRegister;
663 case NITIO_G1_DMA_Status_Reg:
664 ni_660x_register = G1DMAStatusRegister;
666 case NITIO_G2_DMA_Config_Reg:
667 ni_660x_register = G2DMAConfigRegister;
669 case NITIO_G2_DMA_Status_Reg:
670 ni_660x_register = G2DMAStatusRegister;
672 case NITIO_G3_DMA_Config_Reg:
673 ni_660x_register = G3DMAConfigRegister;
675 case NITIO_G3_DMA_Status_Reg:
676 ni_660x_register = G3DMAStatusRegister;
678 case NITIO_G0_Interrupt_Acknowledge_Reg:
679 ni_660x_register = G0InterruptAcknowledge;
681 case NITIO_G1_Interrupt_Acknowledge_Reg:
682 ni_660x_register = G1InterruptAcknowledge;
684 case NITIO_G2_Interrupt_Acknowledge_Reg:
685 ni_660x_register = G2InterruptAcknowledge;
687 case NITIO_G3_Interrupt_Acknowledge_Reg:
688 ni_660x_register = G3InterruptAcknowledge;
690 case NITIO_G0_Status_Reg:
691 ni_660x_register = G0StatusRegister;
693 case NITIO_G1_Status_Reg:
694 ni_660x_register = G1StatusRegister;
696 case NITIO_G2_Status_Reg:
697 ni_660x_register = G2StatusRegister;
699 case NITIO_G3_Status_Reg:
700 ni_660x_register = G3StatusRegister;
702 case NITIO_G0_Interrupt_Enable_Reg:
703 ni_660x_register = G0InterruptEnable;
705 case NITIO_G1_Interrupt_Enable_Reg:
706 ni_660x_register = G1InterruptEnable;
708 case NITIO_G2_Interrupt_Enable_Reg:
709 ni_660x_register = G2InterruptEnable;
711 case NITIO_G3_Interrupt_Enable_Reg:
712 ni_660x_register = G3InterruptEnable;
715 printk(KERN_WARNING "%s: unhandled register 0x%x in switch.\n",
721 return ni_660x_register;
724 static inline void ni_660x_write_register(struct comedi_device *dev,
725 unsigned chip_index, unsigned bits,
726 enum NI_660x_Register reg)
728 void *const write_address =
729 private(dev)->mite->daq_io_addr + GPCT_OFFSET[chip_index] +
730 registerData[reg].offset;
732 switch (registerData[reg].size) {
734 writew(bits, write_address);
737 writel(bits, write_address);
740 printk(KERN_WARNING "%s: %s: bug! unhandled case (reg=0x%x) in switch.\n",
741 __FILE__, __func__, reg);
747 static inline unsigned ni_660x_read_register(struct comedi_device *dev,
749 enum NI_660x_Register reg)
751 void *const read_address =
752 private(dev)->mite->daq_io_addr + GPCT_OFFSET[chip_index] +
753 registerData[reg].offset;
755 switch (registerData[reg].size) {
757 return readw(read_address);
760 return readl(read_address);
763 printk(KERN_WARNING "%s: %s: bug! unhandled case (reg=0x%x) in switch.\n",
764 __FILE__, __func__, reg);
771 static void ni_gpct_write_register(struct ni_gpct *counter, unsigned bits,
772 enum ni_gpct_register reg)
774 struct comedi_device *dev = counter->counter_dev->dev;
775 enum NI_660x_Register ni_660x_register = ni_gpct_to_660x_register(reg);
776 ni_660x_write_register(dev, counter->chip_index, bits,
780 static unsigned ni_gpct_read_register(struct ni_gpct *counter,
781 enum ni_gpct_register reg)
783 struct comedi_device *dev = counter->counter_dev->dev;
784 enum NI_660x_Register ni_660x_register = ni_gpct_to_660x_register(reg);
785 return ni_660x_read_register(dev, counter->chip_index,
789 static inline struct mite_dma_descriptor_ring *mite_ring(struct ni_660x_private
794 return priv->mite_rings[counter->chip_index][counter->counter_index];
797 static inline void ni_660x_set_dma_channel(struct comedi_device *dev,
798 unsigned mite_channel,
799 struct ni_gpct *counter)
802 spin_lock_irqsave(&private(dev)->soft_reg_copy_lock, flags);
803 private(dev)->dma_configuration_soft_copies[counter->chip_index] &=
804 ~dma_select_mask(mite_channel);
805 private(dev)->dma_configuration_soft_copies[counter->chip_index] |=
806 dma_select_bits(mite_channel,
807 dma_selection_counter(counter->counter_index));
808 ni_660x_write_register(dev, counter->chip_index,
810 dma_configuration_soft_copies
811 [counter->chip_index] |
812 dma_reset_bit(mite_channel), DMAConfigRegister);
814 spin_unlock_irqrestore(&private(dev)->soft_reg_copy_lock, flags);
817 static inline void ni_660x_unset_dma_channel(struct comedi_device *dev,
818 unsigned mite_channel,
819 struct ni_gpct *counter)
822 spin_lock_irqsave(&private(dev)->soft_reg_copy_lock, flags);
823 private(dev)->dma_configuration_soft_copies[counter->chip_index] &=
824 ~dma_select_mask(mite_channel);
825 private(dev)->dma_configuration_soft_copies[counter->chip_index] |=
826 dma_select_bits(mite_channel, dma_selection_none);
827 ni_660x_write_register(dev, counter->chip_index,
829 dma_configuration_soft_copies
830 [counter->chip_index], DMAConfigRegister);
832 spin_unlock_irqrestore(&private(dev)->soft_reg_copy_lock, flags);
835 static int ni_660x_request_mite_channel(struct comedi_device *dev,
836 struct ni_gpct *counter,
837 enum comedi_io_direction direction)
840 struct mite_channel *mite_chan;
842 spin_lock_irqsave(&private(dev)->mite_channel_lock, flags);
843 BUG_ON(counter->mite_chan);
845 mite_request_channel(private(dev)->mite, mite_ring(private(dev),
847 if (mite_chan == NULL) {
848 spin_unlock_irqrestore(&private(dev)->mite_channel_lock, flags);
850 "failed to reserve mite dma channel for counter.");
853 mite_chan->dir = direction;
854 ni_tio_set_mite_channel(counter, mite_chan);
855 ni_660x_set_dma_channel(dev, mite_chan->channel, counter);
856 spin_unlock_irqrestore(&private(dev)->mite_channel_lock, flags);
860 void ni_660x_release_mite_channel(struct comedi_device *dev,
861 struct ni_gpct *counter)
865 spin_lock_irqsave(&private(dev)->mite_channel_lock, flags);
866 if (counter->mite_chan) {
867 struct mite_channel *mite_chan = counter->mite_chan;
869 ni_660x_unset_dma_channel(dev, mite_chan->channel, counter);
870 ni_tio_set_mite_channel(counter, NULL);
871 mite_release_channel(mite_chan);
873 spin_unlock_irqrestore(&private(dev)->mite_channel_lock, flags);
876 static int ni_660x_cmd(struct comedi_device *dev, struct comedi_subdevice *s)
880 struct ni_gpct *counter = subdev_to_counter(s);
881 /* const struct comedi_cmd *cmd = &s->async->cmd; */
883 retval = ni_660x_request_mite_channel(dev, counter, COMEDI_INPUT);
886 "no dma channel available for use by counter");
889 ni_tio_acknowledge_and_confirm(counter, NULL, NULL, NULL, NULL);
890 retval = ni_tio_cmd(counter, s->async);
895 static int ni_660x_cmdtest(struct comedi_device *dev,
896 struct comedi_subdevice *s, struct comedi_cmd *cmd)
898 struct ni_gpct *counter = subdev_to_counter(s);
900 return ni_tio_cmdtest(counter, cmd);
903 static int ni_660x_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
905 struct ni_gpct *counter = subdev_to_counter(s);
908 retval = ni_tio_cancel(counter);
909 ni_660x_release_mite_channel(dev, counter);
913 static void set_tio_counterswap(struct comedi_device *dev, int chipset)
915 /* See P. 3.5 of the Register-Level Programming manual. The
916 CounterSwap bit has to be set on the second chip, otherwise
917 it will try to use the same pins as the first chip.
920 ni_660x_write_register(dev, chipset, CounterSwap,
921 ClockConfigRegister);
923 ni_660x_write_register(dev, chipset, 0, ClockConfigRegister);
926 static void ni_660x_handle_gpct_interrupt(struct comedi_device *dev,
927 struct comedi_subdevice *s)
929 ni_tio_handle_interrupt(subdev_to_counter(s), s);
930 if (s->async->events) {
931 if (s->async->events & (COMEDI_CB_EOA | COMEDI_CB_ERROR |
932 COMEDI_CB_OVERFLOW)) {
933 ni_660x_cancel(dev, s);
935 comedi_event(dev, s);
939 static irqreturn_t ni_660x_interrupt(int irq, void *d)
941 struct comedi_device *dev = d;
942 struct comedi_subdevice *s;
946 if (dev->attached == 0)
948 /* lock to avoid race with comedi_poll */
949 spin_lock_irqsave(&private(dev)->interrupt_lock, flags);
951 for (i = 0; i < ni_660x_num_counters(dev); ++i) {
952 s = dev->subdevices + NI_660X_GPCT_SUBDEV(i);
953 ni_660x_handle_gpct_interrupt(dev, s);
955 spin_unlock_irqrestore(&private(dev)->interrupt_lock, flags);
959 static int ni_660x_input_poll(struct comedi_device *dev,
960 struct comedi_subdevice *s)
963 /* lock to avoid race with comedi_poll */
964 spin_lock_irqsave(&private(dev)->interrupt_lock, flags);
965 mite_sync_input_dma(subdev_to_counter(s)->mite_chan, s->async);
966 spin_unlock_irqrestore(&private(dev)->interrupt_lock, flags);
967 return comedi_buf_read_n_available(s->async);
970 static int ni_660x_buf_change(struct comedi_device *dev,
971 struct comedi_subdevice *s,
972 unsigned long new_size)
976 ret = mite_buf_change(mite_ring(private(dev), subdev_to_counter(s)),
984 static int ni_660x_allocate_private(struct comedi_device *dev)
989 retval = alloc_private(dev, sizeof(struct ni_660x_private));
993 spin_lock_init(&private(dev)->mite_channel_lock);
994 spin_lock_init(&private(dev)->interrupt_lock);
995 spin_lock_init(&private(dev)->soft_reg_copy_lock);
996 for (i = 0; i < NUM_PFI_CHANNELS; ++i)
997 private(dev)->pfi_output_selects[i] = pfi_output_select_counter;
1002 static int ni_660x_alloc_mite_rings(struct comedi_device *dev)
1007 for (i = 0; i < board(dev)->n_chips; ++i) {
1008 for (j = 0; j < counters_per_chip; ++j) {
1009 private(dev)->mite_rings[i][j] =
1010 mite_alloc_ring(private(dev)->mite);
1011 if (private(dev)->mite_rings[i][j] == NULL)
1018 static void ni_660x_free_mite_rings(struct comedi_device *dev)
1023 for (i = 0; i < board(dev)->n_chips; ++i) {
1024 for (j = 0; j < counters_per_chip; ++j)
1025 mite_free_ring(private(dev)->mite_rings[i][j]);
1029 static int ni_660x_attach(struct comedi_device *dev,
1030 struct comedi_devconfig *it)
1032 struct comedi_subdevice *s;
1035 unsigned global_interrupt_config_bits;
1037 printk(KERN_INFO "comedi%d: ni_660x: ", dev->minor);
1039 ret = ni_660x_allocate_private(dev);
1042 ret = ni_660x_find_device(dev, it->options[0], it->options[1]);
1046 dev->board_name = board(dev)->name;
1048 ret = mite_setup2(private(dev)->mite, 1);
1050 printk(KERN_WARNING "error setting up mite\n");
1053 comedi_set_hw_dev(dev, &private(dev)->mite->pcidev->dev);
1054 ret = ni_660x_alloc_mite_rings(dev);
1058 printk(KERN_INFO " %s ", dev->board_name);
1060 dev->n_subdevices = 2 + NI_660X_MAX_NUM_COUNTERS;
1062 if (alloc_subdevices(dev, dev->n_subdevices) < 0)
1065 s = dev->subdevices + 0;
1066 /* Old GENERAL-PURPOSE COUNTER/TIME (GPCT) subdevice, no longer used */
1067 s->type = COMEDI_SUBD_UNUSED;
1069 s = dev->subdevices + NI_660X_DIO_SUBDEV;
1070 /* DIGITAL I/O SUBDEVICE */
1071 s->type = COMEDI_SUBD_DIO;
1072 s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
1073 s->n_chan = NUM_PFI_CHANNELS;
1075 s->range_table = &range_digital;
1076 s->insn_bits = ni_660x_dio_insn_bits;
1077 s->insn_config = ni_660x_dio_insn_config;
1078 s->io_bits = 0; /* all bits default to input */
1079 /* we use the ioconfig registers to control dio direction, so zero
1080 output enables in stc dio control reg */
1081 ni_660x_write_register(dev, 0, 0, STCDIOControl);
1083 private(dev)->counter_dev = ni_gpct_device_construct(dev,
1084 &ni_gpct_write_register,
1085 &ni_gpct_read_register,
1086 ni_gpct_variant_660x,
1087 ni_660x_num_counters
1089 if (private(dev)->counter_dev == NULL)
1091 for (i = 0; i < NI_660X_MAX_NUM_COUNTERS; ++i) {
1092 s = dev->subdevices + NI_660X_GPCT_SUBDEV(i);
1093 if (i < ni_660x_num_counters(dev)) {
1094 s->type = COMEDI_SUBD_COUNTER;
1096 SDF_READABLE | SDF_WRITABLE | SDF_LSAMPL |
1097 SDF_CMD_READ /* | SDF_CMD_WRITE */ ;
1099 s->maxdata = 0xffffffff;
1100 s->insn_read = ni_660x_GPCT_rinsn;
1101 s->insn_write = ni_660x_GPCT_winsn;
1102 s->insn_config = ni_660x_GPCT_insn_config;
1103 s->do_cmd = &ni_660x_cmd;
1104 s->len_chanlist = 1;
1105 s->do_cmdtest = &ni_660x_cmdtest;
1106 s->cancel = &ni_660x_cancel;
1107 s->poll = &ni_660x_input_poll;
1108 s->async_dma_dir = DMA_BIDIRECTIONAL;
1109 s->buf_change = &ni_660x_buf_change;
1110 s->private = &private(dev)->counter_dev->counters[i];
1112 private(dev)->counter_dev->counters[i].chip_index =
1113 i / counters_per_chip;
1114 private(dev)->counter_dev->counters[i].counter_index =
1115 i % counters_per_chip;
1117 s->type = COMEDI_SUBD_UNUSED;
1120 for (i = 0; i < board(dev)->n_chips; ++i)
1121 init_tio_chip(dev, i);
1123 for (i = 0; i < ni_660x_num_counters(dev); ++i)
1124 ni_tio_init_counter(&private(dev)->counter_dev->counters[i]);
1126 for (i = 0; i < NUM_PFI_CHANNELS; ++i) {
1127 if (i < min_counter_pfi_chan)
1128 ni_660x_set_pfi_routing(dev, i, pfi_output_select_do);
1130 ni_660x_set_pfi_routing(dev, i,
1131 pfi_output_select_counter);
1132 ni_660x_select_pfi_output(dev, i, pfi_output_select_high_Z);
1134 /* to be safe, set counterswap bits on tio chips after all the counter
1135 outputs have been set to high impedance mode */
1136 for (i = 0; i < board(dev)->n_chips; ++i)
1137 set_tio_counterswap(dev, i);
1139 ret = request_irq(mite_irq(private(dev)->mite), ni_660x_interrupt,
1140 IRQF_SHARED, "ni_660x", dev);
1142 printk(KERN_WARNING " irq not available\n");
1145 dev->irq = mite_irq(private(dev)->mite);
1146 global_interrupt_config_bits = Global_Int_Enable_Bit;
1147 if (board(dev)->n_chips > 1)
1148 global_interrupt_config_bits |= Cascade_Int_Enable_Bit;
1149 ni_660x_write_register(dev, 0, global_interrupt_config_bits,
1150 GlobalInterruptConfigRegister);
1151 printk(KERN_INFO "attached\n");
1155 static int ni_660x_detach(struct comedi_device *dev)
1157 printk(KERN_INFO "comedi%d: ni_660x: remove\n", dev->minor);
1161 free_irq(dev->irq, dev);
1164 if (private(dev)->counter_dev)
1165 ni_gpct_device_destroy(private(dev)->counter_dev);
1166 if (private(dev)->mite) {
1167 ni_660x_free_mite_rings(dev);
1168 mite_unsetup(private(dev)->mite);
1175 ni_660x_GPCT_rinsn(struct comedi_device *dev, struct comedi_subdevice *s,
1176 struct comedi_insn *insn, unsigned int *data)
1178 return ni_tio_rinsn(subdev_to_counter(s), insn, data);
1181 static void init_tio_chip(struct comedi_device *dev, int chipset)
1185 /* init dma configuration register */
1186 private(dev)->dma_configuration_soft_copies[chipset] = 0;
1187 for (i = 0; i < MAX_DMA_CHANNEL; ++i) {
1188 private(dev)->dma_configuration_soft_copies[chipset] |=
1189 dma_select_bits(i, dma_selection_none) & dma_select_mask(i);
1191 ni_660x_write_register(dev, chipset,
1193 dma_configuration_soft_copies[chipset],
1195 for (i = 0; i < NUM_PFI_CHANNELS; ++i)
1196 ni_660x_write_register(dev, chipset, 0, IOConfigReg(i));
1200 ni_660x_GPCT_insn_config(struct comedi_device *dev, struct comedi_subdevice *s,
1201 struct comedi_insn *insn, unsigned int *data)
1203 return ni_tio_insn_config(subdev_to_counter(s), insn, data);
1206 static int ni_660x_GPCT_winsn(struct comedi_device *dev,
1207 struct comedi_subdevice *s,
1208 struct comedi_insn *insn, unsigned int *data)
1210 return ni_tio_winsn(subdev_to_counter(s), insn, data);
1213 static int ni_660x_find_device(struct comedi_device *dev, int bus, int slot)
1215 struct mite_struct *mite;
1218 for (mite = mite_devices; mite; mite = mite->next) {
1222 if (bus != mite->pcidev->bus->number ||
1223 slot != PCI_SLOT(mite->pcidev->devfn))
1227 for (i = 0; i < n_ni_660x_boards; i++) {
1228 if (mite_device_id(mite) == ni_660x_boards[i].dev_id) {
1229 dev->board_ptr = ni_660x_boards + i;
1230 private(dev)->mite = mite;
1235 printk(KERN_WARNING "no device found\n");
1236 mite_list_devices();
1240 static int ni_660x_dio_insn_bits(struct comedi_device *dev,
1241 struct comedi_subdevice *s,
1242 struct comedi_insn *insn, unsigned int *data)
1244 unsigned base_bitfield_channel = CR_CHAN(insn->chanspec);
1246 /* Check if we have to write some bits */
1248 s->state &= ~(data[0] << base_bitfield_channel);
1249 s->state |= (data[0] & data[1]) << base_bitfield_channel;
1250 /* Write out the new digital output lines */
1251 ni_660x_write_register(dev, 0, s->state, DIO32Output);
1253 /* on return, data[1] contains the value of the digital
1254 * input and output lines. */
1256 (ni_660x_read_register(dev, 0,
1257 DIO32Input) >> base_bitfield_channel);
1261 static void ni_660x_select_pfi_output(struct comedi_device *dev,
1262 unsigned pfi_channel,
1263 unsigned output_select)
1265 static const unsigned counter_4_7_first_pfi = 8;
1266 static const unsigned counter_4_7_last_pfi = 23;
1267 unsigned active_chipset = 0;
1268 unsigned idle_chipset = 0;
1269 unsigned active_bits;
1272 if (board(dev)->n_chips > 1) {
1273 if (output_select == pfi_output_select_counter &&
1274 pfi_channel >= counter_4_7_first_pfi &&
1275 pfi_channel <= counter_4_7_last_pfi) {
1284 if (idle_chipset != active_chipset) {
1286 ni_660x_read_register(dev, idle_chipset,
1287 IOConfigReg(pfi_channel));
1288 idle_bits &= ~pfi_output_select_mask(pfi_channel);
1290 pfi_output_select_bits(pfi_channel,
1291 pfi_output_select_high_Z);
1292 ni_660x_write_register(dev, idle_chipset, idle_bits,
1293 IOConfigReg(pfi_channel));
1297 ni_660x_read_register(dev, active_chipset,
1298 IOConfigReg(pfi_channel));
1299 active_bits &= ~pfi_output_select_mask(pfi_channel);
1300 active_bits |= pfi_output_select_bits(pfi_channel, output_select);
1301 ni_660x_write_register(dev, active_chipset, active_bits,
1302 IOConfigReg(pfi_channel));
1305 static int ni_660x_set_pfi_routing(struct comedi_device *dev, unsigned chan,
1308 if (source > num_pfi_output_selects)
1310 if (source == pfi_output_select_high_Z)
1312 if (chan < min_counter_pfi_chan) {
1313 if (source == pfi_output_select_counter)
1315 } else if (chan > max_dio_pfi_chan) {
1316 if (source == pfi_output_select_do)
1319 BUG_ON(chan >= NUM_PFI_CHANNELS);
1321 private(dev)->pfi_output_selects[chan] = source;
1322 if (private(dev)->pfi_direction_bits & (((uint64_t) 1) << chan))
1323 ni_660x_select_pfi_output(dev, chan,
1325 pfi_output_selects[chan]);
1329 static unsigned ni_660x_get_pfi_routing(struct comedi_device *dev,
1332 BUG_ON(chan >= NUM_PFI_CHANNELS);
1333 return private(dev)->pfi_output_selects[chan];
1336 static void ni660x_config_filter(struct comedi_device *dev,
1337 unsigned pfi_channel,
1338 enum ni_gpct_filter_select filter)
1340 unsigned bits = ni_660x_read_register(dev, 0, IOConfigReg(pfi_channel));
1341 bits &= ~pfi_input_select_mask(pfi_channel);
1342 bits |= pfi_input_select_bits(pfi_channel, filter);
1343 ni_660x_write_register(dev, 0, bits, IOConfigReg(pfi_channel));
1346 static int ni_660x_dio_insn_config(struct comedi_device *dev,
1347 struct comedi_subdevice *s,
1348 struct comedi_insn *insn, unsigned int *data)
1350 int chan = CR_CHAN(insn->chanspec);
1352 /* The input or output configuration of each digital line is
1353 * configured by a special insn_config instruction. chanspec
1354 * contains the channel to be changed, and data[0] contains the
1355 * value COMEDI_INPUT or COMEDI_OUTPUT. */
1358 case INSN_CONFIG_DIO_OUTPUT:
1359 private(dev)->pfi_direction_bits |= ((uint64_t) 1) << chan;
1360 ni_660x_select_pfi_output(dev, chan,
1362 pfi_output_selects[chan]);
1364 case INSN_CONFIG_DIO_INPUT:
1365 private(dev)->pfi_direction_bits &= ~(((uint64_t) 1) << chan);
1366 ni_660x_select_pfi_output(dev, chan, pfi_output_select_high_Z);
1368 case INSN_CONFIG_DIO_QUERY:
1370 (private(dev)->pfi_direction_bits &
1371 (((uint64_t) 1) << chan)) ? COMEDI_OUTPUT : COMEDI_INPUT;
1373 case INSN_CONFIG_SET_ROUTING:
1374 return ni_660x_set_pfi_routing(dev, chan, data[1]);
1376 case INSN_CONFIG_GET_ROUTING:
1377 data[1] = ni_660x_get_pfi_routing(dev, chan);
1379 case INSN_CONFIG_FILTER:
1380 ni660x_config_filter(dev, chan, data[1]);