| 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 | }
 | 
|---|