]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/staging/comedi/drivers/addi-data/APCI1710_Dig_io.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Staging: comedi: Remove comedi_device typedef
[net-next-2.6.git] / drivers / staging / comedi / drivers / addi-data / APCI1710_Dig_io.c
CommitLineData
c995fe94
ADG		 1/**
2@verbatim
3
4Copyright (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
14This 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
16This 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
18You 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
20You shoud 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+----------------------------------------------------------------------------+
71b5f4f1 64| Function Name : INT i_APCI1710_InsnConfigDigitalIO(struct comedi_device *dev, |
790c5541 65| comedi_subdevice *s,comedi_insn *insn,unsigned int *data)|
c995fe94
ADG		 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| BYTE_ b_ModulNbr data[0]: Module number to |
74| configure (0 to 3) |
75| BYTE_ 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| BYTE_ 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
86Activates 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
71b5f4f1 102INT i_APCI1710_InsnConfigDigitalIO(struct comedi_device * dev, comedi_subdevice * s,
790c5541 103 comedi_insn * insn, unsigned int * data)
c995fe94
ADG		 104{
105 BYTE b_ModulNbr, b_ChannelAMode, b_ChannelBMode;
106 BYTE b_MemoryOnOff, b_ConfigType;
107 INT i_ReturnValue = 0;
108 DWORD dw_WriteConfig = 0;
109
110 b_ModulNbr = (BYTE) CR_AREF(insn->chanspec);
111 b_ConfigType = (BYTE) data[0]; // Memory or Init
112 b_ChannelAMode = (BYTE) data[1];
113 b_ChannelBMode = (BYTE) data[2];
114 b_MemoryOnOff = (BYTE) 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 (DWORD) (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
71b5f4f1 250|INT i_APCI1710_InsnReadDigitalIOChlValue(struct comedi_device *dev,comedi_subdevice
790c5541 251*s, comedi_insn *insn,unsigned int *data)
c995fe94
ADG		 252
253+----------------------------------------------------------------------------+
254| Task : Read the status from selected digital I/O digital input|
255| (b_InputChannel) |
256+----------------------------------------------------------------------------|
257
258
259|
260| BYTE_ b_ModulNbr CR_AREF(chanspec) : Selected module number |
261| (0 to 3) |
262| BYTE_ 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 (BYTE_ b_BoardHandle,
292// BYTE_ b_ModulNbr,
293// BYTE_ b_InputChannel,
294//
295// PBYTE_ pb_ChannelStatus)
71b5f4f1 296INT i_APCI1710_InsnReadDigitalIOChlValue(struct comedi_device * dev,
790c5541 297 comedi_subdevice * s, comedi_insn * insn, unsigned int * data)
c995fe94
ADG		 298{
299 INT i_ReturnValue = 0;
300 DWORD dw_StatusReg;
301 BYTE b_ModulNbr, b_InputChannel;
302 PBYTE pb_ChannelStatus;
303 b_ModulNbr = (BYTE) CR_AREF(insn->chanspec);
304 b_InputChannel = (BYTE) CR_CHAN(insn->chanspec);
305 data[0] = 0;
306 pb_ChannelStatus = (PBYTE) & 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 //INPDW (ps_APCI1710Variable->
391 // s_Board [b_BoardHandle].
392 // s_BoardInfos.
393 // ui_Address + (64 * b_ModulNbr),
394 // &dw_StatusReg);
395
396 dw_StatusReg =
397 inl(devpriv->
398 s_BoardInfos.
399 ui_Address +
400 (64 * b_ModulNbr));
401
402 *pb_ChannelStatus =
403 (BYTE) ((dw_StatusReg ^
404 0x1C) >>
405 b_InputChannel) & 1;
406
407 } // if (i_ReturnValue == 0)
408 } else {
409 /*******************************/
410 /* Digital I/O not initialised */
411 /*******************************/
412 DPRINTK("Digital I/O not initialised\n");
413 i_ReturnValue = -5;
414 }
415 } else {
416 /********************************/
417 /* Selected digital input error */
418 /********************************/
419 DPRINTK("Selected digital input error\n");
420 i_ReturnValue = -4;
421 }
422 } else {
423 /******************************************/
424 /* The module is not a digital I/O module */
425 /******************************************/
426 DPRINTK("The module is not a digital I/O module\n");
427 i_ReturnValue = -3;
428 }
429 } else {
430 /***********************/
431 /* Module number error */
432 /***********************/
433 DPRINTK("Module number error\n");
434 i_ReturnValue = -2;
435 }
436
437 return (i_ReturnValue);
438}
439
440/*
441+----------------------------------------------------------------------------+
442| OUTPUT FUNCTIONS |
443+----------------------------------------------------------------------------+
444*/
445
446/*
447+----------------------------------------------------------------------------+
448| Function Name : INT i_APCI1710_InsnWriteDigitalIOChlOnOff(comedi_device
790c5541 449|*dev,comedi_subdevice *s,comedi_insn *insn,unsigned int *data)
c995fe94
ADG		 450
451+----------------------------------------------------------------------------+
452| Task : Sets or resets the output witch has been passed with the |
453| parameter b_Channel. Setting an output means setting |
454| an ouput high. |
455+----------------------------------------------------------------------------+
456| Input Parameters : BYTE_ b_BoardHandle : Handle of board APCI-1710 |
457| BYTE_ b_ModulNbr (aref ) : Selected module number (0 to 3)|
458| BYTE_ b_OutputChannel (CR_CHAN) : Selection from digital output |
459| channel (0 to 2) |
460| 0 : Channel H |
461| 1 : Channel A |
462| 2 : Channel B |
463+----------------------------------------------------------------------------+
464| Output Parameters : - |
465+----------------------------------------------------------------------------+
466| Return Value : 0: No error |
467| -1: The handle parameter of the board is wrong |
468| -2: The module parameter is wrong |
469| -3: The module is not a digital I/O module |
470| -4: The selected digital output is wrong |
471| -5: digital I/O not initialised see function |
472| " i_APCI1710_InitDigitalIO" |
473| -6: The digital channel A is used for input |
474| -7: The digital channel B is used for input
475 -8: Digital Output Memory OFF. |
476| Use previously the function |
477| "i_APCI1710_SetDigitalIOMemoryOn". |
478+----------------------------------------------------------------------------+
479*/
480
481//_INT_ i_APCI1710_SetDigitalIOChlOn (BYTE_ b_BoardHandle,
482// BYTE_ b_ModulNbr,
483// BYTE_ b_OutputChannel)
71b5f4f1 484INT i_APCI1710_InsnWriteDigitalIOChlOnOff(struct comedi_device * dev,
790c5541 485 comedi_subdevice * s, comedi_insn * insn, unsigned int * data)
c995fe94
ADG		 486{
487 INT i_ReturnValue = 0;
488 DWORD dw_WriteValue = 0;
489 BYTE 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.
645 // ui_Address + (64 * b_ModulNbr),
646 // dw_WriteValue);
647 outl(dw_WriteValue,
648 devpriv->s_BoardInfos.
649 ui_Address + (64 * b_ModulNbr));
650 }
651 } else {
652 /*******************************/
653 /* Digital I/O not initialised */
654 /*******************************/
655
656 i_ReturnValue = -5;
657 }
658 } else {
659 /******************************************/
660 /* The module is not a digital I/O module */
661 /******************************************/
662
663 i_ReturnValue = -3;
664 }
665 } else {
666 /***********************/
667 /* Module number error */
668 /***********************/
669
670 i_ReturnValue = -2;
671 }
672
673 return (i_ReturnValue);
674}
675
676/*
677+----------------------------------------------------------------------------+
678
71b5f4f1 679|INT i_APCI1710_InsnBitsDigitalIOPortOnOff(struct comedi_device *dev,comedi_subdevice
790c5541 680 *s, comedi_insn *insn,unsigned int *data)
c995fe94
ADG		 681+----------------------------------------------------------------------------+
682| Task : write:
683 Sets or resets one or several outputs from port. |
684| Setting an output means setting an output high. |
685| If you have switched OFF the digital output memory |
686| (OFF), all the other output are set to "0".
687
688| read:
689 Read the status from digital input port |
690| from selected digital I/O module (b_ModulNbr)
691+----------------------------------------------------------------------------+
692| Input Parameters :
693 BYTE_ b_BoardHandle : Handle of board APCI-1710 |
694| BYTE_ b_ModulNbr CR_AREF(aref) : Selected module number (0 to 3)|
695| BYTE_ b_PortValue CR_CHAN(chanspec) : Output Value ( 0 To 7 )
696| data[0] read or write port
697 data[1] if write then indicate ON or OFF
698
699 if read : data[1] will return port status.
700+----------------------------------------------------------------------------+
701| Output Parameters : - |
702+----------------------------------------------------------------------------+
703| Return Value :
704
705 INPUT :
706
707 0: No error |
708| -1: The handle parameter of the board is wrong |
709| -2: The module parameter is wrong |
710| -3: The module is not a digital I/O module |
711| -4: Digital I/O not initialised
712
713 OUTPUT: 0: No error |
714| -1: The handle parameter of the board is wrong |
715| -2: The module parameter is wrong |
716| -3: The module is not a digital I/O module |
717| -4: Output value wrong |
718| -5: digital I/O not initialised see function |
719| " i_APCI1710_InitDigitalIO" |
720| -6: The digital channel A is used for input |
721| -7: The digital channel B is used for input
722 -8: Digital Output Memory OFF. |
723| Use previously the function |
724| "i_APCI1710_SetDigitalIOMemoryOn". |
725+----------------------------------------------------------------------------+
726*/
727
728//_INT_ i_APCI1710_SetDigitalIOPortOn (BYTE_ b_BoardHandle,
729// BYTE_ b_ModulNbr,
730// BYTE_ b_PortValue)
71b5f4f1 731INT i_APCI1710_InsnBitsDigitalIOPortOnOff(struct comedi_device * dev,
790c5541 732 comedi_subdevice * s, comedi_insn * insn, unsigned int * data)
c995fe94
ADG		 733{
734 INT i_ReturnValue = 0;
735 DWORD dw_WriteValue = 0;
736 DWORD dw_StatusReg;
737 BYTE b_ModulNbr, b_PortValue;
738 BYTE b_PortOperation, b_PortOnOFF;
739
740 PBYTE pb_PortValue;
741
742 b_ModulNbr = (BYTE) CR_AREF(insn->chanspec);
743 b_PortOperation = (BYTE) data[0]; // Input or output
744 b_PortOnOFF = (BYTE) data[1]; // if output then On or Off
745 b_PortValue = (BYTE) data[2]; // if out put then Value
746 i_ReturnValue = insn->n;
747 pb_PortValue = (PBYTE) & data[0];
748// if input then read value
749
750 switch (b_PortOperation) {
751 case APCI1710_INPUT:
752 /**************************/
753 /* Test the module number */
754 /**************************/
755
756 if (b_ModulNbr < 4) {
757 /*******************************/
758 /* Test if digital I/O counter */
759 /*******************************/
760
761 if ((devpriv->s_BoardInfos.
762 dw_MolduleConfiguration[b_ModulNbr] &
763 0xFFFF0000UL) == APCI1710_DIGITAL_IO) {
764 /**********************************************/
765 /* Test if the digital I/O module initialised */
766 /**********************************************/
767
768 if (devpriv->s_ModuleInfo[b_ModulNbr].
769 s_DigitalIOInfo.b_DigitalInit == 1) {
770 /**************************/
771 /* Read all digital input */
772 /**************************/
773
774 //INPDW (ps_APCI1710Variable->
775 // s_Board [b_BoardHandle].
776 // s_BoardInfos.
777 // ui_Address + (64 * b_ModulNbr),
778 // &dw_StatusReg);
779
780 dw_StatusReg =
781 inl(devpriv->s_BoardInfos.
782 ui_Address + (64 * b_ModulNbr));
783 *pb_PortValue =
784 (BYTE) (dw_StatusReg ^ 0x1C);
785
786 } else {
787 /*******************************/
788 /* Digital I/O not initialised */
789 /*******************************/
790
791 i_ReturnValue = -4;
792 }
793 } else {
794 /******************************************/
795 /* The module is not a digital I/O module */
796 /******************************************/
797
798 i_ReturnValue = -3;
799 }
800 } else {
801 /***********************/
802 /* Module number error */
803 /***********************/
804
805 i_ReturnValue = -2;
806 }
807
808 break;
809
810 case APCI1710_OUTPUT:
811 /**************************/
812 /* Test the module number */
813 /**************************/
814
815 if (b_ModulNbr < 4) {
816 /*******************************/
817 /* Test if digital I/O counter */
818 /*******************************/
819
820 if ((devpriv->s_BoardInfos.
821 dw_MolduleConfiguration[b_ModulNbr] &
822 0xFFFF0000UL) == APCI1710_DIGITAL_IO) {
823 /**********************************************/
824 /* Test if the digital I/O module initialised */
825 /**********************************************/
826
827 if (devpriv->s_ModuleInfo[b_ModulNbr].
828 s_DigitalIOInfo.b_DigitalInit == 1) {
829 /***********************/
830 /* Test the port value */
831 /***********************/
832
833 if (b_PortValue <= 7) {
834 /***********************************/
835 /* Test the digital output channel */
836 /***********************************/
837
838 /**************************/
839 /* Test if channel A used */
840 /**************************/
841
842 if ((b_PortValue & 2) == 2) {
843 if (devpriv->
844 s_ModuleInfo
845 [b_ModulNbr].
846 s_DigitalIOInfo.
847 b_ChannelAMode
848 != 1) {
849 /*******************************************/
850 /* The digital channel A is used for input */
851 /*******************************************/
852
853 i_ReturnValue =
854 -6;
855 }
856 } // if ((b_PortValue & 2) == 2)
857
858 /**************************/
859 /* Test if channel B used */
860 /**************************/
861
862 if ((b_PortValue & 4) == 4) {
863 if (devpriv->
864 s_ModuleInfo
865 [b_ModulNbr].
866 s_DigitalIOInfo.
867 b_ChannelBMode
868 != 1) {
869 /*******************************************/
870 /* The digital channel B is used for input */
871 /*******************************************/
872
873 i_ReturnValue =
874 -7;
875 }
876 } // if ((b_PortValue & 4) == 4)
877
878 /***********************/
879 /* Test if error occur */
880 /***********************/
881
882 if (i_ReturnValue >= 0) {
883
884 //if(data[1])
885 //{
886 switch (b_PortOnOFF) {
887 /*********************************/
888 /* Test if set Port ON */
889 /*********************************/
890
891 case APCI1710_ON:
892
893 /*********************************/
894 /* Test if output memory enabled */
895 /*********************************/
896
897 if (devpriv->
898 s_ModuleInfo
899 [b_ModulNbr].
900 s_DigitalIOInfo.
901 b_OutputMemoryEnabled
902 == 1) {
903 dw_WriteValue
904 =
905 devpriv->
906 s_ModuleInfo
907 [b_ModulNbr].
908 s_DigitalIOInfo.
909 dw_OutputMemory
910 |
911 b_PortValue;
912
913 devpriv->
914 s_ModuleInfo
915 [b_ModulNbr].
916 s_DigitalIOInfo.
917 dw_OutputMemory
918 =
919 dw_WriteValue;
920 } else {
921 dw_WriteValue
922 =
923 b_PortValue;
924 }
925 break;
926
927 // If Set PORT OFF
928 case APCI1710_OFF:
929
930 /*********************************/
931 /* Test if output memory enabled */
932 /*********************************/
933
934 if (devpriv->
935 s_ModuleInfo
936 [b_ModulNbr].
937 s_DigitalIOInfo.
938 b_OutputMemoryEnabled
939 == 1) {
940 dw_WriteValue
941 =
942 devpriv->
943 s_ModuleInfo
944 [b_ModulNbr].
945 s_DigitalIOInfo.
946 dw_OutputMemory
947 &
948 (0xFFFFFFFFUL
949 -
950 b_PortValue);
951
952 devpriv->
953 s_ModuleInfo
954 [b_ModulNbr].
955 s_DigitalIOInfo.
956 dw_OutputMemory
957 =
958 dw_WriteValue;
959 } else {
960 /*****************************/
961 /* Digital Output Memory OFF */
962 /*****************************/
963
964 i_ReturnValue
965 =
966 -8;
967 }
968 } // switch
969
970 /*******************/
971 /* Write the value */
972 /*******************/
973
974 // OUTPDW (ps_APCI1710Variable->
975 // s_Board [b_BoardHandle].
976 // s_BoardInfos.
977 // ui_Address + (64 * b_ModulNbr),
978 // dw_WriteValue);
979 outl(dw_WriteValue,
980 devpriv->
981 s_BoardInfos.
982 ui_Address +
983 (64 * b_ModulNbr));
984 }
985 } else {
986 /**********************/
987 /* Output value wrong */
988 /**********************/
989
990 i_ReturnValue = -4;
991 }
992 } else {
993 /*******************************/
994 /* Digital I/O not initialised */
995 /*******************************/
996
997 i_ReturnValue = -5;
998 }
999 } else {
1000 /******************************************/
1001 /* The module is not a digital I/O module */
1002 /******************************************/
1003
1004 i_ReturnValue = -3;
1005 }
1006 } else {
1007 /***********************/
1008 /* Module number error */
1009 /***********************/
1010
1011 i_ReturnValue = -2;
1012 }
1013 break;
1014
1015 default:
1016 i_ReturnValue = -9;
1017 DPRINTK("NO INPUT/OUTPUT specified\n");
1018 } //switch INPUT / OUTPUT
1019 return (i_ReturnValue);
1020}
Clone of davem's net-next-2.6 tree