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 |