00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054 #include "config.h"
00055 #ifdef HAVE_STL
00056
00057 #include <string.h>
00058 #include <stdio.h>
00059 #include "nix/nixvec.h"
00060
00061 #ifndef TEST_NIXVEC
00062
00063
00064 NixVec::NixVec(NixVec* p) : m_used(0), m_alth(p->m_alth)
00065 {
00066 if (Lth() > NIX_BPW)
00067 {
00068 m_pNV = new Nix_t[Lth() / NIX_BPW];
00069 memcpy(m_pNV, p->m_pNV, Lth()/8);
00070 }
00071 else
00072 {
00073 m_pNV = p->m_pNV;
00074 }
00075 }
00076
00077 NixVec::~NixVec()
00078 {
00079 if(0)printf("Hello from nixvec destructor\n");
00080 if (Lth() > NIX_BPW) delete [] m_pNV;
00081 }
00082
00083 void NixVec::Add( NixPair_t p)
00084 {
00085 Nixl_t newused;
00086 Nix_t newbits;
00087 Nixl_t newlth;
00088
00089 if (p.second == 0) return;
00090
00091 #ifdef NEED_DEBUG
00092
00093 Nix_t db;
00094
00095 if (Lth() == NIX_BPW)
00096 db = (Nix_t)m_pNV;
00097 else
00098 db = m_pNV[0];
00099 db = ((db & 0xfffffff0) ^ 0x00038520);
00100 if (!db)
00101 {
00102 printf("Adding %ld lth %ld\n", p.first, p.second);
00103 DBDump();
00104 }
00105
00106 #endif
00107
00108 newused = m_used + p.second;
00109 if (newused > Lth())
00110 {
00111 newlth = Lth() + NIX_BPW;
00112 Nix_t* pNew = new Nix_t[newlth / NIX_BPW];
00113 if (Lth() == NIX_BPW)
00114 {
00115 pNew[0] = (Nix_t)m_pNV;
00116 }
00117 else
00118 {
00119 for (unsigned long k = 0; k < Lth() / NIX_BPW; k++)
00120 pNew[k] = m_pNV[k];
00121 }
00122 pNew[newlth / NIX_BPW - 1] = 0;
00123 if (Lth() != NIX_BPW)
00124 delete [] m_pNV;
00125 m_pNV = pNew;
00126 if (m_used == Lth())
00127 {
00128 newbits = p.first << (NIX_BPW - m_used + (newlth - 32) - p.second);
00129 Nixl_t i = (m_used / NIX_BPW);
00130 m_pNV[i] |= newbits;
00131 }
00132 else
00133 {
00134
00135 Nixl_t left = Lth() - m_used;
00136 newbits = p.first >> (p.second - left);
00137 Nixl_t i = (m_used / NIX_BPW);
00138 m_pNV[i] |= newbits;
00139
00140 newbits = p.first << (NIX_BPW - (p.second - left));
00141 i = (m_used / NIX_BPW) + 1;
00142 m_pNV[i] |= newbits;
00143 }
00144
00145 }
00146 else
00147 {
00148 newbits = p.first << (NIX_BPW - m_used + (Lth() - 32) - p.second);
00149 if (Lth() == NIX_BPW)
00150 {
00151 Nix_t n = (Nix_t)m_pNV;
00152 n |= newbits;
00153 m_pNV = (Nix_t*)n;
00154 }
00155 else
00156 {
00157 Nixl_t i = (m_used / NIX_BPW);
00158 m_pNV[i] |= newbits;
00159 }
00160 }
00161 m_used = newused;
00162 if (m_used > m_alth) m_alth = m_used;
00163 #ifdef NEED_DEBUG
00164 if (!db)
00165 {
00166 printf("Added %ld lth %ld\n", p.first, p.second);
00167 DBDump();
00168 }
00169 #endif
00170 }
00171
00172 Nix_t NixVec::Extract(Nixl_t n)
00173 {
00174 return(Extract(n, &m_used));
00175 }
00176
00177 Nix_t NixVec::Extract(Nixl_t n, Nixl_t* pUsed)
00178 {
00179 Nixl_t used = *pUsed;
00180
00181 Nixl_t word = used / NIX_BPW;
00182 Nixl_t bit = used - (word * NIX_BPW);
00183 long m = 0x80000000;
00184 Nix_t w;
00185
00186 if(0)printf("Extracting %ld bits, used %ld lth %ld alth %ld\n",
00187 n, used, Lth(), m_alth);
00188 if ((used + n) > m_alth) return(NIX_NONE);
00189 if ((bit + n) <= NIX_BPW)
00190 {
00191 if (Lth() == NIX_BPW)
00192 w = (long)m_pNV;
00193 else
00194 w = m_pNV[word];
00195 m >>= (n-1);
00196 Nix_t u = (Nix_t)m;
00197 u >>= bit;
00198 w &= u;
00199 w >>= (NIX_BPW - bit - n);
00200 }
00201 else
00202 {
00203 if (Lth() == NIX_BPW)
00204 w = (long)m_pNV;
00205 else
00206 w = m_pNV[word];
00207 Nixl_t t = NIX_BPW - bit;
00208 m >>= (t-1);
00209 Nix_t u = (Nix_t)m;
00210 u >>= bit;
00211 w &= u;
00212 t = n - t;
00213 w <<= t;
00214 m = 0x80000000;
00215 m >>= (t-1);
00216 w |= (m_pNV[word+1] >> (NIX_BPW - t));
00217 }
00218 used += n;
00219 *pUsed = used;
00220 return(w);
00221 }
00222
00223 void NixVec::DBDump()
00224 {
00225 printf("Lth %3ld ActualLth %3ld Used %3ld ", Lth(), ALth(), m_used);
00226 if (Lth() == NIX_BPW)
00227 {
00228 printf("val[0] %08lx\n", (unsigned long)m_pNV);
00229 }
00230 else
00231 {
00232 printf("val[0] %08lx\n", m_pNV[0]);
00233 for (unsigned long i = 1; i < Lth() / NIX_BPW; i++)
00234 printf(" val[%ld] %08lx\n", i, m_pNV[i]);
00235 }
00236 }
00237
00238 void NixVec::Reset()
00239 {
00240 m_used = 0;
00241 }
00242
00243
00244 Nixl_t NixVec::GetBitl( Nixl_t l)
00245 {
00246 int h = 31;
00247
00248 if ((l & 0xFFFF0000) == 0)
00249 {
00250 if (l & 0xFFFFFF00 == 0)
00251 {
00252 h = 7;
00253 }
00254 else
00255 {
00256 h = 15;
00257 }
00258 }
00259 while(h > 0)
00260 {
00261 Nixl_t m = 0x1L << h;
00262 if (m & l)
00263 {
00264 return(h+1);
00265 }
00266 h--;
00267 }
00268 return(1);
00269 }
00270
00271 Nixl_t NixVec::Lth()
00272 {
00273 if (m_alth == 0) return (NIX_BPW);
00274 return((((m_alth - 1) / NIX_BPW) + 1) * NIX_BPW);
00275 }
00276
00277 #endif
00278
00279 #ifdef TEST_NIXVEC
00280
00281 int main()
00282 {
00283 NixVec n;
00284 NixVec n1;
00285 NixVec n2;
00286 int i;
00287
00288
00289 for (i = 0; i < NIX_BPW-1; i++)
00290 {
00291 n.Add(NixPair_t(1, 1));
00292 }
00293 n.Add(NixPair_t(2, 2));
00294 n.Add(NixPair_t(1, 1));
00295 n.DBDump();
00296
00297 n.Reset();
00298 for (i = 0; i < NIX_BPW; i++)
00299 {
00300 n.Add(NixPair_t(1, 1));
00301 n.Add(NixPair_t(0, 1));
00302 n.DBDump();
00303 }
00304 n.Reset();
00305 for (i = 0; i < NIX_BPW*2; i++)
00306 {
00307 Nix_t v = n.Extract(1);
00308 printf("V0 = %lx\n", v);
00309 }
00310 for (i = 0; i < 16; i++)
00311 {
00312 n1.Add(NixPair_t(i, 4));
00313 n1.DBDump();
00314 }
00315 n1.Reset();
00316 for (i = 0; i < 16; i++)
00317 {
00318 Nix_t v = n1.Extract(4);
00319 printf("V1 = %lx\n", v);
00320 }
00321 for (i = 0; i < 8; i++)
00322 {
00323 n2.Add(NixPair_t(0xfe0 + i, 12));
00324 n2.DBDump();
00325 }
00326 n2.Reset();
00327 while(1)
00328 {
00329 Nix_t v = n2.Extract(12);
00330 if (v == NIX_NONE) break;
00331 printf("V2 = %lx\n", v);
00332 }
00333 }
00334
00335 #endif
00336
00337 #endif