| 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 | auxdatap.push_back(new RAcqMZAuxData ); | 
|---|
| 41 | fiber_id.push_back(0); | 
|---|
| 42 | if (procmzsz > 0)  procmemzones.push_back(new Byte[procmzsz] ); | 
|---|
| 43 | } | 
|---|
| 44 | dummy_=0; | 
|---|
| 45 | serial_ = 0; | 
|---|
| 46 | SetFinalizedMask(); | 
|---|
| 47 | SetProcSavedReadyMask(); | 
|---|
| 48 | } | 
|---|
| 49 |  | 
|---|
| 50 | /* --Methode-- */ | 
|---|
| 51 | RAcqMemZoneMgr::~RAcqMemZoneMgr() | 
|---|
| 52 | { | 
|---|
| 53 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 54 | delete[] memzones[k]; | 
|---|
| 55 | delete auxdatap[k]; | 
|---|
| 56 | if (procpaqsz > 0) delete[] procmemzones[k]; | 
|---|
| 57 | } | 
|---|
| 58 | } | 
|---|
| 59 |  | 
|---|
| 60 | /* --Methode-- */ | 
|---|
| 61 | int RAcqMemZoneMgr::FindMemZoneId(MemZaction act) | 
|---|
| 62 | // Recherche et renvoie une zone memoire compatible pour effectuer l'operation act | 
|---|
| 63 | // Pour act = MemZA_Fill : Zone vide ou satisfaisant la condition mask_finalized_ | 
|---|
| 64 | // On recherche a chaque fois la zone ayant le plus petit numero de serie | 
|---|
| 65 | // cad le numero d'ordre de remplissage | 
|---|
| 66 | // Pour ProcA/B/C on attend que la zone avec le plus petit numero soit disponible | 
|---|
| 67 |  | 
|---|
| 68 | { | 
|---|
| 69 | int rid = -1; | 
|---|
| 70 | if (stop_) return rid; | 
|---|
| 71 | if ((act != MemZA_Fill) && (act != MemZA_Save) && (act != MemZA_Proc) && | 
|---|
| 72 | (act != MemZA_ProcA) && (act != MemZA_ProcB) && (act != MemZA_ProcC) && | 
|---|
| 73 | (act != MemZA_ProcD) && (act != MemZA_ProcE) && (act != MemZA_ProcF) && | 
|---|
| 74 | (act != MemZA_SaveProc) ) return rid; | 
|---|
| 75 |  | 
|---|
| 76 | mex.lock(); | 
|---|
| 77 | uint_8 bestserial = serial_ + 5; | 
|---|
| 78 | while ((rid < 0)&&(!stop_)) { | 
|---|
| 79 | switch (act)  { | 
|---|
| 80 | case MemZA_Fill: | 
|---|
| 81 | if (rid < 0) for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 82 | if ((states[k].act == MemZA_None) && | 
|---|
| 83 | ((states[k].stat == MemZS_Free)||((states[k].stat&mask_finalized_)==mask_finalized_) )) { | 
|---|
| 84 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 85 | } | 
|---|
| 86 | } | 
|---|
| 87 | if (rid >= 0) { states[rid].act = MemZA_Fill; states[rid].stat = MemZS_Free; } | 
|---|
| 88 | break; | 
|---|
| 89 | case MemZA_Save: | 
|---|
| 90 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 91 | if ((states[k].act == MemZA_None) && | 
|---|
| 92 | (states[k].stat & MemZS_Filled) && !(states[k].stat & MemZS_Saved) ) { | 
|---|
| 93 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 94 | } | 
|---|
| 95 | } | 
|---|
| 96 | if (rid >= 0) states[rid].act = MemZA_Save; | 
|---|
| 97 | break; | 
|---|
| 98 | case MemZA_Proc: | 
|---|
| 99 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 100 | if ((states[k].act == MemZA_None) && | 
|---|
| 101 | (states[k].stat & MemZS_Saved) && !(states[k].stat & MemZS_Proc) ) { | 
|---|
| 102 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 103 | } | 
|---|
| 104 | } | 
|---|
| 105 | if (rid >= 0) states[rid].act = MemZA_Proc; | 
|---|
| 106 | break; | 
|---|
| 107 | case MemZA_ProcA: | 
|---|
| 108 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 109 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) && | 
|---|
| 110 | !(states[k].stat & MemZS_ProcA) ) { | 
|---|
| 111 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 112 | } | 
|---|
| 113 | } | 
|---|
| 114 | if (rid >= 0) states[rid].act = MemZA_ProcA; | 
|---|
| 115 | break; | 
|---|
| 116 | case MemZA_ProcB: | 
|---|
| 117 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 118 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) && | 
|---|
| 119 | (states[k].stat & MemZS_ProcA) && !(states[k].stat & MemZS_ProcB) ) { | 
|---|
| 120 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 121 | } | 
|---|
| 122 | } | 
|---|
| 123 | if (rid >= 0) states[rid].act = MemZA_ProcB; | 
|---|
| 124 | break; | 
|---|
| 125 | case MemZA_ProcC: | 
|---|
| 126 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 127 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) && | 
|---|
| 128 | (states[k].stat & MemZS_ProcB) && !(states[k].stat & MemZS_ProcC) ) { | 
|---|
| 129 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 130 | } | 
|---|
| 131 | } | 
|---|
| 132 | if (rid >= 0) states[rid].act = MemZA_ProcC; | 
|---|
| 133 | break; | 
|---|
| 134 | case MemZA_ProcD: | 
|---|
| 135 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 136 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) && | 
|---|
| 137 | (states[k].stat & MemZS_ProcC) && !(states[k].stat & MemZS_ProcD) ) { | 
|---|
| 138 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 139 | } | 
|---|
| 140 | } | 
|---|
| 141 | if (rid >= 0) states[rid].act = MemZA_ProcD; | 
|---|
| 142 | break; | 
|---|
| 143 | case MemZA_ProcE: | 
|---|
| 144 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 145 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) && | 
|---|
| 146 | (states[k].stat & MemZS_ProcD) && !(states[k].stat & MemZS_ProcE) ) { | 
|---|
| 147 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 148 | } | 
|---|
| 149 | } | 
|---|
| 150 | if (rid >= 0) states[rid].act = MemZA_ProcE; | 
|---|
| 151 | break; | 
|---|
| 152 | case MemZA_ProcF: | 
|---|
| 153 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 154 | if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) && | 
|---|
| 155 | (states[k].stat & MemZS_ProcE) && !(states[k].stat & MemZS_ProcF) ) { | 
|---|
| 156 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 157 | } | 
|---|
| 158 | } | 
|---|
| 159 | if (rid >= 0) states[rid].act = MemZA_ProcF; | 
|---|
| 160 | break; | 
|---|
| 161 | case MemZA_SaveProc: | 
|---|
| 162 | for(uint_4 k=0; k<NbZones(); k++) { | 
|---|
| 163 | if ((states[k].act == MemZA_None) && | 
|---|
| 164 | (states[k].stat & mask_saveproc_ready_) && !(states[k].stat & MemZS_SavedProc) ) { | 
|---|
| 165 | if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } | 
|---|
| 166 | } | 
|---|
| 167 | } | 
|---|
| 168 | if (rid >= 0) states[rid].act = MemZA_SaveProc; | 
|---|
| 169 | break; | 
|---|
| 170 | case MemZA_None:   // MTQ pour supprimer un warning | 
|---|
| 171 | break; | 
|---|
| 172 | }  // Fin de switch | 
|---|
| 173 | if (rid < 0)  mex.wait(); | 
|---|
| 174 | }  // Fin de while | 
|---|
| 175 | mex.unlock(); | 
|---|
| 176 | return rid; | 
|---|
| 177 | } | 
|---|
| 178 |  | 
|---|
| 179 | /* --Methode-- */ | 
|---|
| 180 | int RAcqMemZoneMgr::FreeMemZone(int id, MemZStatus st) | 
|---|
| 181 | { | 
|---|
| 182 | if ((id < 0) || (id >= (int)states.size()))  return 1; | 
|---|
| 183 | int rc = 0; | 
|---|
| 184 | mex.lock(); | 
|---|
| 185 | switch (st) { | 
|---|
| 186 | case MemZS_Free : | 
|---|
| 187 | states[id].serial = 0; | 
|---|
| 188 | states[id].stat = MemZS_Free; | 
|---|
| 189 | states[id].act = MemZA_None; | 
|---|
| 190 | break; | 
|---|
| 191 | case MemZS_Filled : | 
|---|
| 192 | if (states[id].act != MemZA_Fill)  rc = 2; | 
|---|
| 193 | else states[id].nbact[0]++; | 
|---|
| 194 | serial_ ++; | 
|---|
| 195 | states[id].serial = serial_; | 
|---|
| 196 | states[id].stat |= MemZS_Filled; | 
|---|
| 197 | states[id].act = MemZA_None; | 
|---|
| 198 | break; | 
|---|
| 199 | case MemZS_Saved : | 
|---|
| 200 | if (states[id].act != MemZA_Save)  rc = 4; | 
|---|
| 201 | else states[id].nbact[1]++; | 
|---|
| 202 | states[id].stat |= MemZS_Saved; | 
|---|
| 203 | states[id].act = MemZA_None; | 
|---|
| 204 | break; | 
|---|
| 205 | case MemZS_Proc : | 
|---|
| 206 | if (states[id].act != MemZA_Proc)  rc = 8; | 
|---|
| 207 | else states[id].nbact[2]++; | 
|---|
| 208 | states[id].stat |= MemZS_Proc; | 
|---|
| 209 | states[id].act = MemZA_None; | 
|---|
| 210 | break; | 
|---|
| 211 | case MemZS_ProcA : | 
|---|
| 212 | if (states[id].act != MemZA_ProcA)  rc = 16; | 
|---|
| 213 | else states[id].nbact[3]++; | 
|---|
| 214 | states[id].stat |= MemZS_ProcA; | 
|---|
| 215 | states[id].act = MemZA_None; | 
|---|
| 216 | break; | 
|---|
| 217 | case MemZS_ProcB : | 
|---|
| 218 | if (states[id].act != MemZA_ProcB)  rc = 32; | 
|---|
| 219 | else states[id].nbact[4]++; | 
|---|
| 220 | states[id].stat |= MemZS_ProcB; | 
|---|
| 221 | states[id].act = MemZA_None; | 
|---|
| 222 | break; | 
|---|
| 223 | case MemZS_ProcC : | 
|---|
| 224 | if (states[id].act != MemZA_ProcC)  rc = 64; | 
|---|
| 225 | else states[id].nbact[5]++; | 
|---|
| 226 | states[id].stat |= MemZS_ProcC; | 
|---|
| 227 | states[id].act = MemZA_None; | 
|---|
| 228 | break; | 
|---|
| 229 | case MemZS_ProcD : | 
|---|
| 230 | if (states[id].act != MemZA_ProcD)  rc = 128; | 
|---|
| 231 | else states[id].nbact[6]++; | 
|---|
| 232 | states[id].stat |= MemZS_ProcD; | 
|---|
| 233 | states[id].act = MemZA_None; | 
|---|
| 234 | break; | 
|---|
| 235 | case MemZS_ProcE : | 
|---|
| 236 | if (states[id].act != MemZA_ProcE)  rc = 256; | 
|---|
| 237 | else states[id].nbact[7]++; | 
|---|
| 238 | states[id].stat |= MemZS_ProcE; | 
|---|
| 239 | states[id].act = MemZA_None; | 
|---|
| 240 | break; | 
|---|
| 241 | case MemZS_ProcF : | 
|---|
| 242 | if (states[id].act != MemZA_ProcF)  rc = 512; | 
|---|
| 243 | else states[id].nbact[8]++; | 
|---|
| 244 | states[id].stat |= MemZS_ProcF; | 
|---|
| 245 | states[id].act = MemZA_None; | 
|---|
| 246 | break; | 
|---|
| 247 | case MemZS_SavedProc : | 
|---|
| 248 | if (states[id].act != MemZA_SaveProc)  rc = 1024; | 
|---|
| 249 | else states[id].nbact[9]++; | 
|---|
| 250 | states[id].stat |= MemZS_ProcF; | 
|---|
| 251 | states[id].act = MemZA_None; | 
|---|
| 252 | break; | 
|---|
| 253 | default : | 
|---|
| 254 | rc = 65536; | 
|---|
| 255 | states[id].serial = 0; | 
|---|
| 256 | states[id].stat = MemZS_Free; | 
|---|
| 257 | states[id].act = MemZA_None; | 
|---|
| 258 | break; | 
|---|
| 259 | }  // Fin de switch | 
|---|
| 260 | mex.unlock(); | 
|---|
| 261 | mex.broadcast(); | 
|---|
| 262 | return rc; | 
|---|
| 263 | } | 
|---|
| 264 |  | 
|---|
| 265 | /* --Methode-- */ | 
|---|
| 266 | ostream& RAcqMemZoneMgr::Print(ostream& os) | 
|---|
| 267 | { | 
|---|
| 268 | os << "RAcqMemZoneMgr::Print() NbZones=" << NbZones() << " PaqSize()=" << PaqSize() | 
|---|
| 269 | << " NbPaquets()=" << NbPaquets() << " ZoneSize()=" << ZoneSize() << endl; | 
|---|
| 270 | if (ProcPaqSize() > 0) | 
|---|
| 271 | cout << " ... With Processed Data Zones ProcPaqSize()=" << ProcPaqSize() | 
|---|
| 272 | << " ProcZoneSize()=" << ProcZoneSize() << endl; | 
|---|
| 273 | else cout << " ... NO Processed Data Zones" << endl; | 
|---|
| 274 | for(uint_4 k=0; k<states.size(); k++) { | 
|---|
| 275 | os << " [" << k << "] Act=" << states[k].act << " Stat=" << states[k].stat | 
|---|
| 276 | << " NbAct[0.."<< MXNACTMZM-1 << "]=" << states[k].nbact[0]; | 
|---|
| 277 | for(uint_4 j=1; j<MXNACTMZM; j++)  cout << "," << states[k].nbact[j]; | 
|---|
| 278 | cout << endl; | 
|---|
| 279 | } | 
|---|
| 280 | return os; | 
|---|
| 281 | } | 
|---|
| 282 |  | 
|---|
| 283 | /* --Methode-- */ | 
|---|
| 284 | void RAcqMemZoneMgr::Stop() | 
|---|
| 285 | { | 
|---|
| 286 | //  cout << "RAcqMemZoneMgr::Stop() ........ STOP                          BROADCAST" <<endl; | 
|---|
| 287 | stop_ = true; | 
|---|
| 288 | runstate_ = MemZR_Stopped; | 
|---|
| 289 | mex.broadcast(); | 
|---|
| 290 | } | 
|---|
| 291 |  | 
|---|
| 292 | /* --Methode-- */ | 
|---|
| 293 | MemZaction RAcqMemZoneMgr::Convert_Status2Action(MemZStatus st) | 
|---|
| 294 | // methode statique | 
|---|
| 295 | { | 
|---|
| 296 | MemZaction ra=MemZA_None; | 
|---|
| 297 | switch (st) { | 
|---|
| 298 | case MemZS_Filled: | 
|---|
| 299 | ra=MemZA_Fill; | 
|---|
| 300 | break; | 
|---|
| 301 | case MemZS_Saved: | 
|---|
| 302 | ra=MemZA_Save; | 
|---|
| 303 | break; | 
|---|
| 304 | case MemZS_Proc: | 
|---|
| 305 | ra=MemZA_Proc; | 
|---|
| 306 | break; | 
|---|
| 307 | case MemZS_ProcA: | 
|---|
| 308 | ra=MemZA_ProcA; | 
|---|
| 309 | break; | 
|---|
| 310 | case MemZS_ProcB: | 
|---|
| 311 | ra=MemZA_ProcB; | 
|---|
| 312 | break; | 
|---|
| 313 | case MemZS_ProcC: | 
|---|
| 314 | ra=MemZA_ProcC; | 
|---|
| 315 | break; | 
|---|
| 316 | case MemZS_ProcD: | 
|---|
| 317 | ra=MemZA_ProcD; | 
|---|
| 318 | break; | 
|---|
| 319 | case MemZS_ProcE: | 
|---|
| 320 | ra=MemZA_ProcE; | 
|---|
| 321 | break; | 
|---|
| 322 | case MemZS_ProcF: | 
|---|
| 323 | ra=MemZA_ProcF; | 
|---|
| 324 | break; | 
|---|
| 325 | default: | 
|---|
| 326 | ra=MemZA_None; | 
|---|
| 327 | break; | 
|---|
| 328 | } | 
|---|
| 329 | return ra; | 
|---|
| 330 | } | 
|---|