?  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_Ssi.c
blob6360de59e0e98b6844046eebd2b12e172f955ac7
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 : SSI.C | Version : 2.96 |
34 +-------------------------------+---------------------------------------+
35 | Project manager: Eric Stolz | Date : 02/12/2002 |
36 +-----------------------------------------------------------------------+
37 | Description : APCI-1710 SSI counter module |
38 | |
39 | |
40 +-----------------------------------------------------------------------+
41 | UPDATES |
42 +-----------------------------------------------------------------------+
43 | Date | Author | Description of updates |
44 +----------+-----------+------------------------------------------------+
45 | 13/05/98 | S. Weber | SSI digital input / output implementation |
46 |----------|-----------|------------------------------------------------|
47 | 22/03/00 | C.Guinot | 0100/0226 -> 0200/0227 |
48 | | | Änderung in InitSSI Funktion |
49 | | | b_SSIProfile >= 2 anstatt b_SSIProfile > 2 |
50 | | | |
51 +-----------------------------------------------------------------------+
52 | 08/05/00 | Guinot C | - 0400/0228 All Function in RING 0 |
53 | | | available |
54 +-----------------------------------------------------------------------+
55 */
56
57 /*
58 +----------------------------------------------------------------------------+
59 | Included files |
60 +----------------------------------------------------------------------------+
61 */
62
63 #include "APCI1710_Ssi.h"
64
65 /*
66 +----------------------------------------------------------------------------+
67 | Function Name : _INT_ i_APCI1710_InitSSI |
68 | (unsigned char_ b_BoardHandle, |
69 | unsigned char_ b_ModulNbr, |
70 | unsigned char_ b_SSIProfile, |
71 | unsigned char_ b_PositionTurnLength, |
72 | unsigned char_ b_TurnCptLength, |
73 | unsigned char_ b_PCIInputClock, |
74 | ULONG_ ul_SSIOutputClock, |
75 | unsigned char_ b_SSICountingMode) |
76 +----------------------------------------------------------------------------+
77 | Task : Configure the SSI operating mode from selected module |
78 | (b_ModulNbr). You must calling this function be for you|
79 | call any other function witch access of SSI. |
80 +----------------------------------------------------------------------------+
81 | Input Parameters : unsigned char_ b_BoardHandle : Handle of board APCI-1710|
82 | unsigned char_ b_ModulNbr : Module number to |
83 | configure (0 to 3) |
84 | unsigned char_ b_SSIProfile : Selection from SSI |
85 | profile length (2 to 32).|
86 | unsigned char_ b_PositionTurnLength : Selection from SSI |
87 | position data length |
88 | (1 to 31). |
89 | unsigned char_ b_TurnCptLength : Selection from SSI turn |
90 | counter data length |
91 | (1 to 31). |
92 | unsigned char b_PCIInputClock : Selection from PCI bus |
93 | clock |
94 | - APCI1710_30MHZ : |
95 | The PC have a PCI bus |
96 | clock from 30 MHz |
97 | - APCI1710_33MHZ : |
98 | The PC have a PCI bus |
99 | clock from 33 MHz |
100 | ULONG_ ul_SSIOutputClock : Selection from SSI output|
101 | clock. |
102 | From 229 to 5 000 000 Hz|
103 | for 30 MHz selection. |
104 | From 252 to 5 000 000 Hz|
105 | for 33 MHz selection. |
106 | unsigned char b_SSICountingMode : SSI counting mode |
107 | selection |
108 | - APCI1710_BINARY_MODE : |
109 | Binary counting mode. |
110 | - APCI1710_GRAY_MODE : |
111 | Gray counting mode.
112
113 b_ModulNbr = CR_AREF(insn->chanspec);
114 b_SSIProfile = (unsigned char) data[0];
115 b_PositionTurnLength= (unsigned char) data[1];
116 b_TurnCptLength = (unsigned char) data[2];
117 b_PCIInputClock = (unsigned char) data[3];
118 ul_SSIOutputClock = (unsigned int) data[4];
119 b_SSICountingMode = (unsigned char) data[5]; |
120 +----------------------------------------------------------------------------+
121 | Output Parameters : - |
122 +----------------------------------------------------------------------------+
123 | Return Value : 0: No error |
124 | -1: The handle parameter of the board is wrong |
125 | -2: The module parameter is wrong |
126 | -3: The module is not a SSI module |
127 | -4: The selected SSI profile length is wrong |
128 | -5: The selected SSI position data length is wrong |
129 | -6: The selected SSI turn counter data length is wrong |
130 | -7: The selected PCI input clock is wrong |
131 | -8: The selected SSI output clock is wrong |
132 | -9: The selected SSI counting mode parameter is wrong |
133 +----------------------------------------------------------------------------+
134 */
135
136 int i_APCI1710_InsnConfigInitSSI(struct comedi_device *dev, struct comedi_subdevice *s,
137 struct comedi_insn *insn, unsigned int *data)
138 {
139 int i_ReturnValue = 0;
140 unsigned int ui_TimerValue;
141 unsigned char b_ModulNbr, b_SSIProfile, b_PositionTurnLength, b_TurnCptLength,
142 b_PCIInputClock, b_SSICountingMode;
143 unsigned int ul_SSIOutputClock;
144
145 b_ModulNbr = CR_AREF(insn->chanspec);
146 b_SSIProfile = (unsigned char) data[0];
147 b_PositionTurnLength = (unsigned char) data[1];
148 b_TurnCptLength = (unsigned char) data[2];
149 b_PCIInputClock = (unsigned char) data[3];
150 ul_SSIOutputClock = (unsigned int) data[4];
151 b_SSICountingMode = (unsigned char) data[5];
152
153 i_ReturnValue = insn->n;
154 /**************************/
155 /* Test the module number */
156 /**************************/
157
158 if (b_ModulNbr < 4) {
159 /***********************/
160 /* Test if SSI counter */
161 /***********************/
162
163 if ((devpriv->s_BoardInfos.
164 dw_MolduleConfiguration[b_ModulNbr] &
165 0xFFFF0000UL) == APCI1710_SSI_COUNTER) {
166 /*******************************/
167 /* Test the SSI profile length */
168 /*******************************/
169
170 /* CG 22/03/00 b_SSIProfile >= 2 anstatt b_SSIProfile > 2 */
171 if (b_SSIProfile >= 2 && b_SSIProfile < 33) {
172 /*************************************/
173 /* Test the SSI position data length */
174 /*************************************/
175
176 if (b_PositionTurnLength > 0
177 && b_PositionTurnLength < 32) {
178 /*****************************************/
179 /* Test the SSI turn counter data length */
180 /*****************************************/
181
182 if (b_TurnCptLength > 0
183 && b_TurnCptLength < 32) {
184 /***************************/
185 /* Test the profile length */
186 /***************************/
187
188 if ((b_TurnCptLength +
189 b_PositionTurnLength)
190 <= b_SSIProfile) {
191 /****************************/
192 /* Test the PCI input clock */
193 /****************************/
194
195 if (b_PCIInputClock ==
196 APCI1710_30MHZ
197 ||
198 b_PCIInputClock
199 ==
200 APCI1710_33MHZ)
201 {
202 /*************************/
203 /* Test the output clock */
204 /*************************/
205
206 if ((b_PCIInputClock == APCI1710_30MHZ && (ul_SSIOutputClock > 228 && ul_SSIOutputClock <= 5000000UL)) || (b_PCIInputClock == APCI1710_33MHZ && (ul_SSIOutputClock > 251 && ul_SSIOutputClock <= 5000000UL))) {
207 if (b_SSICountingMode == APCI1710_BINARY_MODE || b_SSICountingMode == APCI1710_GRAY_MODE) {
208 /**********************/
209 /* Save configuration */
210 /**********************/
211 devpriv->
212 s_ModuleInfo
213 [b_ModulNbr].
214 s_SSICounterInfo.
215 b_SSIProfile
216 =
217 b_SSIProfile;
218
219 devpriv->
220 s_ModuleInfo
221 [b_ModulNbr].
222 s_SSICounterInfo.
223 b_PositionTurnLength
224 =
225 b_PositionTurnLength;
226
227 devpriv->
228 s_ModuleInfo
229 [b_ModulNbr].
230 s_SSICounterInfo.
231 b_TurnCptLength
232 =
233 b_TurnCptLength;
234
235 /*********************************/
236 /* Initialise the profile length */
237 /*********************************/
238
239 if (b_SSICountingMode == APCI1710_BINARY_MODE) {
240
241 outl(b_SSIProfile + 1, devpriv->s_BoardInfos.ui_Address + 4 + (64 * b_ModulNbr));
242 } else {
243
244 outl(b_SSIProfile, devpriv->s_BoardInfos.ui_Address + 4 + (64 * b_ModulNbr));
245 }
246
247 /******************************/
248 /* Calculate the output clock */
249 /******************************/
250
251 ui_TimerValue
252 =
253 (unsigned int)
254 (
255 ((unsigned int) (b_PCIInputClock) * 500000UL) / ul_SSIOutputClock);
256
257 /************************/
258 /* Initialise the timer */
259 /************************/
260
261 outl(ui_TimerValue, devpriv->s_BoardInfos.ui_Address + (64 * b_ModulNbr));
262
263 /********************************/
264 /* Initialise the counting mode */
265 /********************************/
266
267 outl(7 * b_SSICountingMode, devpriv->s_BoardInfos.ui_Address + 12 + (64 * b_ModulNbr));
268
269 devpriv->
270 s_ModuleInfo
271 [b_ModulNbr].
272 s_SSICounterInfo.
273 b_SSIInit
274 =
275 1;
276 } else {
277 /*****************************************************/
278 /* The selected SSI counting mode parameter is wrong */
279 /*****************************************************/
280
281 DPRINTK("The selected SSI counting mode parameter is wrong\n");
282 i_ReturnValue
283 =
284 -9;
285 }
286 } else {
287 /******************************************/
288 /* The selected SSI output clock is wrong */
289 /******************************************/
290
291 DPRINTK("The selected SSI output clock is wrong\n");
292 i_ReturnValue
293 =
294 -8;
295 }
296 } else {
297 /*****************************************/
298 /* The selected PCI input clock is wrong */
299 /*****************************************/
300
301 DPRINTK("The selected PCI input clock is wrong\n");
302 i_ReturnValue =
303 -7;
304 }
305 } else {
306 /********************************************/
307 /* The selected SSI profile length is wrong */
308 /********************************************/
309
310 DPRINTK("The selected SSI profile length is wrong\n");
311 i_ReturnValue = -4;
312 }
313 } else {
314 /******************************************************/
315 /* The selected SSI turn counter data length is wrong */
316 /******************************************************/
317
318 DPRINTK("The selected SSI turn counter data length is wrong\n");
319 i_ReturnValue = -6;
320 }
321 } else {
322 /**************************************************/
323 /* The selected SSI position data length is wrong */
324 /**************************************************/
325
326 DPRINTK("The selected SSI position data length is wrong\n");
327 i_ReturnValue = -5;
328 }
329 } else {
330 /********************************************/
331 /* The selected SSI profile length is wrong */
332 /********************************************/
333
334 DPRINTK("The selected SSI profile length is wrong\n");
335 i_ReturnValue = -4;
336 }
337 } else {
338 /**********************************/
339 /* The module is not a SSI module */
340 /**********************************/
341
342 DPRINTK("The module is not a SSI module\n");
343 i_ReturnValue = -3;
344 }
345 } else {
346 /***********************/
347 /* Module number error */
348 /***********************/
349
350 DPRINTK("Module number error\n");
351 i_ReturnValue = -2;
352 }
353
354 return i_ReturnValue;
355 }
356
357 /*
358 +----------------------------------------------------------------------------+
359 | Function Name : _INT_ i_APCI1710_Read1SSIValue |
360 | (unsigned char_ b_BoardHandle, |
361 | unsigned char_ b_ModulNbr, |
362 | unsigned char_ b_SelectedSSI, |
363 | PULONG_ pul_Position, |
364 | PULONG_ pul_TurnCpt)
365 int i_APCI1710_ReadSSIValue(struct comedi_device *dev,struct comedi_subdevice *s,
366 struct comedi_insn *insn,unsigned int *data) |
367 +----------------------------------------------------------------------------+
368 | Task :
369
370
371 Read the selected SSI counter (b_SelectedSSI) from |
372 | selected module (b_ModulNbr).
373 or Read all SSI counter (b_SelectedSSI) from |
374 | selected module (b_ModulNbr). |
375 +----------------------------------------------------------------------------+
376 | Input Parameters : unsigned char_ b_BoardHandle : Handle of board APCI-1710|
377 | unsigned char_ b_ModulNbr : Module number to |
378 | configure (0 to 3) |
379 | unsigned char_ b_SelectedSSI : Selection from SSI |
380 | counter (0 to 2)
381
382 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
383 b_SelectedSSI = (unsigned char) CR_CHAN(insn->chanspec); (in case of single ssi)
384 b_ReadType = (unsigned char) CR_RANGE(insn->chanspec);
385 |
386 +----------------------------------------------------------------------------+
387 | Output Parameters : PULONG_ pul_Position : SSI position in the turn |
388 | PULONG_ pul_TurnCpt : Number of turns
389
390 pul_Position = (unsigned int *) &data[0];
391 pul_TurnCpt = (unsigned int *) &data[1]; |
392 +----------------------------------------------------------------------------+
393 | Return Value : 0: No error |
394 | -1: The handle parameter of the board is wrong |
395 | -2: The module parameter is wrong |
396 | -3: The module is not a SSI module |
397 | -4: SSI not initialised see function |
398 | "i_APCI1710_InitSSI" |
399 | -5: The selected SSI is wrong |
400 +----------------------------------------------------------------------------+
401 */
402
403 int i_APCI1710_InsnReadSSIValue(struct comedi_device *dev, struct comedi_subdevice *s,
404 struct comedi_insn *insn, unsigned int *data)
405 {
406 int i_ReturnValue = 0;
407 unsigned char b_Cpt;
408 unsigned char b_Length;
409 unsigned char b_Schift;
410 unsigned char b_SSICpt;
411 unsigned int dw_And;
412 unsigned int dw_And1;
413 unsigned int dw_And2;
414 unsigned int dw_StatusReg;
415 unsigned int dw_CounterValue;
416 unsigned char b_ModulNbr;
417 unsigned char b_SelectedSSI;
418 unsigned char b_ReadType;
419 unsigned int *pul_Position;
420 unsigned int *pul_TurnCpt;
421 unsigned int *pul_Position1;
422 unsigned int *pul_TurnCpt1;
423
424 i_ReturnValue = insn->n;
425 pul_Position1 = (unsigned int *) &data[0];
426 /* For Read1 */
427 pul_TurnCpt1 = (unsigned int *) &data[1];
428 /* For Read all */
429 pul_Position = (unsigned int *) &data[0]; /* 0-2 */
430 pul_TurnCpt = (unsigned int *) &data[3]; /* 3-5 */
431 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
432 b_SelectedSSI = (unsigned char) CR_CHAN(insn->chanspec);
433 b_ReadType = (unsigned char) CR_RANGE(insn->chanspec);
434
435 /**************************/
436 /* Test the module number */
437 /**************************/
438
439 if (b_ModulNbr < 4) {
440 /***********************/
441 /* Test if SSI counter */
442 /***********************/
443
444 if ((devpriv->s_BoardInfos.
445 dw_MolduleConfiguration[b_ModulNbr] &
446 0xFFFF0000UL) == APCI1710_SSI_COUNTER) {
447 /***************************/
448 /* Test if SSI initialised */
449 /***************************/
450
451 if (devpriv->s_ModuleInfo[b_ModulNbr].
452 s_SSICounterInfo.b_SSIInit == 1) {
453
454 switch (b_ReadType) {
455
456 case APCI1710_SSI_READ1VALUE:
457 /****************************************/
458 /* Test the selected SSI counter number */
459 /****************************************/
460
461 if (b_SelectedSSI < 3) {
462 /************************/
463 /* Start the conversion */
464 /************************/
465
466 outl(0, devpriv->s_BoardInfos.
467 ui_Address + 8 +
468 (64 * b_ModulNbr));
469
470 do {
471 /*******************/
472 /* Read the status */
473 /*******************/
474
475 dw_StatusReg =
476 inl(devpriv->
477 s_BoardInfos.
478 ui_Address +
479 (64 * b_ModulNbr));
480 } while ((dw_StatusReg & 0x1)
481 != 0);
482
483 /******************************/
484 /* Read the SSI counter value */
485 /******************************/
486
487 dw_CounterValue =
488 inl(devpriv->
489 s_BoardInfos.
490 ui_Address + 4 +
491 (b_SelectedSSI * 4) +
492 (64 * b_ModulNbr));
493
494 b_Length =
495 devpriv->
496 s_ModuleInfo
497 [b_ModulNbr].
498 s_SSICounterInfo.
499 b_SSIProfile / 2;
500
501 if ((b_Length * 2) !=
502 devpriv->
503 s_ModuleInfo
504 [b_ModulNbr].
505 s_SSICounterInfo.
506 b_SSIProfile) {
507 b_Length++;
508 }
509
510 b_Schift =
511 b_Length -
512 devpriv->
513 s_ModuleInfo
514 [b_ModulNbr].
515 s_SSICounterInfo.
516 b_PositionTurnLength;
517
518 *pul_Position1 =
519 dw_CounterValue >>
520 b_Schift;
521
522 dw_And = 1;
523
524 for (b_Cpt = 0;
525 b_Cpt <
526 devpriv->
527 s_ModuleInfo
528 [b_ModulNbr].
529 s_SSICounterInfo.
530 b_PositionTurnLength;
531 b_Cpt++) {
532 dw_And = dw_And * 2;
533 }
534
535 *pul_Position1 =
536 *pul_Position1 &
537 ((dw_And) - 1);
538
539 *pul_TurnCpt1 =
540 dw_CounterValue >>
541 b_Length;
542
543 dw_And = 1;
544
545 for (b_Cpt = 0;
546 b_Cpt <
547 devpriv->
548 s_ModuleInfo
549 [b_ModulNbr].
550 s_SSICounterInfo.
551 b_TurnCptLength;
552 b_Cpt++) {
553 dw_And = dw_And * 2;
554 }
555
556 *pul_TurnCpt1 =
557 *pul_TurnCpt1 &
558 ((dw_And) - 1);
559 } else {
560 /*****************************/
561 /* The selected SSI is wrong */
562 /*****************************/
563
564 DPRINTK("The selected SSI is wrong\n");
565 i_ReturnValue = -5;
566 }
567 break;
568
569 case APCI1710_SSI_READALLVALUE:
570 dw_And1 = 1;
571
572 for (b_Cpt = 0;
573 b_Cpt <
574 devpriv->
575 s_ModuleInfo[b_ModulNbr].
576 s_SSICounterInfo.
577 b_PositionTurnLength; b_Cpt++) {
578 dw_And1 = dw_And1 * 2;
579 }
580
581 dw_And2 = 1;
582
583 for (b_Cpt = 0;
584 b_Cpt <
585 devpriv->
586 s_ModuleInfo[b_ModulNbr].
587 s_SSICounterInfo.
588 b_TurnCptLength; b_Cpt++) {
589 dw_And2 = dw_And2 * 2;
590 }
591
592 /************************/
593 /* Start the conversion */
594 /************************/
595
596 outl(0, devpriv->s_BoardInfos.
597 ui_Address + 8 +
598 (64 * b_ModulNbr));
599
600 do {
601 /*******************/
602 /* Read the status */
603 /*******************/
604
605 dw_StatusReg =
606 inl(devpriv->
607 s_BoardInfos.
608 ui_Address +
609 (64 * b_ModulNbr));
610 } while ((dw_StatusReg & 0x1) != 0);
611
612 for (b_SSICpt = 0; b_SSICpt < 3;
613 b_SSICpt++) {
614 /******************************/
615 /* Read the SSI counter value */
616 /******************************/
617
618 dw_CounterValue =
619 inl(devpriv->
620 s_BoardInfos.
621 ui_Address + 4 +
622 (b_SSICpt * 4) +
623 (64 * b_ModulNbr));
624
625 b_Length =
626 devpriv->
627 s_ModuleInfo
628 [b_ModulNbr].
629 s_SSICounterInfo.
630 b_SSIProfile / 2;
631
632 if ((b_Length * 2) !=
633 devpriv->
634 s_ModuleInfo
635 [b_ModulNbr].
636 s_SSICounterInfo.
637 b_SSIProfile) {
638 b_Length++;
639 }
640
641 b_Schift =
642 b_Length -
643 devpriv->
644 s_ModuleInfo
645 [b_ModulNbr].
646 s_SSICounterInfo.
647 b_PositionTurnLength;
648
649 pul_Position[b_SSICpt] =
650 dw_CounterValue >>
651 b_Schift;
652 pul_Position[b_SSICpt] =
653 pul_Position[b_SSICpt] &
654 ((dw_And1) - 1);
655
656 pul_TurnCpt[b_SSICpt] =
657 dw_CounterValue >>
658 b_Length;
659 pul_TurnCpt[b_SSICpt] =
660 pul_TurnCpt[b_SSICpt] &
661 ((dw_And2) - 1);
662 }
663 break;
664
665 default:
666 printk("Read Type Inputs Wrong\n");
667
668 } /* switch ending */
669
670 } else {
671 /***********************/
672 /* SSI not initialised */
673 /***********************/
674
675 DPRINTK("SSI not initialised\n");
676 i_ReturnValue = -4;
677 }
678 } else {
679 /**********************************/
680 /* The module is not a SSI module */
681 /**********************************/
682
683 DPRINTK("The module is not a SSI module\n");
684 i_ReturnValue = -3;
685
686 }
687 } else {
688 /***********************/
689 /* Module number error */
690 /***********************/
691
692 DPRINTK("Module number error\n");
693 i_ReturnValue = -2;
694 }
695
696 return i_ReturnValue;
697 }
698
699 /*
700 +----------------------------------------------------------------------------+
701 | Function Name : _INT_ i_APCI1710_ReadSSI1DigitalInput |
702 | (unsigned char_ b_BoardHandle, |
703 | unsigned char_ b_ModulNbr, |
704 | unsigned char_ b_InputChannel, |
705 | unsigned char *_ pb_ChannelStatus) |
706 +----------------------------------------------------------------------------+
707 | Task :
708 (0) Set the digital output from selected SSI moule |
709 | (b_ModuleNbr) ON
710 (1) Set the digital output from selected SSI moule |
711 | (b_ModuleNbr) OFF
712 (2)Read the status from selected SSI digital input |
713 | (b_InputChannel)
714 (3)Read the status from all SSI digital inputs from |
715 | selected SSI module (b_ModulNbr) |
716 +----------------------------------------------------------------------------+
717 | Input Parameters : unsigned char_ b_BoardHandle : Handle of board APCI-1710|
718 | unsigned char_ b_ModulNbr CR_AREF : Module number to |
719 | configure (0 to 3) |
720 | unsigned char_ b_InputChannel CR_CHAN : Selection from digital |
721 | data[0] which IOTYPE input ( 0 to 2) |
722 +----------------------------------------------------------------------------+
723 | Output Parameters : unsigned char *_ pb_ChannelStatus : Digital input channel |
724 | data[0] status |
725 | 0 : Channle is not active|
726 | 1 : Channle is active |
727 +----------------------------------------------------------------------------+
728 | Return Value : 0: No error |
729 | -1: The handle parameter of the board is wrong |
730 | -2: The module parameter is wrong |
731 | -3: The module is not a SSI module |
732 | -4: The selected SSI digital input is wrong |
733 +----------------------------------------------------------------------------+
734 */
735
736 int i_APCI1710_InsnBitsSSIDigitalIO(struct comedi_device *dev, struct comedi_subdevice *s,
737 struct comedi_insn *insn, unsigned int *data)
738 {
739 int i_ReturnValue = 0;
740 unsigned int dw_StatusReg;
741 unsigned char b_ModulNbr;
742 unsigned char b_InputChannel;
743 unsigned char *pb_ChannelStatus;
744 unsigned char *pb_InputStatus;
745 unsigned char b_IOType;
746 i_ReturnValue = insn->n;
747 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
748 b_IOType = (unsigned char) data[0];
749
750 /**************************/
751 /* Test the module number */
752 /**************************/
753
754 if (b_ModulNbr < 4) {
755 /***********************/
756 /* Test if SSI counter */
757 /***********************/
758
759 if ((devpriv->s_BoardInfos.
760 dw_MolduleConfiguration[b_ModulNbr] &
761 0xFFFF0000UL) == APCI1710_SSI_COUNTER) {
762 switch (b_IOType) {
763 case APCI1710_SSI_SET_CHANNELON:
764 /*****************************/
765 /* Set the digital output ON */
766 /*****************************/
767
768 outl(1, devpriv->s_BoardInfos.ui_Address + 16 +
769 (64 * b_ModulNbr));
770 break;
771
772 case APCI1710_SSI_SET_CHANNELOFF:
773 /******************************/
774 /* Set the digital output OFF */
775 /******************************/
776
777 outl(0, devpriv->s_BoardInfos.ui_Address + 16 +
778 (64 * b_ModulNbr));
779 break;
780
781 case APCI1710_SSI_READ_1CHANNEL:
782 /******************************************/
783 /* Test the digital imnput channel number */
784 /******************************************/
785
786 b_InputChannel = (unsigned char) CR_CHAN(insn->chanspec);
787 pb_ChannelStatus = (unsigned char *) &data[0];
788
789 if (b_InputChannel <= 2) {
790 /**************************/
791 /* Read all digital input */
792 /**************************/
793
794 dw_StatusReg =
795 inl(devpriv->s_BoardInfos.
796 ui_Address + (64 * b_ModulNbr));
797 *pb_ChannelStatus =
798 (unsigned char) (((~dw_StatusReg) >> (4 +
799 b_InputChannel))
800 & 1);
801 } else {
802 /********************************/
803 /* Selected digital input error */
804 /********************************/
805
806 DPRINTK("Selected digital input error\n");
807 i_ReturnValue = -4;
808 }
809 break;
810
811 case APCI1710_SSI_READ_ALLCHANNEL:
812 /**************************/
813 /* Read all digital input */
814 /**************************/
815 pb_InputStatus = (unsigned char *) &data[0];
816
817 dw_StatusReg =
818 inl(devpriv->s_BoardInfos.ui_Address +
819 (64 * b_ModulNbr));
820 *pb_InputStatus =
821 (unsigned char) (((~dw_StatusReg) >> 4) & 7);
822 break;
823
824 default:
825 printk("IO type wrong\n");
826
827 } /* switch end */
828 } else {
829 /**********************************/
830 /* The module is not a SSI module */
831 /**********************************/
832
833 DPRINTK("The module is not a SSI module\n");
834 i_ReturnValue = -3;
835 }
836 } else {
837 /***********************/
838 /* Module number error */
839 /***********************/
840
841 DPRINTK("Module number error\n");
842 i_ReturnValue = -2;
843 }
844
845 return i_ReturnValue;
846 }
Tomato firmware and modifications.