Rev 188 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 188 | Rev 264 | ||
|---|---|---|---|
| 1 | #include <ansi_c.h> |
1 | #include <ansi_c.h> |
| - | 2 | ||
| - | 3 | ||
| - | 4 | #include "vme.h" |
|
| 2 | #include "CAENV965.h" |
5 | #include "CAENV965.h" |
| 3 | #include "CAENV965_DEF.h" |
6 | #include "CAENV965_DEF.h" |
| 4 | 7 | ||
| 5 | #ifdef SISVME |
- | |
| 6 | #include "sisvme_dll.h" |
- | |
| 7 | #endif |
- | |
| 8 | #ifdef WIENVME |
- | |
| 9 | #include "wienvme_dll.h" |
- | |
| 10 | #endif |
- | |
| 11 | 8 | ||
| 12 | static unsigned long ModuleAddress[10]; |
9 | static unsigned long ModuleAddress[10]; |
| 13 | 10 | ||
| 14 | int _VI_FUNC V965_map (int ModuleNumber, unsigned long ModuleOffset, int print) |
11 | int _VI_FUNC V965_map (int ModuleNumber, unsigned long ModuleOffset, int print) |
| 15 | { |
12 | { |
| 16 | int i; |
13 | int i; |
| 17 | unsigned short geo, fw, ah, al; |
14 | unsigned short geo, fw, ah, al; |
| 18 | 15 | ||
| 19 | ModuleAddress[ModuleNumber] = ModuleOffset; |
16 | ModuleAddress[ModuleNumber] = ModuleOffset; |
| 20 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_FW, &fw); |
17 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_FW, &fw); |
| 21 | geo = 0; |
18 | geo = 0; |
| 22 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_CRN, &geo); |
19 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_CRN, &geo); |
| 23 | for (i=0;i<32;i++) |
20 | for (i=0;i<32;i++) |
| 24 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_THM + 2*i, &geo); |
21 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_THM + 2*i, &geo); |
| 25 | geo = ModuleNumber; |
22 | geo = ModuleNumber; |
| 26 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_GEO, &geo); |
23 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_GEO, &geo); |
| 27 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_GEO, &geo); |
24 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_GEO, &geo); |
| 28 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_ADH, &ah); |
25 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_ADH, &ah); |
| 29 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_ADL, &al); |
26 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_ADL, &al); |
| 30 | if (print) { |
27 | if (print) { |
| 31 | printf("firmware = %d.%d\n", (fw>>8)&0xff, fw&0xff); |
28 | printf("firmware = %d.%d\n", (fw>>8)&0xff, fw&0xff); |
| 32 | printf("geo = %d\n", geo&0x1f ); |
29 | printf("geo = %d\n", geo&0x1f ); |
| 33 | printf("addr = 0x%04X0000\n", (ah<<8)|(al&0xff)); |
30 | printf("addr = 0x%04X0000\n", (ah<<8)|(al&0xff)); |
| 34 | } |
31 | } |
| 35 | return 0; |
32 | return 0; |
| 36 | } |
33 | } |
| 37 | 34 | ||
| 38 | 35 | ||
| 39 | int _VI_FUNC V965_init (int ModuleNumber, unsigned short ped) |
36 | int _VI_FUNC V965_init (int ModuleNumber, unsigned short ped) |
| 40 | { |
37 | { |
| 41 | unsigned short dum16; |
38 | unsigned short dum16; |
| 42 | 39 | ||
| 43 | dum16= 0x80; |
40 | dum16= 0x80; |
| 44 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BS1, &dum16); |
41 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BS1, &dum16); |
| 45 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BC1, &dum16); |
42 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BC1, &dum16); |
| 46 | dum16= ped; |
43 | dum16= ped; |
| 47 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_PED, &dum16); |
44 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_PED, &dum16); |
| 48 | dum16= 0x5000; |
45 | dum16= 0x5000; |
| 49 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BS2, &dum16); |
46 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BS2, &dum16); |
| 50 | dum16= 0x4; |
47 | dum16= 0x4; |
| 51 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BS2, &dum16); |
48 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BS2, &dum16); |
| 52 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BC2, &dum16); |
49 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BC2, &dum16); |
| 53 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_ECR, &dum16); |
50 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_ECR, &dum16); |
| 54 | 51 | ||
| 55 | printf ( "Module %d initialized!\n", ModuleNumber ) ; |
52 | printf ( "Module %d initialized!\n", ModuleNumber ) ; |
| 56 | return 0; |
53 | return 0; |
| 57 | } |
54 | } |
| 58 | 55 | ||
| 59 | int _VI_FUNC V965_clear (int ModuleNumber) |
56 | int _VI_FUNC V965_clear (int ModuleNumber) |
| 60 | { |
57 | { |
| 61 | 58 | ||
| 62 | unsigned short dum16; |
59 | unsigned short dum16; |
| 63 | 60 | ||
| 64 | dum16= 0x4; |
61 | dum16= 0x4; |
| 65 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BS2, &dum16); |
62 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BS2, &dum16); |
| 66 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BC2, &dum16); |
63 | VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV965_BC2, &dum16); |
| 67 | 64 | ||
| 68 | return 0; |
65 | return 0; |
| 69 | 66 | ||
| 70 | } |
67 | } |
| 71 | 68 | ||
| 72 | int _VI_FUNC V965_status (int ModuleNumber) |
69 | int _VI_FUNC V965_status (int ModuleNumber) |
| 73 | { |
70 | { |
| 74 | unsigned short dum16; |
71 | unsigned short dum16; |
| 75 | 72 | ||
| 76 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_SR1, &dum16); |
73 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_SR1, &dum16); |
| 77 | 74 | ||
| 78 | return (int)dum16; |
75 | return (int)dum16; |
| 79 | } |
76 | } |
| 80 | 77 | ||
| 81 | int _VI_FUNC V965_status2 (int ModuleNumber) |
78 | int _VI_FUNC V965_status2 (int ModuleNumber) |
| 82 | { |
79 | { |
| 83 | 80 | ||
| 84 | unsigned short dum16; |
81 | unsigned short dum16; |
| 85 | 82 | ||
| 86 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_SR2, &dum16); |
83 | VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV965_SR2, &dum16); |
| 87 | 84 | ||
| 88 | return (int)dum16; |
85 | return (int)dum16; |
| 89 | } |
86 | } |
| 90 | 87 | ||
| 91 | int _VI_FUNC V965_read (int ModuleNumber, unsigned long whereto[]) |
88 | int _VI_FUNC V965_read (int ModuleNumber, unsigned long whereto[]) |
| 92 | { |
89 | { |
| 93 | int status, ndata, i; |
90 | int status, ndata, i; |
| 94 | 91 | ||
| 95 | ndata = 0; |
92 | ndata = 0; |
| 96 | 93 | ||
| 97 | do { |
94 | do { |
| 98 | VME_A24D32_R(ModuleAddress[ModuleNumber] + CAENV965_OB, &whereto[ndata]); |
95 | VME_A24D32_R(ModuleAddress[ModuleNumber] + CAENV965_OB, &whereto[ndata]); |
| 99 | i=(whereto[ndata]>>25)&0x3; |
96 | i=(whereto[ndata]>>25)&0x3; |
| 100 | if (i<3) ndata++; |
97 | if (i<3) ndata++; |
| 101 | } while (i<2); |
98 | } while (i<2); |
| 102 | 99 | ||
| 103 | return ndata; |
100 | return ndata; |
| 104 | } |
101 | } |
| 105 | 102 | ||