2 comedi/drivers/ni_tiocmd.c
3 Command support for NI general purpose counters
5 Copyright (C) 2006 Frank Mori Hess <fmhess@users.sourceforge.net>
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License as published by
9 the Free Software Foundation; either version 2 of the License, or
10 (at your option) any later version.
12 This program is distributed in the hope that it will be useful,
13 but WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 GNU General Public License for more details.
17 You should have received a copy of the GNU General Public License
18 along with this program; if not, write to the Free Software
19 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24 Description: National Instruments general purpose counters command support
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: Fri, 11 Apr 2008 12:32:35 +0100
34 This module is not used directly by end-users. Rather, it
35 is used by other drivers (for example ni_660x and ni_pcimio)
36 to provide command support for NI's general purpose counters.
37 It was originally split out of ni_tio.c to stop the 'ni_tio'
38 module depending on the 'mite' module.
41 DAQ 660x Register-Level Programmer Manual (NI 370505A-01)
42 DAQ 6601/6602 User Manual (NI 322137B-01)
43 340934b.pdf DAQ-STC reference manual
48 Support use of both banks X and Y
51 #include "ni_tio_internal.h"
54 MODULE_AUTHOR("Comedi <comedi@comedi.org>");
55 MODULE_DESCRIPTION("Comedi command support for NI general-purpose counters");
56 MODULE_LICENSE("GPL");
58 static void ni_tio_configure_dma(struct ni_gpct *counter, short enable,
61 struct ni_gpct_device *counter_dev = counter->counter_dev;
62 unsigned input_select_bits = 0;
66 input_select_bits |= Gi_Read_Acknowledges_Irq;
68 input_select_bits |= Gi_Write_Acknowledges_Irq;
70 ni_tio_set_bits(counter,
71 NITIO_Gi_Input_Select_Reg(counter->counter_index),
72 Gi_Read_Acknowledges_Irq | Gi_Write_Acknowledges_Irq,
74 switch (counter_dev->variant) {
75 case ni_gpct_variant_e_series:
77 case ni_gpct_variant_m_series:
78 case ni_gpct_variant_660x:
80 unsigned gi_dma_config_bits = 0;
83 gi_dma_config_bits |= Gi_DMA_Enable_Bit;
84 gi_dma_config_bits |= Gi_DMA_Int_Bit;
86 if (read_not_write == 0)
87 gi_dma_config_bits |= Gi_DMA_Write_Bit;
88 ni_tio_set_bits(counter,
89 NITIO_Gi_DMA_Config_Reg(counter->
91 Gi_DMA_Enable_Bit | Gi_DMA_Int_Bit |
92 Gi_DMA_Write_Bit, gi_dma_config_bits);
98 static int ni_tio_input_inttrig(struct comedi_device *dev,
99 struct comedi_subdevice *s,
100 unsigned int trignum)
104 struct ni_gpct *counter = s->private;
106 BUG_ON(counter == NULL);
110 spin_lock_irqsave(&counter->lock, flags);
111 if (counter->mite_chan)
112 mite_dma_arm(counter->mite_chan);
115 spin_unlock_irqrestore(&counter->lock, flags);
118 retval = ni_tio_arm(counter, 1, NI_GPCT_ARM_IMMEDIATE);
119 s->async->inttrig = NULL;
124 static int ni_tio_input_cmd(struct ni_gpct *counter, struct comedi_async *async)
126 struct ni_gpct_device *counter_dev = counter->counter_dev;
127 struct comedi_cmd *cmd = &async->cmd;
130 /* write alloc the entire buffer */
131 comedi_buf_write_alloc(async, async->prealloc_bufsz);
132 counter->mite_chan->dir = COMEDI_INPUT;
133 switch (counter_dev->variant) {
134 case ni_gpct_variant_m_series:
135 case ni_gpct_variant_660x:
136 mite_prep_dma(counter->mite_chan, 32, 32);
138 case ni_gpct_variant_e_series:
139 mite_prep_dma(counter->mite_chan, 16, 32);
145 ni_tio_set_bits(counter, NITIO_Gi_Command_Reg(counter->counter_index),
146 Gi_Save_Trace_Bit, 0);
147 ni_tio_configure_dma(counter, 1, 1);
148 switch (cmd->start_src) {
150 async->inttrig = NULL;
151 mite_dma_arm(counter->mite_chan);
152 retval = ni_tio_arm(counter, 1, NI_GPCT_ARM_IMMEDIATE);
155 async->inttrig = &ni_tio_input_inttrig;
158 async->inttrig = NULL;
159 mite_dma_arm(counter->mite_chan);
160 retval = ni_tio_arm(counter, 1, cmd->start_arg);
162 async->inttrig = NULL;
163 mite_dma_arm(counter->mite_chan);
172 static int ni_tio_output_cmd(struct ni_gpct *counter,
173 struct comedi_async *async)
175 printk(KERN_ERR "ni_tio: output commands not yet implemented.\n");
178 counter->mite_chan->dir = COMEDI_OUTPUT;
179 mite_prep_dma(counter->mite_chan, 32, 32);
180 ni_tio_configure_dma(counter, 1, 0);
181 mite_dma_arm(counter->mite_chan);
182 return ni_tio_arm(counter, 1, NI_GPCT_ARM_IMMEDIATE);
185 static int ni_tio_cmd_setup(struct ni_gpct *counter, struct comedi_async *async)
187 struct comedi_cmd *cmd = &async->cmd;
188 int set_gate_source = 0;
189 unsigned gate_source;
192 if (cmd->scan_begin_src == TRIG_EXT) {
194 gate_source = cmd->scan_begin_arg;
195 } else if (cmd->convert_src == TRIG_EXT) {
197 gate_source = cmd->convert_arg;
200 retval = ni_tio_set_gate_src(counter, 0, gate_source);
201 if (cmd->flags & TRIG_WAKE_EOS) {
202 ni_tio_set_bits(counter,
203 NITIO_Gi_Interrupt_Enable_Reg(counter->
205 Gi_Gate_Interrupt_Enable_Bit(counter->
207 Gi_Gate_Interrupt_Enable_Bit(counter->
213 int ni_tio_cmd(struct ni_gpct *counter, struct comedi_async *async)
215 struct comedi_cmd *cmd = &async->cmd;
219 spin_lock_irqsave(&counter->lock, flags);
220 if (counter->mite_chan == NULL) {
221 printk(KERN_ERR "ni_tio: commands only supported with DMA. Interrupt-driven commands not yet implemented.\n");
224 retval = ni_tio_cmd_setup(counter, async);
226 if (cmd->flags & CMDF_WRITE)
227 retval = ni_tio_output_cmd(counter, async);
229 retval = ni_tio_input_cmd(counter, async);
232 spin_unlock_irqrestore(&counter->lock, flags);
235 EXPORT_SYMBOL_GPL(ni_tio_cmd);
237 int ni_tio_cmdtest(struct ni_gpct *counter, struct comedi_cmd *cmd)
243 /* step 1: make sure trigger sources are trivially valid */
245 tmp = cmd->start_src;
246 sources = TRIG_NOW | TRIG_INT | TRIG_OTHER;
247 if (ni_tio_counting_mode_registers_present(counter->counter_dev))
249 cmd->start_src &= sources;
250 if (!cmd->start_src || tmp != cmd->start_src)
253 tmp = cmd->scan_begin_src;
254 cmd->scan_begin_src &= TRIG_FOLLOW | TRIG_EXT | TRIG_OTHER;
255 if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
258 tmp = cmd->convert_src;
259 sources = TRIG_NOW | TRIG_EXT | TRIG_OTHER;
260 cmd->convert_src &= sources;
261 if (!cmd->convert_src || tmp != cmd->convert_src)
264 tmp = cmd->scan_end_src;
265 cmd->scan_end_src &= TRIG_COUNT;
266 if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
270 cmd->stop_src &= TRIG_NONE;
271 if (!cmd->stop_src || tmp != cmd->stop_src)
277 /* step 2: make sure trigger sources are unique... */
279 if (cmd->start_src != TRIG_NOW &&
280 cmd->start_src != TRIG_INT &&
281 cmd->start_src != TRIG_EXT && cmd->start_src != TRIG_OTHER)
283 if (cmd->scan_begin_src != TRIG_FOLLOW &&
284 cmd->scan_begin_src != TRIG_EXT &&
285 cmd->scan_begin_src != TRIG_OTHER)
287 if (cmd->convert_src != TRIG_OTHER &&
288 cmd->convert_src != TRIG_EXT && cmd->convert_src != TRIG_NOW)
290 if (cmd->stop_src != TRIG_NONE)
292 /* ... and mutually compatible */
293 if (cmd->convert_src != TRIG_NOW && cmd->scan_begin_src != TRIG_FOLLOW)
299 /* step 3: make sure arguments are trivially compatible */
300 if (cmd->start_src != TRIG_EXT) {
301 if (cmd->start_arg != 0) {
306 if (cmd->scan_begin_src != TRIG_EXT) {
307 if (cmd->scan_begin_arg) {
308 cmd->scan_begin_arg = 0;
312 if (cmd->convert_src != TRIG_EXT) {
313 if (cmd->convert_arg) {
314 cmd->convert_arg = 0;
319 if (cmd->scan_end_arg != cmd->chanlist_len) {
320 cmd->scan_end_arg = cmd->chanlist_len;
324 if (cmd->stop_src == TRIG_NONE) {
325 if (cmd->stop_arg != 0) {
334 /* step 4: fix up any arguments */
341 EXPORT_SYMBOL_GPL(ni_tio_cmdtest);
343 int ni_tio_cancel(struct ni_gpct *counter)
347 ni_tio_arm(counter, 0, 0);
348 spin_lock_irqsave(&counter->lock, flags);
349 if (counter->mite_chan)
350 mite_dma_disarm(counter->mite_chan);
351 spin_unlock_irqrestore(&counter->lock, flags);
352 ni_tio_configure_dma(counter, 0, 0);
354 ni_tio_set_bits(counter,
355 NITIO_Gi_Interrupt_Enable_Reg(counter->counter_index),
356 Gi_Gate_Interrupt_Enable_Bit(counter->counter_index),
360 EXPORT_SYMBOL_GPL(ni_tio_cancel);
362 /* During buffered input counter operation for e-series, the gate
363 interrupt is acked automatically by the dma controller, due to the
364 Gi_Read/Write_Acknowledges_IRQ bits in the input select register. */
365 static int should_ack_gate(struct ni_gpct *counter)
370 switch (counter->counter_dev->variant) {
371 case ni_gpct_variant_m_series:
372 /* not sure if 660x really supports gate
373 interrupts (the bits are not listed
374 in register-level manual) */
375 case ni_gpct_variant_660x:
378 case ni_gpct_variant_e_series:
379 spin_lock_irqsave(&counter->lock, flags);
381 if (counter->mite_chan == NULL ||
382 counter->mite_chan->dir != COMEDI_INPUT ||
383 (mite_done(counter->mite_chan))) {
387 spin_unlock_irqrestore(&counter->lock, flags);
393 void ni_tio_acknowledge_and_confirm(struct ni_gpct *counter, int *gate_error,
394 int *tc_error, int *perm_stale_data,
397 const unsigned short gxx_status = read_register(counter,
401 const unsigned short gi_status = read_register(counter,
412 *perm_stale_data = 0;
416 if (gxx_status & Gi_Gate_Error_Bit(counter->counter_index)) {
417 ack |= Gi_Gate_Error_Confirm_Bit(counter->counter_index);
419 /*660x don't support automatic acknowledgement
420 of gate interrupt via dma read/write
421 and report bogus gate errors */
422 if (counter->counter_dev->variant !=
423 ni_gpct_variant_660x) {
428 if (gxx_status & Gi_TC_Error_Bit(counter->counter_index)) {
429 ack |= Gi_TC_Error_Confirm_Bit(counter->counter_index);
433 if (gi_status & Gi_TC_Bit)
434 ack |= Gi_TC_Interrupt_Ack_Bit;
435 if (gi_status & Gi_Gate_Interrupt_Bit) {
436 if (should_ack_gate(counter))
437 ack |= Gi_Gate_Interrupt_Ack_Bit;
440 write_register(counter, ack,
441 NITIO_Gi_Interrupt_Acknowledge_Reg
442 (counter->counter_index));
443 if (ni_tio_get_soft_copy
445 NITIO_Gi_Mode_Reg(counter->counter_index)) &
446 Gi_Loading_On_Gate_Bit) {
447 if (gxx_status & Gi_Stale_Data_Bit(counter->counter_index)) {
451 if (read_register(counter,
452 NITIO_Gxx_Joint_Status2_Reg
453 (counter->counter_index)) &
454 Gi_Permanent_Stale_Bit(counter->counter_index)) {
455 printk(KERN_INFO "%s: Gi_Permanent_Stale_Data detected.\n",
458 *perm_stale_data = 1;
462 EXPORT_SYMBOL_GPL(ni_tio_acknowledge_and_confirm);
464 void ni_tio_handle_interrupt(struct ni_gpct *counter,
465 struct comedi_subdevice *s)
467 unsigned gpct_mite_status;
473 ni_tio_acknowledge_and_confirm(counter, &gate_error, &tc_error,
474 &perm_stale_data, NULL);
476 printk(KERN_NOTICE "%s: Gi_Gate_Error detected.\n", __func__);
477 s->async->events |= COMEDI_CB_OVERFLOW;
480 s->async->events |= COMEDI_CB_ERROR;
481 switch (counter->counter_dev->variant) {
482 case ni_gpct_variant_m_series:
483 case ni_gpct_variant_660x:
484 if (read_register(counter,
485 NITIO_Gi_DMA_Status_Reg
486 (counter->counter_index)) & Gi_DRQ_Error_Bit) {
487 printk(KERN_NOTICE "%s: Gi_DRQ_Error detected.\n",
489 s->async->events |= COMEDI_CB_OVERFLOW;
492 case ni_gpct_variant_e_series:
495 spin_lock_irqsave(&counter->lock, flags);
496 if (counter->mite_chan == NULL) {
497 spin_unlock_irqrestore(&counter->lock, flags);
500 gpct_mite_status = mite_get_status(counter->mite_chan);
501 if (gpct_mite_status & CHSR_LINKC) {
503 counter->mite_chan->mite->mite_io_addr +
504 MITE_CHOR(counter->mite_chan->channel));
506 mite_sync_input_dma(counter->mite_chan, s->async);
507 spin_unlock_irqrestore(&counter->lock, flags);
509 EXPORT_SYMBOL_GPL(ni_tio_handle_interrupt);
511 void ni_tio_set_mite_channel(struct ni_gpct *counter,
512 struct mite_channel *mite_chan)
516 spin_lock_irqsave(&counter->lock, flags);
517 counter->mite_chan = mite_chan;
518 spin_unlock_irqrestore(&counter->lock, flags);
520 EXPORT_SYMBOL_GPL(ni_tio_set_mite_channel);
522 static int __init ni_tiocmd_init_module(void)
527 module_init(ni_tiocmd_init_module);
529 static void __exit ni_tiocmd_cleanup_module(void)
533 module_exit(ni_tiocmd_cleanup_module);