?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Staging: comedi: Remove BYTE and *PBYTE typedefs in addi-data
[linux-2.6/linux-2.6-openrd.git] / drivers / staging / comedi / drivers / addi-data / APCI1710_Inp_cpt.c
blob7364cf0759179af0955273e6a07f915b131bf373
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 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 : Inp_CPT.C | Version : 2.96 |
34 +-------------------------------+---------------------------------------+
35 | Project manager: Eric Stolz | Date : 02/12/2002 |
36 +-----------------------------------------------------------------------+
37 | Description : APCI-1710 pulse encoder module |
38 | |
39 | |
40 +-----------------------------------------------------------------------+
41 | UPDATES |
42 +-----------------------------------------------------------------------+
43 | Date | Author | Description of updates |
44 +----------+-----------+------------------------------------------------+
45 | | | |
46 |----------|-----------|------------------------------------------------|
47 | 08/05/00 | Guinot C | - 0400/0228 All Function in RING 0 |
48 | | | available |
49 +-----------------------------------------------------------------------+
50 */
51
52 /*
53 +----------------------------------------------------------------------------+
54 | Included files |
55 +----------------------------------------------------------------------------+
56 */
57
58 #include "APCI1710_Inp_cpt.h"
59
60 /*
61 +----------------------------------------------------------------------------+
62 | Function Name : _INT_ i_APCI1710_InitPulseEncoder |
63 | (unsigned char_ b_BoardHandle, |
64 | unsigned char_ b_ModulNbr, |
65 | unsigned char_ b_PulseEncoderNbr, |
66 | unsigned char_ b_InputLevelSelection, |
67 | unsigned char_ b_TriggerOutputAction, |
68 | ULONG_ ul_StartValue) |
69 +----------------------------------------------------------------------------+
70 | Task : Configure the pulse encoder operating mode selected via|
71 | b_ModulNbr and b_PulseEncoderNbr. The pulse encoder |
72 | after each pulse decrement the counter value from 1. |
73 | |
74 | You must calling this function be for you call any |
75 | other function witch access of pulse encoders. |
76 +----------------------------------------------------------------------------+
77 | Input Parameters : unsigned char_ b_BoardHandle : Handle of board APCI-1710|
78 | unsigned char_ b_ModulNbr : Module number to |
79 | configure (0 to 3) |
80 | unsigned char_ b_PulseEncoderNbr : Pulse encoder selection |
81 | (0 to 3) |
82 | unsigned char_ b_InputLevelSelection : Input level selection |
83 | (0 or 1) |
84 | 0 : Set pulse encoder|
85 | count the the low|
86 | level pulse. |
87 | 1 : Set pulse encoder|
88 | count the the |
89 | high level pulse.|
90 | unsigned char_ b_TriggerOutputAction : Digital TRIGGER output |
91 | action |
92 | 0 : No action |
93 | 1 : Set the trigger |
94 | output to "1" |
95 | (high) after the |
96 | passage from 1 to|
97 | 0 from pulse |
98 | encoder. |
99 | 2 : Set the trigger |
100 | output to "0" |
101 | (low) after the |
102 | passage from 1 to|
103 | 0 from pulse |
104 | encoder |
105 | ULONG_ ul_StartValue : Pulse encoder start value|
106 | (1 to 4294967295)
107 b_ModulNbr =(unsigned char) CR_AREF(insn->chanspec);
108 b_PulseEncoderNbr =(unsigned char) data[0];
109 b_InputLevelSelection =(unsigned char) data[1];
110 b_TriggerOutputAction =(unsigned char) data[2];
111 ul_StartValue =(ULONG) data[3];
112 |
113 +----------------------------------------------------------------------------+
114 | Output Parameters : - |
115 +----------------------------------------------------------------------------+
116 | Return Value : 0: No error |
117 | -1: The handle parameter of the board is wrong |
118 | -2: The module is not a pulse encoder module |
119 | -3: Pulse encoder selection is wrong |
120 | -4: Input level selection is wrong |
121 | -5: Digital TRIGGER output action selection is wrong |
122 | -6: Pulse encoder start value is wrong |
123 +----------------------------------------------------------------------------+
124 */
125
126 INT i_APCI1710_InsnConfigInitPulseEncoder(struct comedi_device * dev,
127 struct comedi_subdevice * s, struct comedi_insn * insn, unsigned int * data)
128 {
129 INT i_ReturnValue = 0;
130 DWORD dw_IntRegister;
131
132 unsigned char b_ModulNbr;
133 unsigned char b_PulseEncoderNbr;
134 unsigned char b_InputLevelSelection;
135 unsigned char b_TriggerOutputAction;
136 ULONG ul_StartValue;
137
138 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
139 b_PulseEncoderNbr = (unsigned char) data[0];
140 b_InputLevelSelection = (unsigned char) data[1];
141 b_TriggerOutputAction = (unsigned char) data[2];
142 ul_StartValue = (ULONG) data[3];
143
144 i_ReturnValue = insn->n;
145
146 /***********************************/
147 /* Test the selected module number */
148 /***********************************/
149
150 if (b_ModulNbr <= 3) {
151 /*************************/
152 /* Test if pulse encoder */
153 /*************************/
154
155 if ((devpriv->s_BoardInfos.
156 dw_MolduleConfiguration[b_ModulNbr] &
157 APCI1710_PULSE_ENCODER) ==
158 APCI1710_PULSE_ENCODER) {
159 /******************************************/
160 /* Test the selected pulse encoder number */
161 /******************************************/
162
163 if (b_PulseEncoderNbr <= 3) {
164 /************************/
165 /* Test the input level */
166 /************************/
167
168 if ((b_InputLevelSelection == 0)
169 || (b_InputLevelSelection == 1)) {
170 /*******************************************/
171 /* Test the ouput TRIGGER action selection */
172 /*******************************************/
173
174 if ((b_TriggerOutputAction <= 2)
175 || (b_PulseEncoderNbr > 0)) {
176 if (ul_StartValue > 1) {
177
178 dw_IntRegister =
179 inl(devpriv->
180 s_BoardInfos.
181 ui_Address +
182 20 +
183 (64 * b_ModulNbr));
184
185 /***********************/
186 /* Set the start value */
187 /***********************/
188
189 outl(ul_StartValue,
190 devpriv->
191 s_BoardInfos.
192 ui_Address +
193 (b_PulseEncoderNbr
194 * 4) +
195 (64 * b_ModulNbr));
196
197 /***********************/
198 /* Set the input level */
199 /***********************/
200 devpriv->
201 s_ModuleInfo
202 [b_ModulNbr].
203 s_PulseEncoderModuleInfo.
204 dw_SetRegister =
205 (devpriv->
206 s_ModuleInfo
207 [b_ModulNbr].
208 s_PulseEncoderModuleInfo.
209 dw_SetRegister &
210 (0xFFFFFFFFUL -
211 (1UL << (8 + b_PulseEncoderNbr)))) | ((1UL & (~b_InputLevelSelection)) << (8 + b_PulseEncoderNbr));
212
213 /*******************************/
214 /* Test if output trigger used */
215 /*******************************/
216
217 if ((b_TriggerOutputAction > 0) && (b_PulseEncoderNbr > 1)) {
218 /****************************/
219 /* Enable the output action */
220 /****************************/
221
222 devpriv->
223 s_ModuleInfo
224 [b_ModulNbr].
225 s_PulseEncoderModuleInfo.
226 dw_SetRegister
227 =
228 devpriv->
229 s_ModuleInfo
230 [b_ModulNbr].
231 s_PulseEncoderModuleInfo.
232 dw_SetRegister
233 | (1UL
234 << (4 + b_PulseEncoderNbr));
235
236 /*********************************/
237 /* Set the output TRIGGER action */
238 /*********************************/
239
240 devpriv->
241 s_ModuleInfo
242 [b_ModulNbr].
243 s_PulseEncoderModuleInfo.
244 dw_SetRegister
245 =
246 (devpriv->
247 s_ModuleInfo
248 [b_ModulNbr].
249 s_PulseEncoderModuleInfo.
250 dw_SetRegister
251 &
252 (0xFFFFFFFFUL
253 -
254 (1UL << (12 + b_PulseEncoderNbr)))) | ((1UL & (b_TriggerOutputAction - 1)) << (12 + b_PulseEncoderNbr));
255 } else {
256 /*****************************/
257 /* Disable the output action */
258 /*****************************/
259
260 devpriv->
261 s_ModuleInfo
262 [b_ModulNbr].
263 s_PulseEncoderModuleInfo.
264 dw_SetRegister
265 =
266 devpriv->
267 s_ModuleInfo
268 [b_ModulNbr].
269 s_PulseEncoderModuleInfo.
270 dw_SetRegister
271 &
272 (0xFFFFFFFFUL
273 -
274 (1UL << (4 + b_PulseEncoderNbr)));
275 }
276
277 /*************************/
278 /* Set the configuration */
279 /*************************/
280
281 outl(devpriv->
282 s_ModuleInfo
283 [b_ModulNbr].
284 s_PulseEncoderModuleInfo.
285 dw_SetRegister,
286 devpriv->
287 s_BoardInfos.
288 ui_Address +
289 20 +
290 (64 * b_ModulNbr));
291
292 devpriv->
293 s_ModuleInfo
294 [b_ModulNbr].
295 s_PulseEncoderModuleInfo.
296 s_PulseEncoderInfo
297 [b_PulseEncoderNbr].
298 b_PulseEncoderInit
299 = 1;
300 } else {
301 /**************************************/
302 /* Pulse encoder start value is wrong */
303 /**************************************/
304
305 DPRINTK("Pulse encoder start value is wrong\n");
306 i_ReturnValue = -6;
307 }
308 } else {
309 /****************************************************/
310 /* Digital TRIGGER output action selection is wrong */
311 /****************************************************/
312
313 DPRINTK("Digital TRIGGER output action selection is wrong\n");
314 i_ReturnValue = -5;
315 }
316 } else {
317 /**********************************/
318 /* Input level selection is wrong */
319 /**********************************/
320
321 DPRINTK("Input level selection is wrong\n");
322 i_ReturnValue = -4;
323 }
324 } else {
325 /************************************/
326 /* Pulse encoder selection is wrong */
327 /************************************/
328
329 DPRINTK("Pulse encoder selection is wrong\n");
330 i_ReturnValue = -3;
331 }
332 } else {
333 /********************************************/
334 /* The module is not a pulse encoder module */
335 /********************************************/
336
337 DPRINTK("The module is not a pulse encoder module\n");
338 i_ReturnValue = -2;
339 }
340 } else {
341 /********************************************/
342 /* The module is not a pulse encoder module */
343 /********************************************/
344
345 DPRINTK("The module is not a pulse encoder module\n");
346 i_ReturnValue = -2;
347 }
348
349 return (i_ReturnValue);
350 }
351
352 /*
353 +----------------------------------------------------------------------------+
354 | Function Name : _INT_ i_APCI1710_EnablePulseEncoder |
355 | (unsigned char_ b_BoardHandle, |
356 | unsigned char_ b_ModulNbr, |
357 | unsigned char_ b_PulseEncoderNbr, |
358 | unsigned char_ b_CycleSelection, |
359 | unsigned char_ b_InterruptHandling) |
360 +----------------------------------------------------------------------------+
361 | Task : Enableor disable the selected pulse encoder (b_PulseEncoderNbr) |
362 | from selected module (b_ModulNbr). Each input pulse |
363 | decrement the pulse encoder counter value from 1. |
364 | If you enabled the interrupt (b_InterruptHandling), a |
365 | interrupt is generated when the pulse encoder has run |
366 | down. |
367 +----------------------------------------------------------------------------+
368 | Input Parameters : unsigned char_ b_BoardHandle : Handle of board APCI-1710|
369 | unsigned char_ b_ModulNbr : Module number to |
370 | configure (0 to 3) |
371 | unsigned char_ b_PulseEncoderNbr : Pulse encoder selection |
372 | (0 to 3) |
373 | unsigned char_ b_CycleSelection : APCI1710_CONTINUOUS: |
374 | Each time the |
375 | counting value is set|
376 | on "0", the pulse |
377 | encoder load the |
378 | start value after |
379 | the next pulse. |
380 | APCI1710_SINGLE: |
381 | If the counter is set|
382 | on "0", the pulse |
383 | encoder is stopped. |
384 | unsigned char_ b_InterruptHandling : Interrupts can be |
385 | generated, when the pulse|
386 | encoder has run down. |
387 | With this parameter the |
388 | user decides if |
389 | interrupts are used or |
390 | not. |
391 | APCI1710_ENABLE: |
392 | Interrupts are enabled |
393 | APCI1710_DISABLE: |
394 | Interrupts are disabled
395
396 b_ModulNbr =(unsigned char) CR_AREF(insn->chanspec);
397 b_Action =(unsigned char) data[0];
398 b_PulseEncoderNbr =(unsigned char) data[1];
399 b_CycleSelection =(unsigned char) data[2];
400 b_InterruptHandling =(unsigned char) data[3];|
401 +----------------------------------------------------------------------------+
402 | Output Parameters : - |
403 +----------------------------------------------------------------------------+
404 | Return Value : 0: No error |
405 | -1: The handle parameter of the board is wrong |
406 | -2: Module selection is wrong |
407 | -3: Pulse encoder selection is wrong |
408 | -4: Pulse encoder not initialised. |
409 | See function "i_APCI1710_InitPulseEncoder" |
410 | -5: Cycle selection mode is wrong |
411 | -6: Interrupt handling mode is wrong |
412 | -7: Interrupt routine not installed. |
413 | See function "i_APCI1710_SetBoardIntRoutineX" |
414 +----------------------------------------------------------------------------+
415 */
416
417 INT i_APCI1710_InsnWriteEnableDisablePulseEncoder(struct comedi_device * dev,
418 struct comedi_subdevice * s, struct comedi_insn * insn, unsigned int * data)
419 {
420 INT i_ReturnValue = 0;
421 unsigned char b_ModulNbr;
422 unsigned char b_PulseEncoderNbr;
423 unsigned char b_CycleSelection;
424 unsigned char b_InterruptHandling;
425 unsigned char b_Action;
426
427 i_ReturnValue = insn->n;
428 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
429 b_Action = (unsigned char) data[0];
430 b_PulseEncoderNbr = (unsigned char) data[1];
431 b_CycleSelection = (unsigned char) data[2];
432 b_InterruptHandling = (unsigned char) data[3];
433
434 /***********************************/
435 /* Test the selected module number */
436 /***********************************/
437
438 if (b_ModulNbr <= 3) {
439 /******************************************/
440 /* Test the selected pulse encoder number */
441 /******************************************/
442
443 if (b_PulseEncoderNbr <= 3) {
444 /*************************************/
445 /* Test if pulse encoder initialised */
446 /*************************************/
447
448 if (devpriv->s_ModuleInfo[b_ModulNbr].
449 s_PulseEncoderModuleInfo.
450 s_PulseEncoderInfo[b_PulseEncoderNbr].
451 b_PulseEncoderInit == 1) {
452 switch (b_Action) {
453
454 case APCI1710_ENABLE:
455 /****************************/
456 /* Test the cycle selection */
457 /****************************/
458
459 if (b_CycleSelection ==
460 APCI1710_CONTINUOUS
461 || b_CycleSelection ==
462 APCI1710_SINGLE) {
463 /*******************************/
464 /* Test the interrupt handling */
465 /*******************************/
466
467 if (b_InterruptHandling ==
468 APCI1710_ENABLE
469 || b_InterruptHandling
470 == APCI1710_DISABLE) {
471 /******************************/
472 /* Test if interrupt not used */
473 /******************************/
474
475 if (b_InterruptHandling
476 ==
477 APCI1710_DISABLE)
478 {
479 /*************************/
480 /* Disable the interrupt */
481 /*************************/
482
483 devpriv->
484 s_ModuleInfo
485 [b_ModulNbr].
486 s_PulseEncoderModuleInfo.
487 dw_SetRegister
488 =
489 devpriv->
490 s_ModuleInfo
491 [b_ModulNbr].
492 s_PulseEncoderModuleInfo.
493 dw_SetRegister
494 &
495 (0xFFFFFFFFUL
496 -
497 (1UL << b_PulseEncoderNbr));
498 } else {
499
500 /************************/
501 /* Enable the interrupt */
502 /************************/
503
504 devpriv->
505 s_ModuleInfo
506 [b_ModulNbr].
507 s_PulseEncoderModuleInfo.
508 dw_SetRegister
509 =
510 devpriv->
511 s_ModuleInfo
512 [b_ModulNbr].
513 s_PulseEncoderModuleInfo.
514 dw_SetRegister
515 | (1UL
516 <<
517 b_PulseEncoderNbr);
518 devpriv->tsk_Current = current; // Save the current process task structure
519
520 }
521
522 if (i_ReturnValue >= 0) {
523 /***********************************/
524 /* Enable or disable the interrupt */
525 /***********************************/
526
527 outl(devpriv->
528 s_ModuleInfo
529 [b_ModulNbr].
530 s_PulseEncoderModuleInfo.
531 dw_SetRegister,
532 devpriv->
533 s_BoardInfos.
534 ui_Address
535 + 20 +
536 (64 * b_ModulNbr));
537
538 /****************************/
539 /* Enable the pulse encoder */
540 /****************************/
541 devpriv->
542 s_ModuleInfo
543 [b_ModulNbr].
544 s_PulseEncoderModuleInfo.
545 dw_ControlRegister
546 =
547 devpriv->
548 s_ModuleInfo
549 [b_ModulNbr].
550 s_PulseEncoderModuleInfo.
551 dw_ControlRegister
552 | (1UL
553 <<
554 b_PulseEncoderNbr);
555
556 /**********************/
557 /* Set the cycle mode */
558 /**********************/
559
560 devpriv->
561 s_ModuleInfo
562 [b_ModulNbr].
563 s_PulseEncoderModuleInfo.
564 dw_ControlRegister
565 =
566 (devpriv->
567 s_ModuleInfo
568 [b_ModulNbr].
569 s_PulseEncoderModuleInfo.
570 dw_ControlRegister
571 &
572 (0xFFFFFFFFUL
573 -
574 (1 << (b_PulseEncoderNbr + 4)))) | ((b_CycleSelection & 1UL) << (4 + b_PulseEncoderNbr));
575
576 /****************************/
577 /* Enable the pulse encoder */
578 /****************************/
579
580 outl(devpriv->
581 s_ModuleInfo
582 [b_ModulNbr].
583 s_PulseEncoderModuleInfo.
584 dw_ControlRegister,
585 devpriv->
586 s_BoardInfos.
587 ui_Address
588 + 16 +
589 (64 * b_ModulNbr));
590 }
591 } else {
592 /************************************/
593 /* Interrupt handling mode is wrong */
594 /************************************/
595
596 DPRINTK("Interrupt handling mode is wrong\n");
597 i_ReturnValue = -6;
598 }
599 } else {
600 /*********************************/
601 /* Cycle selection mode is wrong */
602 /*********************************/
603
604 DPRINTK("Cycle selection mode is wrong\n");
605 i_ReturnValue = -5;
606 }
607 break;
608
609 case APCI1710_DISABLE:
610 devpriv->s_ModuleInfo[b_ModulNbr].
611 s_PulseEncoderModuleInfo.
612 dw_ControlRegister =
613 devpriv->
614 s_ModuleInfo[b_ModulNbr].
615 s_PulseEncoderModuleInfo.
616 dw_ControlRegister &
617 (0xFFFFFFFFUL -
618 (1UL << b_PulseEncoderNbr));
619
620 /*****************************/
621 /* Disable the pulse encoder */
622 /*****************************/
623
624 outl(devpriv->s_ModuleInfo[b_ModulNbr].
625 s_PulseEncoderModuleInfo.
626 dw_ControlRegister,
627 devpriv->s_BoardInfos.
628 ui_Address + 16 +
629 (64 * b_ModulNbr));
630
631 break;
632 } // switch End
633
634 } else {
635 /*********************************/
636 /* Pulse encoder not initialised */
637 /*********************************/
638
639 DPRINTK("Pulse encoder not initialised\n");
640 i_ReturnValue = -4;
641 }
642 } else {
643 /************************************/
644 /* Pulse encoder selection is wrong */
645 /************************************/
646
647 DPRINTK("Pulse encoder selection is wrong\n");
648 i_ReturnValue = -3;
649 }
650 } else {
651 /*****************************/
652 /* Module selection is wrong */
653 /*****************************/
654
655 DPRINTK("Module selection is wrong\n");
656 i_ReturnValue = -2;
657 }
658
659 return (i_ReturnValue);
660 }
661
662 /*
663 +----------------------------------------------------------------------------+
664 | Function Name : _INT_ i_APCI1710_ReadPulseEncoderStatus |
665 | (unsigned char_ b_BoardHandle, |
666 | unsigned char_ b_ModulNbr, |
667 | unsigned char_ b_PulseEncoderNbr, |
668 | unsigned char *_ pb_Status) |
669 +----------------------------------------------------------------------------+
670 | Task APCI1710_PULSEENCODER_READ : Reads the pulse encoder status
671 and valuefrom selected pulse |
672 | encoder (b_PulseEncoderNbr) from selected module |
673 | (b_ModulNbr). |
674 +----------------------------------------------------------------------------+
675 unsigned char b_Type; data[0]
676 APCI1710_PULSEENCODER_WRITE
677 Writes a 32-bit value (ul_WriteValue) into the selected|
678 | pulse encoder (b_PulseEncoderNbr) from selected module |
679 | (b_ModulNbr). This operation set the new start pulse |
680 | encoder value.
681 APCI1710_PULSEENCODER_READ
682 | Input Parameters : unsigned char_ b_BoardHandle : Handle of board APCI-1710|
683 | CRAREF() unsigned char_ b_ModulNbr : Module number to |
684 | configure (0 to 3) |
685 | data[1] unsigned char_ b_PulseEncoderNbr : Pulse encoder selection |
686 | (0 to 3)
687 APCI1710_PULSEENCODER_WRITE
688 data[2] ULONG_ ul_WriteValue : 32-bit value to be |
689 | written |
690 +----------------------------------------------------------------------------+
691 | Output Parameters : unsigned char *_ pb_Status : Pulse encoder status. |
692 | 0 : No overflow occur|
693 | 1 : Overflow occur
694 PULONG_ pul_ReadValue : Pulse encoder value | |
695 +----------------------------------------------------------------------------+
696 | Return Value : 0: No error |
697 | -1: The handle parameter of the board is wrong |
698 | -2: Module selection is wrong |
699 | -3: Pulse encoder selection is wrong |
700 | -4: Pulse encoder not initialised. |
701 | See function "i_APCI1710_InitPulseEncoder" |
702 +----------------------------------------------------------------------------+
703 */
704
705 /*_INT_ i_APCI1710_ReadPulseEncoderStatus (unsigned char_ b_BoardHandle,
706 unsigned char_ b_ModulNbr,
707 unsigned char_ b_PulseEncoderNbr,
708
709 unsigned char *_ pb_Status)
710 */
711 INT i_APCI1710_InsnBitsReadWritePulseEncoder(struct comedi_device * dev,
712 struct comedi_subdevice * s, struct comedi_insn * insn, unsigned int * data)
713 {
714 INT i_ReturnValue = 0;
715 DWORD dw_StatusRegister;
716 unsigned char b_ModulNbr;
717 unsigned char b_PulseEncoderNbr;
718 unsigned char * pb_Status;
719 unsigned char b_Type;
720 PULONG pul_ReadValue;
721 ULONG ul_WriteValue;
722
723 i_ReturnValue = insn->n;
724 b_ModulNbr = (unsigned char) CR_AREF(insn->chanspec);
725 b_Type = (unsigned char) data[0];
726 b_PulseEncoderNbr = (unsigned char) data[1];
727 pb_Status = (unsigned char *) & data[0];
728 pul_ReadValue = (PULONG) & data[1];
729
730 /***********************************/
731 /* Test the selected module number */
732 /***********************************/
733
734 if (b_ModulNbr <= 3) {
735 /******************************************/
736 /* Test the selected pulse encoder number */
737 /******************************************/
738
739 if (b_PulseEncoderNbr <= 3) {
740 /*************************************/
741 /* Test if pulse encoder initialised */
742 /*************************************/
743
744 if (devpriv->s_ModuleInfo[b_ModulNbr].
745 s_PulseEncoderModuleInfo.
746 s_PulseEncoderInfo[b_PulseEncoderNbr].
747 b_PulseEncoderInit == 1) {
748
749 switch (b_Type) {
750 case APCI1710_PULSEENCODER_READ:
751 /****************************/
752 /* Read the status register */
753 /****************************/
754
755 dw_StatusRegister =
756 inl(devpriv->s_BoardInfos.
757 ui_Address + 16 +
758 (64 * b_ModulNbr));
759
760 devpriv->s_ModuleInfo[b_ModulNbr].
761 s_PulseEncoderModuleInfo.
762 dw_StatusRegister = devpriv->
763 s_ModuleInfo[b_ModulNbr].
764 s_PulseEncoderModuleInfo.
765 dw_StatusRegister |
766 dw_StatusRegister;
767
768 *pb_Status =
769 (unsigned char) (devpriv->
770 s_ModuleInfo[b_ModulNbr].
771 s_PulseEncoderModuleInfo.
772 dw_StatusRegister >> (1 +
773 b_PulseEncoderNbr)) & 1;
774
775 devpriv->s_ModuleInfo[b_ModulNbr].
776 s_PulseEncoderModuleInfo.
777 dw_StatusRegister =
778 devpriv->
779 s_ModuleInfo[b_ModulNbr].
780 s_PulseEncoderModuleInfo.
781 dw_StatusRegister &
782 (0xFFFFFFFFUL - (1 << (1 +
783 b_PulseEncoderNbr)));
784
785 /******************/
786 /* Read the value */
787 /******************/
788
789 *pul_ReadValue =
790 inl(devpriv->s_BoardInfos.
791 ui_Address +
792 (4 * b_PulseEncoderNbr) +
793 (64 * b_ModulNbr));
794 break;
795
796 case APCI1710_PULSEENCODER_WRITE:
797 ul_WriteValue = (ULONG) data[2];
798 /*******************/
799 /* Write the value */
800 /*******************/
801
802 outl(ul_WriteValue,
803 devpriv->s_BoardInfos.
804 ui_Address +
805 (4 * b_PulseEncoderNbr) +
806 (64 * b_ModulNbr));
807
808 } //end of switch
809 } else {
810 /*********************************/
811 /* Pulse encoder not initialised */
812 /*********************************/
813
814 DPRINTK("Pulse encoder not initialised\n");
815 i_ReturnValue = -4;
816 }
817 } else {
818 /************************************/
819 /* Pulse encoder selection is wrong */
820 /************************************/
821
822 DPRINTK("Pulse encoder selection is wrong\n");
823 i_ReturnValue = -3;
824 }
825 } else {
826 /*****************************/
827 /* Module selection is wrong */
828 /*****************************/
829
830 DPRINTK("Module selection is wrong\n");
831 i_ReturnValue = -2;
832 }
833
834 return (i_ReturnValue);
835 }
836
837 INT i_APCI1710_InsnReadInterruptPulseEncoder(struct comedi_device * dev,
838 struct comedi_subdevice * s, struct comedi_insn * insn, unsigned int * data)
839 {
840
841 data[0] = devpriv->s_InterruptParameters.
842 s_FIFOInterruptParameters[devpriv->
843 s_InterruptParameters.ui_Read].b_OldModuleMask;
844 data[1] = devpriv->s_InterruptParameters.
845 s_FIFOInterruptParameters[devpriv->
846 s_InterruptParameters.ui_Read].ul_OldInterruptMask;
847 data[2] = devpriv->s_InterruptParameters.
848 s_FIFOInterruptParameters[devpriv->
849 s_InterruptParameters.ui_Read].ul_OldCounterLatchValue;
850
851 /***************************/
852 /* Increment the read FIFO */
853 /***************************/
854
855 devpriv->s_InterruptParameters.
856 ui_Read = (devpriv->
857 s_InterruptParameters.ui_Read + 1) % APCI1710_SAVE_INTERRUPT;
858
859 return insn->n;
860
861 }
linux 2.6 git repository for openrd