?  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 / addi-data / APCI1710_Dig_io.c
bloba6898e4bbb6229022a91498e938b0b8b671ec1a9
1 /**
2 @verbatim
3
4 Copyright (C) 2004,2005 ADDI-DATA GmbH for the source code of this module.
5
6 ADDI-DATA GmbH
7 Dieselstrasse 3
8 D-77833 Ottersweier
9 Tel: +19(0)7223/9493-0
10 Fax: +49(0)7223/9493-92
11 http://www.addi-data-com
12 info@addi-data.com
13
14 This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version.
15
16 This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details.
17
18 You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19
20 You should also find the complete GPL in the COPYING file accompanying this source code.
21
22 @endverbatim
23 */
24 /*
25
26 +-----------------------------------------------------------------------+
27 | (C) ADDI-DATA GmbH Dieselstraße 3 D-77833 Ottersweier |
28 +-----------------------------------------------------------------------+
29 | Tel : +49 (0) 7223/9493-0 | email : info@addi-data.com |
30 | Fax : +49 (0) 7223/9493-92 | Internet : http://www.addi-data.com |
31 +-----------------------------------------------------------------------+
32 | Project : API APCI1710 | Compiler : gcc |
33 | Module name : DIG_IO.C | Version : 2.96 |
34 +-------------------------------+---------------------------------------+
35 | Project manager: Eric Stolz | Date : 02/12/2002 |
36 +-----------------------------------------------------------------------+
37 | Description : APCI-1710 digital I/O module |
38 | |
39 | |
40 +-----------------------------------------------------------------------+
41 | UPDATES |
42 +-----------------------------------------------------------------------+
43 | Date | Author | Description of updates |
44 +----------+-----------+------------------------------------------------+
45 | 16/06/98 | S. Weber | Digital input / output implementation |
46 |----------|-----------|------------------------------------------------|
47 | 08/05/00 | Guinot C | - 0400/0228 All Function in RING 0 |
48 | | | available |
49 +-----------------------------------------------------------------------+
50 | | | |
51 | | | |
52 +-----------------------------------------------------------------------+
53 */
54
55 /*
56 +----------------------------------------------------------------------------+
57 | Included files |
58 +----------------------------------------------------------------------------+
59 */
60 #include "APCI1710_Dig_io.h"
61
62 /*
63 +----------------------------------------------------------------------------+
64 | Function Name : int i_APCI1710_InsnConfigDigitalIO(struct comedi_device *dev, |
65 | struct comedi_subdevice *s,struct comedi_insn *insn,unsigned int *data)|
66 +----------------------------------------------------------------------------+
67 | Task : Configure the digital I/O operating mode from selected |
68 | module (b_ModulNbr). You must calling this function be|
69 | for you call any other function witch access of digital|
70 | I/O. |
71 +----------------------------------------------------------------------------+
72 | Input Parameters : |
73 | unsigned char_ b_ModulNbr data[0]: Module number to |
74 | configure (0 to 3) |
75 | unsigned char_ b_ChannelAMode data[1] : Channel A mode selection |
76 | 0 : Channel used for digital |
77 | input |
78 | 1 : Channel used for digital |
79 | output |
80 | unsigned char_ b_ChannelBMode data[2] : Channel B mode selection |
81 | 0 : Channel used for digital |
82 | input |
83 | 1 : Channel used for digital |
84 | output |
85 data[0] memory on/off
86 Activates and deactivates the digital output memory.
87 After having |
88 | called up this function with memory on,the output you have previously|
89 | activated with the function are not reset
90 +----------------------------------------------------------------------------+
91 | Output Parameters : - |
92 +----------------------------------------------------------------------------+
93 | Return Value : 0: No error |
94 | -1: The handle parameter of the board is wrong |
95 | -2: The module parameter is wrong |
96 | -3: The module is not a digital I/O module |
97 | -4: Bi-directional channel A configuration error |
98 | -5: Bi-directional channel B configuration error |
99 +----------------------------------------------------------------------------+
100 */
101
102 int i_APCI1710_InsnConfigDigitalIO(struct comedi_device *dev, struct comedi_subdevice *s,
103 struct comedi_insn *insn, unsigned int *data)
104 {
105 unsigned char b_ModulNbr, b_ChannelAMode, b_ChannelBMode;
106 unsigned char b_MemoryOnOff, b_ConfigType;
107 int i_ReturnValue = 0;
108 unsigned int dw_WriteConfig = 0;
109
110 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
111 b_ConfigType = (unsigned char) data[0]; /* Memory or Init */
112 b_ChannelAMode = (unsigned char) data[1];
113 b_ChannelBMode = (unsigned char) data[2];
114 b_MemoryOnOff = (unsigned char) data[1]; /* if memory operation */
115 i_ReturnValue = insn->n;
116
117 /**************************/
118 /* Test the module number */
119 /**************************/
120
121 if (b_ModulNbr >= 4) {
122 DPRINTK("Module Number invalid\n");
123 i_ReturnValue = -2;
124 return i_ReturnValue;
125 }
126 switch (b_ConfigType) {
127 case APCI1710_DIGIO_MEMORYONOFF:
128
129 if (b_MemoryOnOff) /* If Memory ON */
130 {
131 /****************************/
132 /* Set the output memory on */
133 /****************************/
134
135 devpriv->s_ModuleInfo[b_ModulNbr].
136 s_DigitalIOInfo.b_OutputMemoryEnabled = 1;
137
138 /***************************/
139 /* Clear the output memory */
140 /***************************/
141 devpriv->s_ModuleInfo[b_ModulNbr].
142 s_DigitalIOInfo.dw_OutputMemory = 0;
143 } else /* If memory off */
144 {
145 /*****************************/
146 /* Set the output memory off */
147 /*****************************/
148
149 devpriv->s_ModuleInfo[b_ModulNbr].
150 s_DigitalIOInfo.b_OutputMemoryEnabled = 0;
151 }
152 break;
153
154 case APCI1710_DIGIO_INIT:
155
156 /*******************************/
157 /* Test if digital I/O counter */
158 /*******************************/
159
160 if ((devpriv->s_BoardInfos.
161 dw_MolduleConfiguration[b_ModulNbr] &
162 0xFFFF0000UL) == APCI1710_DIGITAL_IO) {
163
164 /***************************************************/
165 /* Test the bi-directional channel A configuration */
166 /***************************************************/
167
168 if ((b_ChannelAMode == 0) || (b_ChannelAMode == 1)) {
169 /***************************************************/
170 /* Test the bi-directional channel B configuration */
171 /***************************************************/
172
173 if ((b_ChannelBMode == 0)
174 || (b_ChannelBMode == 1)) {
175 devpriv->s_ModuleInfo[b_ModulNbr].
176 s_DigitalIOInfo.b_DigitalInit =
177 1;
178
179 /********************************/
180 /* Save channel A configuration */
181 /********************************/
182
183 devpriv->s_ModuleInfo[b_ModulNbr].
184 s_DigitalIOInfo.
185 b_ChannelAMode = b_ChannelAMode;
186
187 /********************************/
188 /* Save channel B configuration */
189 /********************************/
190
191 devpriv->s_ModuleInfo[b_ModulNbr].
192 s_DigitalIOInfo.
193 b_ChannelBMode = b_ChannelBMode;
194
195 /*****************************************/
196 /* Set the channel A and B configuration */
197 /*****************************************/
198
199 dw_WriteConfig =
200 (unsigned int) (b_ChannelAMode |
201 (b_ChannelBMode * 2));
202
203 /***************************/
204 /* Write the configuration */
205 /***************************/
206
207 outl(dw_WriteConfig,
208 devpriv->s_BoardInfos.
209 ui_Address + 4 +
210 (64 * b_ModulNbr));
211
212 } else {
213 /************************************************/
214 /* Bi-directional channel B configuration error */
215 /************************************************/
216 DPRINTK("Bi-directional channel B configuration error\n");
217 i_ReturnValue = -5;
218 }
219
220 } else {
221 /************************************************/
222 /* Bi-directional channel A configuration error */
223 /************************************************/
224 DPRINTK("Bi-directional channel A configuration error\n");
225 i_ReturnValue = -4;
226
227 }
228
229 } else {
230 /******************************************/
231 /* The module is not a digital I/O module */
232 /******************************************/
233 DPRINTK("The module is not a digital I/O module\n");
234 i_ReturnValue = -3;
235 }
236 } /* end of Switch */
237 printk("Return Value %d\n", i_ReturnValue);
238 return i_ReturnValue;
239 }
240
241 /*
242 +----------------------------------------------------------------------------+
243 | INPUT FUNCTIONS |
244 +----------------------------------------------------------------------------+
245 */
246
247 /*
248 +----------------------------------------------------------------------------+
249
250 |INT i_APCI1710_InsnReadDigitalIOChlValue(struct comedi_device *dev,comedi_subdevice
251 *s, struct comedi_insn *insn,unsigned int *data)
252
253 +----------------------------------------------------------------------------+
254 | Task : Read the status from selected digital I/O digital input|
255 | (b_InputChannel) |
256 +----------------------------------------------------------------------------|
257
258
259 |
260 | unsigned char_ b_ModulNbr CR_AREF(chanspec) : Selected module number |
261 | (0 to 3) |
262 | unsigned char_ b_InputChannel CR_CHAN(chanspec) : Selection from digital |
263 | input ( 0 to 6) |
264 | 0 : Channel C |
265 | 1 : Channel D |
266 | 2 : Channel E |
267 | 3 : Channel F |
268 | 4 : Channel G |
269 | 5 : Channel A |
270 | 6 : Channel B
271
272
273 |
274 +----------------------------------------------------------------------------+
275 | Output Parameters : data[0] : Digital input channel |
276 | status |
277 | 0 : Channle is not active|
278 | 1 : Channle is active |
279 +----------------------------------------------------------------------------+
280 | Return Value : 0: No error |
281 | -1: The handle parameter of the board is wrong |
282 | -2: The module parameter is wrong |
283 | -3: The module is not a digital I/O module |
284 | -4: The selected digital I/O digital input is wrong |
285 | -5: Digital I/O not initialised |
286 | -6: The digital channel A is used for output |
287 | -7: The digital channel B is used for output |
288 +----------------------------------------------------------------------------+
289 */
290
291 /* _INT_ i_APCI1710_ReadDigitalIOChlValue (unsigned char_ b_BoardHandle, */
292 /*
293 * unsigned char_ b_ModulNbr, unsigned char_ b_InputChannel,
294 * unsigned char *_ pb_ChannelStatus)
295 */
296 int i_APCI1710_InsnReadDigitalIOChlValue(struct comedi_device *dev,
297 struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data)
298 {
299 int i_ReturnValue = 0;
300 unsigned int dw_StatusReg;
301 unsigned char b_ModulNbr, b_InputChannel;
302 unsigned char *pb_ChannelStatus;
303 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
304 b_InputChannel = (unsigned char) CR_CHAN(insn->chanspec);
305 data[0] = 0;
306 pb_ChannelStatus = (unsigned char *) &data[0];
307 i_ReturnValue = insn->n;
308
309 /**************************/
310 /* Test the module number */
311 /**************************/
312
313 if (b_ModulNbr < 4) {
314 /*******************************/
315 /* Test if digital I/O counter */
316 /*******************************/
317
318 if ((devpriv->s_BoardInfos.
319 dw_MolduleConfiguration[b_ModulNbr] &
320 0xFFFF0000UL) == APCI1710_DIGITAL_IO) {
321 /******************************************/
322 /* Test the digital imnput channel number */
323 /******************************************/
324
325 if (b_InputChannel <= 6) {
326 /**********************************************/
327 /* Test if the digital I/O module initialised */
328 /**********************************************/
329
330 if (devpriv->s_ModuleInfo[b_ModulNbr].
331 s_DigitalIOInfo.b_DigitalInit == 1) {
332 /**********************************/
333 /* Test if channel A or channel B */
334 /**********************************/
335
336 if (b_InputChannel > 4) {
337 /*********************/
338 /* Test if channel A */
339 /*********************/
340
341 if (b_InputChannel == 5) {
342 /***************************/
343 /* Test the channel A mode */
344 /***************************/
345
346 if (devpriv->
347 s_ModuleInfo
348 [b_ModulNbr].
349 s_DigitalIOInfo.
350 b_ChannelAMode
351 != 0) {
352 /********************************************/
353 /* The digital channel A is used for output */
354 /********************************************/
355
356 i_ReturnValue =
357 -6;
358 }
359 } /* if (b_InputChannel == 5) */
360 else {
361 /***************************/
362 /* Test the channel B mode */
363 /***************************/
364
365 if (devpriv->
366 s_ModuleInfo
367 [b_ModulNbr].
368 s_DigitalIOInfo.
369 b_ChannelBMode
370 != 0) {
371 /********************************************/
372 /* The digital channel B is used for output */
373 /********************************************/
374
375 i_ReturnValue =
376 -7;
377 }
378 } /* if (b_InputChannel == 5) */
379 } /* if (b_InputChannel > 4) */
380
381 /***********************/
382 /* Test if error occur */
383 /***********************/
384
385 if (i_ReturnValue >= 0) {
386 /**************************/
387 /* Read all digital input */
388 /**************************/
389
390 /*
391 * INPDW (ps_APCI1710Variable-> s_Board [b_BoardHandle].
392 * s_BoardInfos. ui_Address + (64 * b_ModulNbr), &dw_StatusReg);
393 */
394
395 dw_StatusReg =
396 inl(devpriv->
397 s_BoardInfos.
398 ui_Address +
399 (64 * b_ModulNbr));
400
401 *pb_ChannelStatus =
402 (unsigned char) ((dw_StatusReg ^
403 0x1C) >>
404 b_InputChannel) & 1;
405
406 } /* if (i_ReturnValue == 0) */
407 } else {
408 /*******************************/
409 /* Digital I/O not initialised */
410 /*******************************/
411 DPRINTK("Digital I/O not initialised\n");
412 i_ReturnValue = -5;
413 }
414 } else {
415 /********************************/
416 /* Selected digital input error */
417 /********************************/
418 DPRINTK("Selected digital input error\n");
419 i_ReturnValue = -4;
420 }
421 } else {
422 /******************************************/
423 /* The module is not a digital I/O module */
424 /******************************************/
425 DPRINTK("The module is not a digital I/O module\n");
426 i_ReturnValue = -3;
427 }
428 } else {
429 /***********************/
430 /* Module number error */
431 /***********************/
432 DPRINTK("Module number error\n");
433 i_ReturnValue = -2;
434 }
435
436 return i_ReturnValue;
437 }
438
439 /*
440 +----------------------------------------------------------------------------+
441 | OUTPUT FUNCTIONS |
442 +----------------------------------------------------------------------------+
443 */
444
445 /*
446 +----------------------------------------------------------------------------+
447 | Function Name : int i_APCI1710_InsnWriteDigitalIOChlOnOff(comedi_device
448 |*dev,struct comedi_subdevice *s,struct comedi_insn *insn,unsigned int *data)
449
450 +----------------------------------------------------------------------------+
451 | Task : Sets or resets the output witch has been passed with the |
452 | parameter b_Channel. Setting an output means setting |
453 | an ouput high. |
454 +----------------------------------------------------------------------------+
455 | Input Parameters : unsigned char_ b_BoardHandle : Handle of board APCI-1710 |
456 | unsigned char_ b_ModulNbr (aref ) : Selected module number (0 to 3)|
457 | unsigned char_ b_OutputChannel (CR_CHAN) : Selection from digital output |
458 | channel (0 to 2) |
459 | 0 : Channel H |
460 | 1 : Channel A |
461 | 2 : Channel B |
462 +----------------------------------------------------------------------------+
463 | Output Parameters : - |
464 +----------------------------------------------------------------------------+
465 | Return Value : 0: No error |
466 | -1: The handle parameter of the board is wrong |
467 | -2: The module parameter is wrong |
468 | -3: The module is not a digital I/O module |
469 | -4: The selected digital output is wrong |
470 | -5: digital I/O not initialised see function |
471 | " i_APCI1710_InitDigitalIO" |
472 | -6: The digital channel A is used for input |
473 | -7: The digital channel B is used for input
474 -8: Digital Output Memory OFF. |
475 | Use previously the function |
476 | "i_APCI1710_SetDigitalIOMemoryOn". |
477 +----------------------------------------------------------------------------+
478 */
479
480 /*
481 * _INT_ i_APCI1710_SetDigitalIOChlOn (unsigned char_ b_BoardHandle,
482 * unsigned char_ b_ModulNbr, unsigned char_ b_OutputChannel)
483 */
484 int i_APCI1710_InsnWriteDigitalIOChlOnOff(struct comedi_device *dev,
485 struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data)
486 {
487 int i_ReturnValue = 0;
488 unsigned int dw_WriteValue = 0;
489 unsigned char b_ModulNbr, b_OutputChannel;
490 i_ReturnValue = insn->n;
491 b_ModulNbr = CR_AREF(insn->chanspec);
492 b_OutputChannel = CR_CHAN(insn->chanspec);
493
494 /**************************/
495 /* Test the module number */
496 /**************************/
497
498 if (b_ModulNbr < 4) {
499 /*******************************/
500 /* Test if digital I/O counter */
501 /*******************************/
502
503 if ((devpriv->s_BoardInfos.
504 dw_MolduleConfiguration[b_ModulNbr] &
505 0xFFFF0000UL) == APCI1710_DIGITAL_IO) {
506 /**********************************************/
507 /* Test if the digital I/O module initialised */
508 /**********************************************/
509
510 if (devpriv->s_ModuleInfo[b_ModulNbr].
511 s_DigitalIOInfo.b_DigitalInit == 1) {
512 /******************************************/
513 /* Test the digital output channel number */
514 /******************************************/
515
516 switch (b_OutputChannel) {
517 /*************/
518 /* Channel H */
519 /*************/
520
521 case 0:
522 break;
523
524 /*************/
525 /* Channel A */
526 /*************/
527
528 case 1:
529 if (devpriv->s_ModuleInfo[b_ModulNbr].
530 s_DigitalIOInfo.
531 b_ChannelAMode != 1) {
532 /*******************************************/
533 /* The digital channel A is used for input */
534 /*******************************************/
535
536 i_ReturnValue = -6;
537 }
538 break;
539
540 /*************/
541 /* Channel B */
542 /*************/
543
544 case 2:
545 if (devpriv->s_ModuleInfo[b_ModulNbr].
546 s_DigitalIOInfo.
547 b_ChannelBMode != 1) {
548 /*******************************************/
549 /* The digital channel B is used for input */
550 /*******************************************/
551
552 i_ReturnValue = -7;
553 }
554 break;
555
556 default:
557 /****************************************/
558 /* The selected digital output is wrong */
559 /****************************************/
560
561 i_ReturnValue = -4;
562 break;
563 }
564
565 /***********************/
566 /* Test if error occur */
567 /***********************/
568
569 if (i_ReturnValue >= 0) {
570
571 /*********************************/
572 /* Test if set channel ON */
573 /*********************************/
574 if (data[0]) {
575 /*********************************/
576 /* Test if output memory enabled */
577 /*********************************/
578
579 if (devpriv->
580 s_ModuleInfo
581 [b_ModulNbr].
582 s_DigitalIOInfo.
583 b_OutputMemoryEnabled ==
584 1) {
585 dw_WriteValue =
586 devpriv->
587 s_ModuleInfo
588 [b_ModulNbr].
589 s_DigitalIOInfo.
590 dw_OutputMemory
591 | (1 <<
592 b_OutputChannel);
593
594 devpriv->
595 s_ModuleInfo
596 [b_ModulNbr].
597 s_DigitalIOInfo.
598 dw_OutputMemory
599 = dw_WriteValue;
600 } else {
601 dw_WriteValue =
602 1 <<
603 b_OutputChannel;
604 }
605 } /* set channel off */
606 else {
607 if (devpriv->
608 s_ModuleInfo
609 [b_ModulNbr].
610 s_DigitalIOInfo.
611 b_OutputMemoryEnabled ==
612 1) {
613 dw_WriteValue =
614 devpriv->
615 s_ModuleInfo
616 [b_ModulNbr].
617 s_DigitalIOInfo.
618 dw_OutputMemory
619 & (0xFFFFFFFFUL
620 -
621 (1 << b_OutputChannel));
622
623 devpriv->
624 s_ModuleInfo
625 [b_ModulNbr].
626 s_DigitalIOInfo.
627 dw_OutputMemory
628 = dw_WriteValue;
629 } else {
630 /*****************************/
631 /* Digital Output Memory OFF */
632 /*****************************/
633 /* +Use previously the function "i_APCI1710_SetDigitalIOMemoryOn" */
634 i_ReturnValue = -8;
635 }
636
637 }
638 /*******************/
639 /* Write the value */
640 /*******************/
641
642 /* OUTPDW (ps_APCI1710Variable->
643 * s_Board [b_BoardHandle].
644 * s_BoardInfos. ui_Address + (64 * b_ModulNbr),
645 * dw_WriteValue);
646 */
647 */
648 outl(dw_WriteValue,
649 devpriv->s_BoardInfos.
650 ui_Address + (64 * b_ModulNbr));
651 }
652 } else {
653 /*******************************/
654 /* Digital I/O not initialised */
655 /*******************************/
656
657 i_ReturnValue = -5;
658 }
659 } else {
660 /******************************************/
661 /* The module is not a digital I/O module */
662 /******************************************/
663
664 i_ReturnValue = -3;
665 }
666 } else {
667 /***********************/
668 /* Module number error */
669 /***********************/
670
671 i_ReturnValue = -2;
672 }
673
674 return i_ReturnValue;
675 }
676
677 /*
678 +----------------------------------------------------------------------------+
679
680 |INT i_APCI1710_InsnBitsDigitalIOPortOnOff(struct comedi_device *dev,comedi_subdevice
681 *s, struct comedi_insn *insn,unsigned int *data)
682 +----------------------------------------------------------------------------+
683 | Task : write:
684 Sets or resets one or several outputs from port. |
685 | Setting an output means setting an output high. |
686 | If you have switched OFF the digital output memory |
687 | (OFF), all the other output are set to "0".
688
689 | read:
690 Read the status from digital input port |
691 | from selected digital I/O module (b_ModulNbr)
692 +----------------------------------------------------------------------------+
693 | Input Parameters :
694 unsigned char_ b_BoardHandle : Handle of board APCI-1710 |
695 | unsigned char_ b_ModulNbr CR_AREF(aref) : Selected module number (0 to 3)|
696 | unsigned char_ b_PortValue CR_CHAN(chanspec) : Output Value ( 0 To 7 )
697 | data[0] read or write port
698 | data[1] if write then indicate ON or OFF
699
700 | if read : data[1] will return port status.
701 +----------------------------------------------------------------------------+
702 | Output Parameters : - |
703 +----------------------------------------------------------------------------+
704 | Return Value :
705
706 | INPUT :
707
708 0: No error |
709 | -1: The handle parameter of the board is wrong |
710 | -2: The module parameter is wrong |
711 | -3: The module is not a digital I/O module |
712 | -4: Digital I/O not initialised
713
714 OUTPUT: 0: No error |
715 | -1: The handle parameter of the board is wrong |
716 | -2: The module parameter is wrong |
717 | -3: The module is not a digital I/O module |
718 | -4: Output value wrong |
719 | -5: digital I/O not initialised see function |
720 | " i_APCI1710_InitDigitalIO" |
721 | -6: The digital channel A is used for input |
722 | -7: The digital channel B is used for input
723 -8: Digital Output Memory OFF. |
724 | Use previously the function |
725 | "i_APCI1710_SetDigitalIOMemoryOn". |
726 +----------------------------------------------------------------------------+
727 */
728
729 /*
730 * _INT_ i_APCI1710_SetDigitalIOPortOn (unsigned char_
731 * b_BoardHandle, unsigned char_ b_ModulNbr, unsigned char_
732 * b_PortValue)
733 */
734 int i_APCI1710_InsnBitsDigitalIOPortOnOff(struct comedi_device *dev,
735 struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data)
736 {
737 int i_ReturnValue = 0;
738 unsigned int dw_WriteValue = 0;
739 unsigned int dw_StatusReg;
740 unsigned char b_ModulNbr, b_PortValue;
741 unsigned char b_PortOperation, b_PortOnOFF;
742
743 unsigned char *pb_PortValue;
744
745 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
746 b_PortOperation = (unsigned char) data[0]; /* Input or output */
747 b_PortOnOFF = (unsigned char) data[1]; /* if output then On or Off */
748 b_PortValue = (unsigned char) data[2]; /* if out put then Value */
749 i_ReturnValue = insn->n;
750 pb_PortValue = (unsigned char *) &data[0];
751 /* if input then read value */
752
753 switch (b_PortOperation) {
754 case APCI1710_INPUT:
755 /**************************/
756 /* Test the module number */
757 /**************************/
758
759 if (b_ModulNbr < 4) {
760 /*******************************/
761 /* Test if digital I/O counter */
762 /*******************************/
763
764 if ((devpriv->s_BoardInfos.
765 dw_MolduleConfiguration[b_ModulNbr] &
766 0xFFFF0000UL) == APCI1710_DIGITAL_IO) {
767 /**********************************************/
768 /* Test if the digital I/O module initialised */
769 /**********************************************/
770
771 if (devpriv->s_ModuleInfo[b_ModulNbr].
772 s_DigitalIOInfo.b_DigitalInit == 1) {
773 /**************************/
774 /* Read all digital input */
775 /**************************/
776
777 /* INPDW (ps_APCI1710Variable->
778 * s_Board [b_BoardHandle].
779 * s_BoardInfos.
780 * ui_Address + (64 * b_ModulNbr),
781 * &dw_StatusReg);
782 */
783
784 dw_StatusReg =
785 inl(devpriv->s_BoardInfos.
786 ui_Address + (64 * b_ModulNbr));
787 *pb_PortValue =
788 (unsigned char) (dw_StatusReg ^ 0x1C);
789
790 } else {
791 /*******************************/
792 /* Digital I/O not initialised */
793 /*******************************/
794
795 i_ReturnValue = -4;
796 }
797 } else {
798 /******************************************/
799 /* The module is not a digital I/O module */
800 /******************************************/
801
802 i_ReturnValue = -3;
803 }
804 } else {
805 /***********************/
806 /* Module number error */
807 /***********************/
808
809 i_ReturnValue = -2;
810 }
811
812 break;
813
814 case APCI1710_OUTPUT:
815 /**************************/
816 /* Test the module number */
817 /**************************/
818
819 if (b_ModulNbr < 4) {
820 /*******************************/
821 /* Test if digital I/O counter */
822 /*******************************/
823
824 if ((devpriv->s_BoardInfos.
825 dw_MolduleConfiguration[b_ModulNbr] &
826 0xFFFF0000UL) == APCI1710_DIGITAL_IO) {
827 /**********************************************/
828 /* Test if the digital I/O module initialised */
829 /**********************************************/
830
831 if (devpriv->s_ModuleInfo[b_ModulNbr].
832 s_DigitalIOInfo.b_DigitalInit == 1) {
833 /***********************/
834 /* Test the port value */
835 /***********************/
836
837 if (b_PortValue <= 7) {
838 /***********************************/
839 /* Test the digital output channel */
840 /***********************************/
841
842 /**************************/
843 /* Test if channel A used */
844 /**************************/
845
846 if ((b_PortValue & 2) == 2) {
847 if (devpriv->
848 s_ModuleInfo
849 [b_ModulNbr].
850 s_DigitalIOInfo.
851 b_ChannelAMode
852 != 1) {
853 /*******************************************/
854 /* The digital channel A is used for input */
855 /*******************************************/
856
857 i_ReturnValue =
858 -6;
859 }
860 } /* if ((b_PortValue & 2) == 2) */
861
862 /**************************/
863 /* Test if channel B used */
864 /**************************/
865
866 if ((b_PortValue & 4) == 4) {
867 if (devpriv->
868 s_ModuleInfo
869 [b_ModulNbr].
870 s_DigitalIOInfo.
871 b_ChannelBMode
872 != 1) {
873 /*******************************************/
874 /* The digital channel B is used for input */
875 /*******************************************/
876
877 i_ReturnValue =
878 -7;
879 }
880 } /* if ((b_PortValue & 4) == 4) */
881
882 /***********************/
883 /* Test if error occur */
884 /***********************/
885
886 if (i_ReturnValue >= 0) {
887
888 /* if(data[1]) { */
889
890 switch (b_PortOnOFF) {
891 /*********************************/
892 /* Test if set Port ON */
893 /*********************************/
894
895 case APCI1710_ON:
896
897 /*********************************/
898 /* Test if output memory enabled */
899 /*********************************/
900
901 if (devpriv->
902 s_ModuleInfo
903 [b_ModulNbr].
904 s_DigitalIOInfo.
905 b_OutputMemoryEnabled
906 == 1) {
907 dw_WriteValue
908 =
909 devpriv->
910 s_ModuleInfo
911 [b_ModulNbr].
912 s_DigitalIOInfo.
913 dw_OutputMemory
914 |
915 b_PortValue;
916
917 devpriv->
918 s_ModuleInfo
919 [b_ModulNbr].
920 s_DigitalIOInfo.
921 dw_OutputMemory
922 =
923 dw_WriteValue;
924 } else {
925 dw_WriteValue
926 =
927 b_PortValue;
928 }
929 break;
930
931 /* If Set PORT OFF */
932 case APCI1710_OFF:
933
934 /*********************************/
935 /* Test if output memory enabled */
936 /*********************************/
937
938 if (devpriv->
939 s_ModuleInfo
940 [b_ModulNbr].
941 s_DigitalIOInfo.
942 b_OutputMemoryEnabled
943 == 1) {
944 dw_WriteValue
945 =
946 devpriv->
947 s_ModuleInfo
948 [b_ModulNbr].
949 s_DigitalIOInfo.
950 dw_OutputMemory
951 &
952 (0xFFFFFFFFUL
953 -
954 b_PortValue);
955
956 devpriv->
957 s_ModuleInfo
958 [b_ModulNbr].
959 s_DigitalIOInfo.
960 dw_OutputMemory
961 =
962 dw_WriteValue;
963 } else {
964 /*****************************/
965 /* Digital Output Memory OFF */
966 /*****************************/
967
968 i_ReturnValue
969 =
970 -8;
971 }
972 } /* switch */
973
974 /*******************/
975 /* Write the value */
976 /*******************/
977
978 /* OUTPDW (ps_APCI1710Variable->
979 * s_Board [b_BoardHandle].
980 * s_BoardInfos.
981 * ui_Address + (64 * b_ModulNbr),
982 * dw_WriteValue); */
983
984 outl(dw_WriteValue,
985 devpriv->
986 s_BoardInfos.
987 ui_Address +
988 (64 * b_ModulNbr));
989 }
990 } else {
991 /**********************/
992 /* Output value wrong */
993 /**********************/
994
995 i_ReturnValue = -4;
996 }
997 } else {
998 /*******************************/
999 /* Digital I/O not initialised */
1000 /*******************************/
1001
1002 i_ReturnValue = -5;
1003 }
1004 } else {
1005 /******************************************/
1006 /* The module is not a digital I/O module */
1007 /******************************************/
1008
1009 i_ReturnValue = -3;
1010 }
1011 } else {
1012 /***********************/
1013 /* Module number error */
1014 /***********************/
1015
1016 i_ReturnValue = -2;
1017 }
1018 break;
1019
1020 default:
1021 i_ReturnValue = -9;
1022 DPRINTK("NO INPUT/OUTPUT specified\n");
1023 } /* switch INPUT / OUTPUT */
1024 return i_ReturnValue;
1025 }
Tomato firmware and modifications.