| [3537] | 1 | #include "racqumem.h"
 | 
|---|
 | 2 | 
 | 
|---|
| [3683] | 3 | using namespace SOPHYA;
 | 
|---|
 | 4 | 
 | 
|---|
| [3537] | 5 | //----------------------------------------------------------------
 | 
|---|
 | 6 | // ---- classes de gestion memoire pour acquisition BAORadio -----
 | 
|---|
 | 7 | // LAL -      R. Ansari - Juin/Juillet 2008 
 | 
|---|
 | 8 | //----------------------------------------------------------------
 | 
|---|
 | 9 | 
 | 
|---|
| [3626] | 10 | /* --Methode-- */
 | 
|---|
| [3658] | 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)
 | 
|---|
| [3537] | 13 | {
 | 
|---|
| [3658] | 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 | {
 | 
|---|
| [3537] | 28 |   St_MemZ st;
 | 
|---|
| [3623] | 29 | 
 | 
|---|
| [3626] | 30 |   st.serial = 0;
 | 
|---|
| [3537] | 31 |   st.act = (uint_4)MemZA_None;
 | 
|---|
| [3626] | 32 |   st.stat = (uint_4)MemZS_Free;
 | 
|---|
| [3683] | 33 |   for(int k=0; k<MXNACTMZM; k++) st.nbact[k] = 0;
 | 
|---|
| [3658] | 34 |   uint_8 mzsz = nfibres*npaq*paqsz;
 | 
|---|
 | 35 |   uint_8 procmzsz = nfibres*npaq*procpaqsz;
 | 
|---|
| [3537] | 36 | 
 | 
|---|
| [3658] | 37 |    for(unsigned int k=0; k<NbZones(); k++) {
 | 
|---|
| [3623] | 38 |      memzones.push_back(new Byte[mzsz] );
 | 
|---|
 | 39 |      states.push_back(st);
 | 
|---|
| [3635] | 40 |      if (procmzsz > 0)  procmemzones.push_back(new Byte[procmzsz] );
 | 
|---|
| [3623] | 41 |    }
 | 
|---|
| [3626] | 42 |   serial_ = 0;
 | 
|---|
 | 43 |   SetFinalizedMask();
 | 
|---|
| [3683] | 44 |   SetProcSavedReadyMask();
 | 
|---|
| [3537] | 45 | }
 | 
|---|
 | 46 | 
 | 
|---|
| [3626] | 47 | /* --Methode-- */
 | 
|---|
| [3537] | 48 | RAcqMemZoneMgr::~RAcqMemZoneMgr()
 | 
|---|
 | 49 | {
 | 
|---|
| [3658] | 50 |   for(uint_4 k=0; k<NbZones(); k++) { 
 | 
|---|
 | 51 |     delete[] memzones[k]; 
 | 
|---|
 | 52 |     if (procpaqsz > 0) delete[] procmemzones[k];
 | 
|---|
 | 53 |   }
 | 
|---|
| [3537] | 54 | }
 | 
|---|
 | 55 | 
 | 
|---|
| [3626] | 56 | /* --Methode-- */
 | 
|---|
| [3537] | 57 | int RAcqMemZoneMgr::FindMemZoneId(MemZaction act)
 | 
|---|
| [3626] | 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 | 
 | 
|---|
| [3537] | 64 | {
 | 
|---|
 | 65 |   int rid = -1;
 | 
|---|
 | 66 |   if (stop_) return rid;
 | 
|---|
| [3635] | 67 |   if ((act != MemZA_Fill) && (act != MemZA_Save) && (act != MemZA_Proc) &&
 | 
|---|
| [3779] | 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 | 
 | 
|---|
| [3537] | 72 |   mex.lock();
 | 
|---|
| [3626] | 73 |   uint_8 bestserial = serial_ + 5;
 | 
|---|
| [3537] | 74 |   while ((rid < 0)&&(!stop_)) {
 | 
|---|
| [3626] | 75 |     switch (act)  {
 | 
|---|
| [3623] | 76 |       case MemZA_Fill:
 | 
|---|
 | 77 |         if (rid < 0) for(uint_4 k=0; k<NbZones(); k++) {
 | 
|---|
 | 78 |           if ((states[k].act == MemZA_None) && 
 | 
|---|
| [3640] | 79 |               ((states[k].stat == MemZS_Free)||((states[k].stat&mask_finalized_)==mask_finalized_) )) {
 | 
|---|
| [3626] | 80 |             if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } 
 | 
|---|
 | 81 |           }
 | 
|---|
| [3623] | 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++) {
 | 
|---|
| [3626] | 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 |           } 
 | 
|---|
| [3623] | 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++) {
 | 
|---|
| [3626] | 96 |           if ((states[k].act == MemZA_None) && 
 | 
|---|
| [3671] | 97 |               (states[k].stat & MemZS_Saved) && !(states[k].stat & MemZS_Proc) ) { 
 | 
|---|
| [3626] | 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++) {
 | 
|---|
| [3623] | 105 |           if ((states[k].act == MemZA_None) && (states[k].stat & MemZS_Filled) && 
 | 
|---|
| [3626] | 106 |               !(states[k].stat & MemZS_ProcA) ) { 
 | 
|---|
 | 107 |             if (states[k].serial < bestserial) { rid=k; bestserial=states[k].serial; } 
 | 
|---|
 | 108 |           }
 | 
|---|
| [3623] | 109 |         }
 | 
|---|
| [3626] | 110 |         if (rid >= 0) states[rid].act = MemZA_ProcA;              
 | 
|---|
| [3623] | 111 |         break;
 | 
|---|
| [3626] | 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;
 | 
|---|
| [3683] | 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;
 | 
|---|
| [3623] | 166 |       case MemZA_None:   // MTQ pour supprimer un warning
 | 
|---|
 | 167 |         break;
 | 
|---|
| [3626] | 168 |       }  // Fin de switch 
 | 
|---|
| [3623] | 169 |     if (rid < 0)  mex.wait();
 | 
|---|
| [3626] | 170 |   }  // Fin de while 
 | 
|---|
| [3537] | 171 |   mex.unlock();
 | 
|---|
 | 172 |   return rid;
 | 
|---|
 | 173 | }
 | 
|---|
 | 174 | 
 | 
|---|
| [3626] | 175 | /* --Methode-- */
 | 
|---|
| [3537] | 176 | int RAcqMemZoneMgr::FreeMemZone(int id, MemZStatus st)
 | 
|---|
 | 177 | {
 | 
|---|
| [3623] | 178 |   if ((id < 0) || (id >= (int)states.size()))  return 1;
 | 
|---|
| [3537] | 179 |   int rc = 0;
 | 
|---|
 | 180 |   mex.lock();
 | 
|---|
 | 181 |   switch (st) {
 | 
|---|
| [3626] | 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;
 | 
|---|
| [3683] | 221 |       else states[id].nbact[5]++;         
 | 
|---|
| [3626] | 222 |       states[id].stat |= MemZS_ProcC; 
 | 
|---|
 | 223 |       states[id].act = MemZA_None;
 | 
|---|
 | 224 |       break;
 | 
|---|
| [3683] | 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;
 | 
|---|
| [3626] | 249 |     default :
 | 
|---|
| [3683] | 250 |       rc = 65536;
 | 
|---|
| [3626] | 251 |       states[id].serial = 0;
 | 
|---|
 | 252 |       states[id].stat = MemZS_Free; 
 | 
|---|
 | 253 |       states[id].act = MemZA_None;
 | 
|---|
 | 254 |       break;
 | 
|---|
 | 255 |   }  // Fin de switch 
 | 
|---|
| [3537] | 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;
 | 
|---|
| [3635] | 265 |   if (ProcPaqSize() > 0)  
 | 
|---|
 | 266 |     cout << " ... With Processed Data Zones ProcPaqSize()=" << ProcPaqSize() 
 | 
|---|
 | 267 |          << " ProcZoneSize()=" << ProcZoneSize() << endl;
 | 
|---|
 | 268 |   else cout << " ... NO Processed Data Zones" << endl;
 | 
|---|
| [3683] | 269 |   for(uint_4 k=0; k<states.size(); k++) {
 | 
|---|
| [3537] | 270 |     os << " [" << k << "] Act=" << states[k].act << " Stat=" << states[k].stat 
 | 
|---|
| [3683] | 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 |   }
 | 
|---|
| [3537] | 275 |   return os;   
 | 
|---|
 | 276 | }
 | 
|---|
 | 277 | 
 | 
|---|
 | 278 | void RAcqMemZoneMgr::Stop()
 | 
|---|
 | 279 | {
 | 
|---|
| [3623] | 280 |   //  cout << "RAcqMemZoneMgr::Stop() ........ STOP                          BROADCAST" <<endl; 
 | 
|---|
| [3537] | 281 |   stop_ = true;
 | 
|---|
| [3658] | 282 |   runstate_ = MemZR_Stopped;
 | 
|---|
| [3537] | 283 |   mex.broadcast();
 | 
|---|
 | 284 | }
 | 
|---|