1 | #include "racqumem.h"
|
---|
2 |
|
---|
3 | using namespace SOPHYA;
|
---|
4 |
|
---|
5 | //----------------------------------------------------------------
|
---|
6 | // ---- classes de gestion memoire pour acquisition BAORadio -----
|
---|
7 | // LAL - R. Ansari - Juin/Juillet 2008
|
---|
8 | //----------------------------------------------------------------
|
---|
9 |
|
---|
10 | /* --Methode-- */
|
---|
11 | RAcqMemZoneMgr::RAcqMemZoneMgr(uint_4 nz, uint_4 np, uint_4 psz)
|
---|
12 | : mex(true), nzones(nz), nfibres(1), npaq(np), paqsz(psz), procpaqsz(0), stop_(false), runstate_(MemZR_Running)
|
---|
13 | {
|
---|
14 | Init();
|
---|
15 | }
|
---|
16 |
|
---|
17 | /* --Methode-- */
|
---|
18 | RAcqMemZoneMgr::RAcqMemZoneMgr(uint_4 nzon, uint_4 nfib, uint_4 npaq, uint_4 paqsz, uint_4 procsz)
|
---|
19 | : mex(true), nzones(nzon), nfibres(nfib), npaq(npaq), paqsz(paqsz), procpaqsz(procsz),
|
---|
20 | stop_(false), runstate_(MemZR_Running)
|
---|
21 | {
|
---|
22 | Init();
|
---|
23 | }
|
---|
24 |
|
---|
25 | /* --Methode-- */
|
---|
26 | void RAcqMemZoneMgr::Init()
|
---|
27 | {
|
---|
28 | St_MemZ st;
|
---|
29 |
|
---|
30 | st.serial = 0;
|
---|
31 | st.act = (uint_4)MemZA_None;
|
---|
32 | st.stat = (uint_4)MemZS_Free;
|
---|
33 | for(int k=0; k<MXNACTMZM; k++) st.nbact[k] = 0;
|
---|
34 | uint_8 mzsz = nfibres*npaq*paqsz;
|
---|
35 | uint_8 procmzsz = nfibres*npaq*procpaqsz;
|
---|
36 |
|
---|
37 | for(unsigned int k=0; k<NbZones(); k++) {
|
---|
38 | memzones.push_back(new Byte[mzsz] );
|
---|
39 | states.push_back(st);
|
---|
40 | if (procmzsz > 0) procmemzones.push_back(new Byte[procmzsz] );
|
---|
41 | }
|
---|
42 | serial_ = 0;
|
---|
43 | SetFinalizedMask();
|
---|
44 | SetProcSavedReadyMask();
|
---|
45 | }
|
---|
46 |
|
---|
47 | /* --Methode-- */
|
---|
48 | RAcqMemZoneMgr::~RAcqMemZoneMgr()
|
---|
49 | {
|
---|
50 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
51 | delete[] memzones[k];
|
---|
52 | if (procpaqsz > 0) delete[] procmemzones[k];
|
---|
53 | }
|
---|
54 | }
|
---|
55 |
|
---|
56 | /* --Methode-- */
|
---|
57 | int RAcqMemZoneMgr::FindMemZoneId(MemZaction act)
|
---|
58 | // Recherche et renvoie une zone memoire compatible pour effectuer l'operation act
|
---|
59 | // Pour act = MemZA_Fill : Zone vide ou satisfaisant la condition mask_finalized_
|
---|
60 | // On recherche a chaque fois la zone ayant le plus petit numero de serie
|
---|
61 | // cad le numero d'ordre de remplissage
|
---|
62 | // Pour ProcA/B/C on attend que la zone avec le plus petit numero soit disponible
|
---|
63 |
|
---|
64 | {
|
---|
65 | int rid = -1;
|
---|
66 | if (stop_) return rid;
|
---|
67 | if ((act != MemZA_Fill) && (act != MemZA_Save) && (act != MemZA_Proc) &&
|
---|
68 | (act != MemZA_ProcA) && (act != MemZA_ProcB) && (act != MemZA_ProcC) &&
|
---|
69 | (act != MemZA_ProcD) && (act != MemZA_ProcE) && (act != MemZA_ProcF) &&
|
---|
70 | (act != MemZA_SaveProc) ) return rid;
|
---|
71 |
|
---|
72 | mex.lock();
|
---|
73 | uint_8 bestserial = serial_ + 5;
|
---|
74 | while ((rid < 0)&&(!stop_)) {
|
---|
75 | switch (act) {
|
---|
76 | case MemZA_Fill:
|
---|
77 | if (rid < 0) for(uint_4 k=0; k<NbZones(); k++) {
|
---|
78 | if ((states[k].act == MemZA_None) &&
|
---|
79 | ((states[k].stat == MemZS_Free)||((states[k].stat&mask_finalized_)==mask_finalized_) )) {
|
---|
80 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
81 | }
|
---|
82 | }
|
---|
83 | if (rid >= 0) { states[rid].act = MemZA_Fill; states[rid].stat = MemZS_Free; }
|
---|
84 | break;
|
---|
85 | case MemZA_Save:
|
---|
86 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
87 | if ((states[k].act == MemZA_None) &&
|
---|
88 | (states[k].stat & MemZS_Filled) && !(states[k].stat & MemZS_Saved) ) {
|
---|
89 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
90 | }
|
---|
91 | }
|
---|
92 | if (rid >= 0) states[rid].act = MemZA_Save;
|
---|
93 | break;
|
---|
94 | case MemZA_Proc:
|
---|
95 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
96 | if ((states[k].act == MemZA_None) &&
|
---|
97 | (states[k].stat & MemZS_Saved) && !(states[k].stat & MemZS_Proc) ) {
|
---|
98 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
99 | }
|
---|
100 | }
|
---|
101 | if (rid >= 0) states[rid].act = MemZA_Proc;
|
---|
102 | break;
|
---|
103 | case MemZA_ProcA:
|
---|
104 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
105 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) &&
|
---|
106 | !(states[k].stat & MemZS_ProcA) ) {
|
---|
107 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
108 | }
|
---|
109 | }
|
---|
110 | if (rid >= 0) states[rid].act = MemZA_ProcA;
|
---|
111 | break;
|
---|
112 | case MemZA_ProcB:
|
---|
113 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
114 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) &&
|
---|
115 | (states[k].stat & MemZS_ProcA) && !(states[k].stat & MemZS_ProcB) ) {
|
---|
116 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
117 | }
|
---|
118 | }
|
---|
119 | if (rid >= 0) states[rid].act = MemZA_ProcB;
|
---|
120 | break;
|
---|
121 | case MemZA_ProcC:
|
---|
122 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
123 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) &&
|
---|
124 | (states[k].stat & MemZS_ProcB) && !(states[k].stat & MemZS_ProcC) ) {
|
---|
125 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
126 | }
|
---|
127 | }
|
---|
128 | if (rid >= 0) states[rid].act = MemZA_ProcC;
|
---|
129 | break;
|
---|
130 | case MemZA_ProcD:
|
---|
131 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
132 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) &&
|
---|
133 | (states[k].stat & MemZS_ProcC) && !(states[k].stat & MemZS_ProcD) ) {
|
---|
134 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
135 | }
|
---|
136 | }
|
---|
137 | if (rid >= 0) states[rid].act = MemZA_ProcD;
|
---|
138 | break;
|
---|
139 | case MemZA_ProcE:
|
---|
140 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
141 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) &&
|
---|
142 | (states[k].stat & MemZS_ProcD) && !(states[k].stat & MemZS_ProcE) ) {
|
---|
143 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
144 | }
|
---|
145 | }
|
---|
146 | if (rid >= 0) states[rid].act = MemZA_ProcE;
|
---|
147 | break;
|
---|
148 | case MemZA_ProcF:
|
---|
149 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
150 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) &&
|
---|
151 | (states[k].stat & MemZS_ProcE) && !(states[k].stat & MemZS_ProcF) ) {
|
---|
152 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
153 | }
|
---|
154 | }
|
---|
155 | if (rid >= 0) states[rid].act = MemZA_ProcF;
|
---|
156 | break;
|
---|
157 | case MemZA_SaveProc:
|
---|
158 | for(uint_4 k=0; k<NbZones(); k++) {
|
---|
159 | if ((states[k].act == MemZA_None) &&
|
---|
160 | (states[k].stat & mask_saveproc_ready_) && !(states[k].stat & MemZS_SavedProc) ) {
|
---|
161 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; }
|
---|
162 | }
|
---|
163 | }
|
---|
164 | if (rid >= 0) states[rid].act = MemZA_SaveProc;
|
---|
165 | break;
|
---|
166 | case MemZA_None: // MTQ pour supprimer un warning
|
---|
167 | break;
|
---|
168 | } // Fin de switch
|
---|
169 | if (rid < 0) mex.wait();
|
---|
170 | } // Fin de while
|
---|
171 | mex.unlock();
|
---|
172 | return rid;
|
---|
173 | }
|
---|
174 |
|
---|
175 | /* --Methode-- */
|
---|
176 | int RAcqMemZoneMgr::FreeMemZone(int id, MemZStatus st)
|
---|
177 | {
|
---|
178 | if ((id < 0) || (id >= (int)states.size())) return 1;
|
---|
179 | int rc = 0;
|
---|
180 | mex.lock();
|
---|
181 | switch (st) {
|
---|
182 | case MemZS_Free :
|
---|
183 | states[id].serial = 0;
|
---|
184 | states[id].stat = MemZS_Free;
|
---|
185 | states[id].act = MemZA_None;
|
---|
186 | break;
|
---|
187 | case MemZS_Filled :
|
---|
188 | if (states[id].act != MemZA_Fill) rc = 2;
|
---|
189 | else states[id].nbact[0]++;
|
---|
190 | serial_ ++;
|
---|
191 | states[id].serial = serial_;
|
---|
192 | states[id].stat |= MemZS_Filled;
|
---|
193 | states[id].act = MemZA_None;
|
---|
194 | break;
|
---|
195 | case MemZS_Saved :
|
---|
196 | if (states[id].act != MemZA_Save) rc = 4;
|
---|
197 | else states[id].nbact[1]++;
|
---|
198 | states[id].stat |= MemZS_Saved;
|
---|
199 | states[id].act = MemZA_None;
|
---|
200 | break;
|
---|
201 | case MemZS_Proc :
|
---|
202 | if (states[id].act != MemZA_Proc) rc = 8;
|
---|
203 | else states[id].nbact[2]++;
|
---|
204 | states[id].stat |= MemZS_Proc;
|
---|
205 | states[id].act = MemZA_None;
|
---|
206 | break;
|
---|
207 | case MemZS_ProcA :
|
---|
208 | if (states[id].act != MemZA_ProcA) rc = 16;
|
---|
209 | else states[id].nbact[3]++;
|
---|
210 | states[id].stat |= MemZS_ProcA;
|
---|
211 | states[id].act = MemZA_None;
|
---|
212 | break;
|
---|
213 | case MemZS_ProcB :
|
---|
214 | if (states[id].act != MemZA_ProcB) rc = 32;
|
---|
215 | else states[id].nbact[4]++;
|
---|
216 | states[id].stat |= MemZS_ProcB;
|
---|
217 | states[id].act = MemZA_None;
|
---|
218 | break;
|
---|
219 | case MemZS_ProcC :
|
---|
220 | if (states[id].act != MemZA_ProcC) rc = 64;
|
---|
221 | else states[id].nbact[5]++;
|
---|
222 | states[id].stat |= MemZS_ProcC;
|
---|
223 | states[id].act = MemZA_None;
|
---|
224 | break;
|
---|
225 | case MemZS_ProcD :
|
---|
226 | if (states[id].act != MemZA_ProcD) rc = 128;
|
---|
227 | else states[id].nbact[6]++;
|
---|
228 | states[id].stat |= MemZS_ProcD;
|
---|
229 | states[id].act = MemZA_None;
|
---|
230 | break;
|
---|
231 | case MemZS_ProcE :
|
---|
232 | if (states[id].act != MemZA_ProcE) rc = 256;
|
---|
233 | else states[id].nbact[7]++;
|
---|
234 | states[id].stat |= MemZS_ProcE;
|
---|
235 | states[id].act = MemZA_None;
|
---|
236 | break;
|
---|
237 | case MemZS_ProcF :
|
---|
238 | if (states[id].act != MemZA_ProcF) rc = 512;
|
---|
239 | else states[id].nbact[8]++;
|
---|
240 | states[id].stat |= MemZS_ProcF;
|
---|
241 | states[id].act = MemZA_None;
|
---|
242 | break;
|
---|
243 | case MemZS_SavedProc :
|
---|
244 | if (states[id].act != MemZA_SaveProc) rc = 1024;
|
---|
245 | else states[id].nbact[9]++;
|
---|
246 | states[id].stat |= MemZS_ProcF;
|
---|
247 | states[id].act = MemZA_None;
|
---|
248 | break;
|
---|
249 | default :
|
---|
250 | rc = 65536;
|
---|
251 | states[id].serial = 0;
|
---|
252 | states[id].stat = MemZS_Free;
|
---|
253 | states[id].act = MemZA_None;
|
---|
254 | break;
|
---|
255 | } // Fin de switch
|
---|
256 | mex.unlock();
|
---|
257 | mex.broadcast();
|
---|
258 | return rc;
|
---|
259 | }
|
---|
260 |
|
---|
261 | ostream& RAcqMemZoneMgr::Print(ostream& os)
|
---|
262 | {
|
---|
263 | os << "RAcqMemZoneMgr::Print() NbZones=" << NbZones() << " PaqSize()=" << PaqSize()
|
---|
264 | << " NbPaquets()=" << NbPaquets() << " ZoneSize()=" << ZoneSize() << endl;
|
---|
265 | if (ProcPaqSize() > 0)
|
---|
266 | cout << " ... With Processed Data Zones ProcPaqSize()=" << ProcPaqSize()
|
---|
267 | << " ProcZoneSize()=" << ProcZoneSize() << endl;
|
---|
268 | else cout << " ... NO Processed Data Zones" << endl;
|
---|
269 | for(uint_4 k=0; k<states.size(); k++) {
|
---|
270 | os << " [" << k << "] Act=" << states[k].act << " Stat=" << states[k].stat
|
---|
271 | << " NbAct[0.."<< MXNACTMZM-1 << "]=" << states[k].nbact[0];
|
---|
272 | for(uint_4 j=1; j<MXNACTMZM; j++) cout << "," << states[k].nbact[j];
|
---|
273 | cout << endl;
|
---|
274 | }
|
---|
275 | return os;
|
---|
276 | }
|
---|
277 |
|
---|
278 | void RAcqMemZoneMgr::Stop()
|
---|
279 | {
|
---|
280 | // cout << "RAcqMemZoneMgr::Stop() ........ STOP BROADCAST" <<endl;
|
---|
281 | stop_ = true;
|
---|
282 | runstate_ = MemZR_Stopped;
|
---|
283 | mex.broadcast();
|
---|
284 | }
|
---|