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