bitStream.cpp 24 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144
  1. //-----------------------------------------------------------------------------
  2. // Copyright (c) 2012 GarageGames, LLC
  3. //
  4. // Permission is hereby granted, free of charge, to any person obtaining a copy
  5. // of this software and associated documentation files (the "Software"), to
  6. // deal in the Software without restriction, including without limitation the
  7. // rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
  8. // sell copies of the Software, and to permit persons to whom the Software is
  9. // furnished to do so, subject to the following conditions:
  10. //
  11. // The above copyright notice and this permission notice shall be included in
  12. // all copies or substantial portions of the Software.
  13. //
  14. // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15. // IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16. // FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  17. // AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  18. // LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  19. // FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
  20. // IN THE SOFTWARE.
  21. //-----------------------------------------------------------------------------
  22. #include "platform/platform.h"
  23. #include "core/stream/bitStream.h"
  24. #include "core/strings/stringFunctions.h"
  25. #include "math/mathIO.h"
  26. #include "console/consoleObject.h"
  27. #include "platform/platformNet.h"
  28. #include "core/bitVector.h"
  29. static BitStream gPacketStream(NULL, 0);
  30. static U8 gPacketBuffer[Net::MaxPacketDataSize];
  31. // bitstream utility functions
  32. void BitStream::clearStringBuffer()
  33. {
  34. static char stringBuf[256];
  35. stringBuf[0] = 0;
  36. // setStringBuffer( stringBuf );
  37. }
  38. void BitStream::setStringBuffer(char buffer[256])
  39. {
  40. // stringBuffer = buffer;
  41. }
  42. BitStream *BitStream::getPacketStream(U32 writeSize)
  43. {
  44. if(!writeSize)
  45. writeSize = Net::MaxPacketDataSize;
  46. gPacketStream.setBuffer(gPacketBuffer, writeSize, Net::MaxPacketDataSize);
  47. gPacketStream.setPosition(0);
  48. return &gPacketStream;
  49. }
  50. void BitStream::sendPacketStream(const NetAddress *addr)
  51. {
  52. Net::sendto(addr, gPacketStream.getBuffer(), gPacketStream.getPosition());
  53. }
  54. // CodeReview WTF is this additional IsEqual? - BJG, 3/29/07
  55. inline bool IsEqual(F32 a, F32 b) { return a == b; }
  56. ResizeBitStream::ResizeBitStream(U32 minSpace, U32 initialSize) : BitStream(NULL, 0, 0)
  57. {
  58. mMinSpace = minSpace;
  59. if(!initialSize)
  60. initialSize = minSpace * 2;
  61. U8 *buf = (U8 *) dMalloc(initialSize);
  62. setBuffer(buf, initialSize, initialSize);
  63. }
  64. ResizeBitStream::~ResizeBitStream()
  65. {
  66. dFree(dataPtr);
  67. }
  68. void ResizeBitStream::validate()
  69. {
  70. if(getPosition() + mMinSpace > bufSize)
  71. {
  72. bufSize = getPosition() + mMinSpace * 2;
  73. dataPtr = (U8 *) dRealloc(dataPtr, bufSize);
  74. maxReadBitNum = bufSize << 3;
  75. maxWriteBitNum = bufSize << 3;
  76. }
  77. }
  78. class HuffmanProcessor
  79. {
  80. static const U32 csm_charFreqs[256];
  81. bool m_tablesBuilt;
  82. void buildTables();
  83. struct HuffNode {
  84. U32 pop;
  85. S16 index0;
  86. S16 index1;
  87. };
  88. struct HuffLeaf {
  89. U32 pop;
  90. U8 numBits;
  91. U8 symbol;
  92. U32 code; // no code should be longer than 32 bits.
  93. };
  94. // We have to be a bit careful with these, mSince they are pointers...
  95. struct HuffWrap {
  96. HuffNode* pNode;
  97. HuffLeaf* pLeaf;
  98. public:
  99. HuffWrap() : pNode(NULL), pLeaf(NULL) { }
  100. void set(HuffLeaf* in_leaf) { pNode = NULL; pLeaf = in_leaf; }
  101. void set(HuffNode* in_node) { pLeaf = NULL; pNode = in_node; }
  102. U32 getPop() { if (pNode) return pNode->pop; else return pLeaf->pop; }
  103. };
  104. Vector<HuffNode> m_huffNodes;
  105. Vector<HuffLeaf> m_huffLeaves;
  106. S16 determineIndex(HuffWrap&);
  107. void generateCodes(BitStream&, S32, S32);
  108. public:
  109. HuffmanProcessor() : m_tablesBuilt(false) { }
  110. static HuffmanProcessor g_huffProcessor;
  111. bool readHuffBuffer(BitStream* pStream, char* out_pBuffer);
  112. bool writeHuffBuffer(BitStream* pStream, const char* out_pBuffer, S32 maxLen);
  113. };
  114. HuffmanProcessor HuffmanProcessor::g_huffProcessor;
  115. void BitStream::setBuffer(void *bufPtr, S32 size, S32 maxSize)
  116. {
  117. dataPtr = (U8 *) bufPtr;
  118. bitNum = 0;
  119. bufSize = size;
  120. maxReadBitNum = size << 3;
  121. if(maxSize < 0)
  122. maxSize = size;
  123. maxWriteBitNum = maxSize << 3;
  124. error = false;
  125. clearCompressionPoint();
  126. }
  127. U32 BitStream::getPosition() const
  128. {
  129. return (bitNum + 7) >> 3;
  130. }
  131. bool BitStream::setPosition(const U32 pos)
  132. {
  133. bitNum = pos << 3;
  134. return (true);
  135. }
  136. U32 BitStream::getStreamSize()
  137. {
  138. return bufSize;
  139. }
  140. U8 *BitStream::getBytePtr()
  141. {
  142. return dataPtr + getPosition();
  143. }
  144. U32 BitStream::getReadByteSize()
  145. {
  146. return (maxReadBitNum >> 3) - getPosition();
  147. }
  148. U32 BitStream::getWriteByteSize()
  149. {
  150. return (maxWriteBitNum >> 3) - getPosition();
  151. }
  152. void BitStream::clear()
  153. {
  154. dMemset(dataPtr, 0, bufSize);
  155. }
  156. void BitStream::writeClassId(U32 classId, U32 classType, U32 classGroup)
  157. {
  158. AssertFatal(classType < NetClassTypesCount, "Out of range class type.");
  159. AssertFatal(classGroup < NetClassGroupsCount, "Out of range class group.");
  160. AssertFatal(classId < AbstractClassRep::NetClassCount[classGroup][classType], "Out of range class id.");
  161. AssertFatal(AbstractClassRep::NetClassCount[classGroup][classType] < (1 << AbstractClassRep::NetClassBitSize[classGroup][classType]),
  162. "NetClassBitSize too small!");
  163. writeInt(classId, AbstractClassRep::NetClassBitSize[classGroup][classType]);
  164. }
  165. S32 BitStream::readClassId(U32 classType, U32 classGroup)
  166. {
  167. AssertFatal(classType < NetClassTypesCount, "Out of range class type.");
  168. AssertFatal(classGroup < NetClassGroupsCount, "Out of range class group.");
  169. AssertFatal(AbstractClassRep::NetClassCount[classGroup][classType] < (1 << AbstractClassRep::NetClassBitSize[classGroup][classType]),
  170. "NetClassBitSize too small!");
  171. S32 ret = readInt(AbstractClassRep::NetClassBitSize[classGroup][classType]);
  172. AssertFatal(ret < AbstractClassRep::NetClassCount[classGroup][classType], "BitStream::readClassId - unexpected class ID!");
  173. if(ret >= AbstractClassRep::NetClassCount[classGroup][classType])
  174. return -1;
  175. return ret;
  176. }
  177. void BitStream::writeBits(S32 bitCount, const void *bitPtr)
  178. {
  179. if(!bitCount)
  180. return;
  181. if(bitCount + bitNum > maxWriteBitNum)
  182. {
  183. error = true;
  184. AssertFatal(false, "Out of range write");
  185. return;
  186. }
  187. // [tom, 8/17/2006] This is probably a lot lamer then it needs to be. However,
  188. // at least it doesnt clobber data or overrun the buffer like the old code did.
  189. const U8 *ptr = (U8 *)bitPtr;
  190. for(S32 srcBitNum = 0;srcBitNum < bitCount;srcBitNum++)
  191. {
  192. if((*(ptr + (srcBitNum >> 3)) & (1 << (srcBitNum & 0x7))) != 0)
  193. *(dataPtr + (bitNum >> 3)) |= (1 << (bitNum & 0x7));
  194. else
  195. *(dataPtr + (bitNum >> 3)) &= ~(1 << (bitNum & 0x7));
  196. bitNum++;
  197. }
  198. }
  199. void BitStream::setBit(S32 bitCount, bool set)
  200. {
  201. if(set)
  202. *(dataPtr + (bitCount >> 3)) |= (1 << (bitCount & 0x7));
  203. else
  204. *(dataPtr + (bitCount >> 3)) &= ~(1 << (bitCount & 0x7));
  205. }
  206. bool BitStream::testBit(S32 bitCount)
  207. {
  208. return (*(dataPtr + (bitCount >> 3)) & (1 << (bitCount & 0x7))) != 0;
  209. }
  210. bool BitStream::writeFlag(bool val)
  211. {
  212. if(bitNum + 1 > maxWriteBitNum)
  213. {
  214. error = true;
  215. AssertFatal(false, "Out of range write");
  216. return false;
  217. }
  218. if(val)
  219. *(dataPtr + (bitNum >> 3)) |= (1 << (bitNum & 0x7));
  220. else
  221. *(dataPtr + (bitNum >> 3)) &= ~(1 << (bitNum & 0x7));
  222. bitNum++;
  223. return (val);
  224. }
  225. void BitStream::readBits(S32 bitCount, void *bitPtr)
  226. {
  227. if(!bitCount)
  228. return;
  229. if(bitCount + bitNum > maxReadBitNum)
  230. {
  231. error = true;
  232. //AssertFatal(false, "Out of range read");
  233. AssertWarn(false, "Out of range read");
  234. return;
  235. }
  236. U8 *stPtr = dataPtr + (bitNum >> 3);
  237. S32 byteCount = (bitCount + 7) >> 3;
  238. U8 *ptr = (U8 *) bitPtr;
  239. S32 downShift = bitNum & 0x7;
  240. S32 upShift = 8 - downShift;
  241. U8 curB = *stPtr;
  242. const U8 *stEnd = dataPtr + bufSize;
  243. while(byteCount--)
  244. {
  245. stPtr++;
  246. U8 nextB = stPtr < stEnd ? *stPtr : 0;
  247. *ptr++ = (curB >> downShift) | (nextB << upShift);
  248. curB = nextB;
  249. }
  250. bitNum += bitCount;
  251. }
  252. bool BitStream::_read(U32 size, void *dataPtr)
  253. {
  254. readBits(size << 3, dataPtr);
  255. return true;
  256. }
  257. bool BitStream::_write(U32 size, const void *dataPtr)
  258. {
  259. writeBits(size << 3, dataPtr);
  260. return true;
  261. }
  262. S32 BitStream::readInt(S32 bitCount)
  263. {
  264. S32 ret = 0;
  265. readBits(bitCount, &ret);
  266. ret = convertLEndianToHost(ret);
  267. if(bitCount == 32)
  268. return ret;
  269. else
  270. ret &= (1 << bitCount) - 1;
  271. return ret;
  272. }
  273. void BitStream::writeInt(S32 val, S32 bitCount)
  274. {
  275. AssertFatal((bitCount == 32) || ((val >> bitCount) == 0), avar("BitStream::writeInt: value out of range: %i/%i (%i bits)", val, 1 << bitCount, bitCount));
  276. val = convertHostToLEndian(val);
  277. writeBits(bitCount, &val);
  278. }
  279. void BitStream::writeFloat(F32 f, S32 bitCount)
  280. {
  281. writeInt((S32)(f * ((1 << bitCount) - 1)), bitCount);
  282. }
  283. F32 BitStream::readFloat(S32 bitCount)
  284. {
  285. return readInt(bitCount) / F32((1 << bitCount) - 1);
  286. }
  287. void BitStream::writeSignedFloat(F32 f, S32 bitCount)
  288. {
  289. writeInt((S32)(((f + 1) * .5) * ((1 << bitCount) - 1)), bitCount);
  290. }
  291. F32 BitStream::readSignedFloat(S32 bitCount)
  292. {
  293. return readInt(bitCount) * 2 / F32((1 << bitCount) - 1) - 1.0f;
  294. }
  295. void BitStream::writeSignedInt(S32 value, S32 bitCount)
  296. {
  297. if(writeFlag(value < 0))
  298. writeInt(-value, bitCount - 1);
  299. else
  300. writeInt(value, bitCount - 1);
  301. }
  302. S32 BitStream::readSignedInt(S32 bitCount)
  303. {
  304. if(readFlag())
  305. return -readInt(bitCount - 1);
  306. else
  307. return readInt(bitCount - 1);
  308. }
  309. void BitStream::writeNormalVector(const Point3F& vec, S32 bitCount)
  310. {
  311. F32 phi = mAtan2(vec.x, vec.y) / M_PI;
  312. F32 theta = mAtan2(vec.z, mSqrt(vec.x*vec.x + vec.y*vec.y)) / (M_PI/2.0);
  313. writeSignedFloat(phi, bitCount+1);
  314. writeSignedFloat(theta, bitCount);
  315. }
  316. void BitStream::readNormalVector(Point3F *vec, S32 bitCount)
  317. {
  318. F32 phi = readSignedFloat(bitCount+1) * M_PI;
  319. F32 theta = readSignedFloat(bitCount) * (M_PI/2.0);
  320. vec->x = mSin(phi)*mCos(theta);
  321. vec->y = mCos(phi)*mCos(theta);
  322. vec->z = mSin(theta);
  323. }
  324. Point3F BitStream::dumbDownNormal(const Point3F& vec, S32 bitCount)
  325. {
  326. U8 buffer[128];
  327. BitStream temp(buffer, 128);
  328. temp.writeNormalVector(vec, bitCount);
  329. temp.setCurPos(0);
  330. Point3F ret;
  331. temp.readNormalVector(&ret, bitCount);
  332. return ret;
  333. }
  334. void BitStream::writeVector( Point3F vec, F32 maxMag, S32 magBits, S32 normalBits )
  335. {
  336. F32 mag = vec.len();
  337. // If its zero length then we're done.
  338. if ( !writeFlag( mag > 0.0f ) )
  339. return;
  340. // Write the magnitude compressed unless its greater than the maximum.
  341. if ( writeFlag( mag < maxMag ) )
  342. writeFloat( mag / maxMag, magBits );
  343. else
  344. write( mag );
  345. // Finally write the normal part.
  346. vec *= 1.0f / mag;
  347. writeNormalVector( vec, normalBits );
  348. }
  349. void BitStream::readVector( Point3F *outVec, F32 maxMag, S32 magBits, S32 normalBits )
  350. {
  351. // Nothing more to do if we got a zero length vector.
  352. if ( !readFlag() )
  353. {
  354. outVec->set(0,0,0);
  355. return;
  356. }
  357. // Read the compressed or uncompressed magnitude.
  358. F32 mag;
  359. if ( readFlag() )
  360. mag = readFloat( magBits ) * maxMag;
  361. else
  362. read( &mag );
  363. // Finally read the normal and reconstruct the vector.
  364. readNormalVector( outVec, normalBits );
  365. *outVec *= mag;
  366. }
  367. void BitStream::writeAffineTransform(const MatrixF& matrix)
  368. {
  369. // AssertFatal(matrix.isAffine() == true,
  370. // "BitStream::writeAffineTransform: Error, must write only affine transforms!");
  371. Point3F pos;
  372. matrix.getColumn(3, &pos);
  373. mathWrite(*this, pos);
  374. QuatF q(matrix);
  375. q.normalize();
  376. write(q.x);
  377. write(q.y);
  378. write(q.z);
  379. writeFlag(q.w < 0.0);
  380. }
  381. void BitStream::readAffineTransform(MatrixF* matrix)
  382. {
  383. Point3F pos;
  384. QuatF q;
  385. mathRead(*this, &pos);
  386. read(&q.x);
  387. read(&q.y);
  388. read(&q.z);
  389. q.w = mSqrt(1.0 - getMin(F32(((q.x * q.x) + (q.y * q.y) + (q.z * q.z))), 1.f));
  390. if (readFlag())
  391. q.w = -q.w;
  392. q.setMatrix(matrix);
  393. matrix->setColumn(3, pos);
  394. // AssertFatal(matrix->isAffine() == true,
  395. // "BitStream::readAffineTransform: Error, transform should be affine after this function!");
  396. }
  397. void BitStream::writeQuat( const QuatF& quat, U32 bitCount )
  398. {
  399. writeSignedFloat( quat.x, bitCount );
  400. writeSignedFloat( quat.y, bitCount );
  401. writeSignedFloat( quat.z, bitCount );
  402. writeFlag( quat.w < 0.0f );
  403. }
  404. void BitStream::readQuat( QuatF *outQuat, U32 bitCount )
  405. {
  406. outQuat->x = readSignedFloat( bitCount );
  407. outQuat->y = readSignedFloat( bitCount );
  408. outQuat->z = readSignedFloat( bitCount );
  409. outQuat->w = mSqrt( 1.0 - getMin( mSquared( outQuat->x ) +
  410. mSquared( outQuat->y ) +
  411. mSquared( outQuat->z ),
  412. 1.0f ) );
  413. if ( readFlag() )
  414. outQuat->w = -outQuat->w;
  415. }
  416. void BitStream::writeBits( const BitVector &bitvec )
  417. {
  418. U32 size = bitvec.getSize();
  419. if ( writeFlag( size <= 127 ) )
  420. writeInt( size, 7 );
  421. else
  422. write( size );
  423. writeBits( bitvec.getSize(), bitvec.getBits() );
  424. }
  425. void BitStream::readBits( BitVector *bitvec )
  426. {
  427. U32 size;
  428. if ( readFlag() ) // size <= 127
  429. size = readInt( 7 );
  430. else
  431. read( &size );
  432. bitvec->setSize( size );
  433. readBits( size, bitvec->getBits() );
  434. }
  435. //----------------------------------------------------------------------------
  436. void BitStream::clearCompressionPoint()
  437. {
  438. mCompressPoint.set(0,0,0);
  439. }
  440. void BitStream::setCompressionPoint(const Point3F& p)
  441. {
  442. mCompressPoint = p;
  443. }
  444. static U32 gBitCounts[4] = {
  445. 16, 18, 20, 32
  446. };
  447. void BitStream::writeCompressedPoint(const Point3F& p,F32 scale)
  448. {
  449. // Same # of bits for all axis
  450. Point3F vec;
  451. F32 invScale = 1 / scale;
  452. U32 type;
  453. vec = p - mCompressPoint;
  454. F32 dist = vec.len() * invScale;
  455. if(dist < (1 << 15))
  456. type = 0;
  457. else if(dist < (1 << 17))
  458. type = 1;
  459. else if(dist < (1 << 19))
  460. type = 2;
  461. else
  462. type = 3;
  463. writeInt(type, 2);
  464. if (type != 3)
  465. {
  466. type = gBitCounts[type];
  467. writeSignedInt(S32(vec.x * invScale + 0.5f),type);
  468. writeSignedInt(S32(vec.y * invScale + 0.5f),type);
  469. writeSignedInt(S32(vec.z * invScale + 0.5f),type);
  470. }
  471. else
  472. {
  473. write(p.x);
  474. write(p.y);
  475. write(p.z);
  476. }
  477. }
  478. void BitStream::readCompressedPoint(Point3F* p,F32 scale)
  479. {
  480. // Same # of bits for all axis
  481. U32 type = readInt(2);
  482. if(type == 3)
  483. {
  484. read(&p->x);
  485. read(&p->y);
  486. read(&p->z);
  487. }
  488. else
  489. {
  490. type = gBitCounts[type];
  491. p->x = (F32)readSignedInt(type);
  492. p->y = (F32)readSignedInt(type);
  493. p->z = (F32)readSignedInt(type);
  494. p->x = mCompressPoint.x + p->x * scale;
  495. p->y = mCompressPoint.y + p->y * scale;
  496. p->z = mCompressPoint.z + p->z * scale;
  497. }
  498. }
  499. //------------------------------------------------------------------------------
  500. InfiniteBitStream::InfiniteBitStream()
  501. {
  502. //
  503. }
  504. InfiniteBitStream::~InfiniteBitStream()
  505. {
  506. //
  507. }
  508. void InfiniteBitStream::reset()
  509. {
  510. // Rewing back to beginning
  511. setPosition(0);
  512. }
  513. void InfiniteBitStream::validate(U32 upcomingBytes)
  514. {
  515. if(getPosition() + upcomingBytes + mMinSpace > bufSize)
  516. {
  517. bufSize = getPosition() + upcomingBytes + mMinSpace;
  518. dataPtr = (U8 *) dRealloc(dataPtr, bufSize);
  519. maxReadBitNum = bufSize << 3;
  520. maxWriteBitNum = bufSize << 3;
  521. }
  522. }
  523. void InfiniteBitStream::compact()
  524. {
  525. // Prepare to copy...
  526. U32 oldSize = bufSize;
  527. U8 *tmp = (U8*)dMalloc(bufSize);
  528. // Copy things...
  529. bufSize = getPosition() + mMinSpace * 2;
  530. dMemcpy(tmp, dataPtr, oldSize);
  531. // And clean up.
  532. dFree(dataPtr);
  533. dataPtr = tmp;
  534. maxReadBitNum = bufSize << 3;
  535. maxWriteBitNum = bufSize << 3;
  536. }
  537. void InfiniteBitStream::writeToStream(Stream &s)
  538. {
  539. s.write(getPosition(), dataPtr);
  540. }
  541. //------------------------------------------------------------------------------
  542. void BitStream::readString(char buf[256])
  543. {
  544. if(stringBuffer)
  545. {
  546. if(readFlag())
  547. {
  548. S32 offset = readInt(8);
  549. HuffmanProcessor::g_huffProcessor.readHuffBuffer(this, stringBuffer + offset);
  550. dStrcpy(buf, stringBuffer);
  551. return;
  552. }
  553. }
  554. HuffmanProcessor::g_huffProcessor.readHuffBuffer(this, buf);
  555. if(stringBuffer)
  556. dStrcpy(stringBuffer, buf);
  557. }
  558. void BitStream::writeString(const char *string, S32 maxLen)
  559. {
  560. if(!string)
  561. string = "";
  562. if(stringBuffer)
  563. {
  564. S32 j;
  565. for(j = 0; j < maxLen && stringBuffer[j] == string[j] && string[j];j++)
  566. ;
  567. dStrncpy(stringBuffer, string, maxLen);
  568. stringBuffer[maxLen] = 0;
  569. if(writeFlag(j > 2))
  570. {
  571. writeInt(j, 8);
  572. HuffmanProcessor::g_huffProcessor.writeHuffBuffer(this, string + j, maxLen - j);
  573. return;
  574. }
  575. }
  576. HuffmanProcessor::g_huffProcessor.writeHuffBuffer(this, string, maxLen);
  577. }
  578. void HuffmanProcessor::buildTables()
  579. {
  580. AssertFatal(m_tablesBuilt == false, "Cannot build tables twice!");
  581. m_tablesBuilt = true;
  582. S32 i;
  583. // First, construct the array of wraps...
  584. //
  585. m_huffLeaves.setSize(256);
  586. m_huffNodes.reserve(256);
  587. m_huffNodes.increment();
  588. for (i = 0; i < 256; i++) {
  589. HuffLeaf& rLeaf = m_huffLeaves[i];
  590. rLeaf.pop = csm_charFreqs[i] + 1;
  591. rLeaf.symbol = U8(i);
  592. dMemset(&rLeaf.code, 0, sizeof(rLeaf.code));
  593. rLeaf.numBits = 0;
  594. }
  595. S32 currWraps = 256;
  596. HuffWrap* pWrap = new HuffWrap[256];
  597. for (i = 0; i < 256; i++) {
  598. pWrap[i].set(&m_huffLeaves[i]);
  599. }
  600. while (currWraps != 1) {
  601. U32 min1 = 0xfffffffe, min2 = 0xffffffff;
  602. S32 index1 = -1, index2 = -1;
  603. for (i = 0; i < currWraps; i++) {
  604. if (pWrap[i].getPop() < min1) {
  605. min2 = min1;
  606. index2 = index1;
  607. min1 = pWrap[i].getPop();
  608. index1 = i;
  609. } else if (pWrap[i].getPop() < min2) {
  610. min2 = pWrap[i].getPop();
  611. index2 = i;
  612. }
  613. }
  614. AssertFatal(index1 != -1 && index2 != -1 && index1 != index2, "hrph");
  615. // Create a node for this...
  616. m_huffNodes.increment();
  617. HuffNode& rNode = m_huffNodes.last();
  618. rNode.pop = pWrap[index1].getPop() + pWrap[index2].getPop();
  619. rNode.index0 = determineIndex(pWrap[index1]);
  620. rNode.index1 = determineIndex(pWrap[index2]);
  621. S32 mergeIndex = index1 > index2 ? index2 : index1;
  622. S32 nukeIndex = index1 > index2 ? index1 : index2;
  623. pWrap[mergeIndex].set(&rNode);
  624. if (index2 != (currWraps - 1)) {
  625. pWrap[nukeIndex] = pWrap[currWraps - 1];
  626. }
  627. currWraps--;
  628. }
  629. AssertFatal(currWraps == 1, "wrong wraps?");
  630. AssertFatal(pWrap[0].pNode != NULL && pWrap[0].pLeaf == NULL, "Wrong wrap type!");
  631. // Ok, now we have one wrap, which is a node. we need to make sure that this
  632. // is the first node in the node list.
  633. m_huffNodes[0] = *(pWrap[0].pNode);
  634. delete [] pWrap;
  635. U32 code = 0;
  636. BitStream bs(&code, 4);
  637. generateCodes(bs, 0, 0);
  638. }
  639. void HuffmanProcessor::generateCodes(BitStream& rBS, S32 index, S32 depth)
  640. {
  641. if (index < 0) {
  642. // leaf node, copy the code in, and back out...
  643. HuffLeaf& rLeaf = m_huffLeaves[-(index + 1)];
  644. dMemcpy(&rLeaf.code, rBS.dataPtr, sizeof(rLeaf.code));
  645. rLeaf.numBits = depth;
  646. } else {
  647. HuffNode& rNode = m_huffNodes[index];
  648. S32 pos = rBS.getCurPos();
  649. rBS.writeFlag(false);
  650. generateCodes(rBS, rNode.index0, depth + 1);
  651. rBS.setCurPos(pos);
  652. rBS.writeFlag(true);
  653. generateCodes(rBS, rNode.index1, depth + 1);
  654. rBS.setCurPos(pos);
  655. }
  656. }
  657. S16 HuffmanProcessor::determineIndex(HuffWrap& rWrap)
  658. {
  659. if (rWrap.pLeaf != NULL) {
  660. AssertFatal(rWrap.pNode == NULL, "Got a non-NULL pNode in a HuffWrap with a non-NULL leaf.");
  661. return -((rWrap.pLeaf - m_huffLeaves.address()) + 1);
  662. } else {
  663. AssertFatal(rWrap.pNode != NULL, "Got a NULL pNode in a HuffWrap with a NULL leaf.");
  664. return rWrap.pNode - m_huffNodes.address();
  665. }
  666. }
  667. bool HuffmanProcessor::readHuffBuffer(BitStream* pStream, char* out_pBuffer)
  668. {
  669. if (m_tablesBuilt == false)
  670. buildTables();
  671. if (pStream->readFlag()) {
  672. S32 len = pStream->readInt(8);
  673. for (S32 i = 0; i < len; i++) {
  674. S32 index = 0;
  675. while (true) {
  676. if (index >= 0) {
  677. if (pStream->readFlag() == true) {
  678. index = m_huffNodes[index].index1;
  679. } else {
  680. index = m_huffNodes[index].index0;
  681. }
  682. } else {
  683. out_pBuffer[i] = m_huffLeaves[-(index+1)].symbol;
  684. break;
  685. }
  686. }
  687. }
  688. out_pBuffer[len] = '\0';
  689. return true;
  690. } else {
  691. // Uncompressed string...
  692. U32 len = pStream->readInt(8);
  693. pStream->read(len, out_pBuffer);
  694. out_pBuffer[len] = '\0';
  695. return true;
  696. }
  697. }
  698. bool HuffmanProcessor::writeHuffBuffer(BitStream* pStream, const char* out_pBuffer, S32 maxLen)
  699. {
  700. if (out_pBuffer == NULL) {
  701. pStream->writeFlag(false);
  702. pStream->writeInt(0, 8);
  703. return true;
  704. }
  705. if (m_tablesBuilt == false)
  706. buildTables();
  707. S32 len = out_pBuffer ? dStrlen(out_pBuffer) : 0;
  708. AssertWarn(len <= 255, "String TOO long for writeString");
  709. AssertWarn(len <= 255, out_pBuffer);
  710. if (len > maxLen)
  711. len = maxLen;
  712. S32 numBits = 0;
  713. S32 i;
  714. for (i = 0; i < len; i++)
  715. numBits += m_huffLeaves[(unsigned char)out_pBuffer[i]].numBits;
  716. if (numBits >= (len * 8)) {
  717. pStream->writeFlag(false);
  718. pStream->writeInt(len, 8);
  719. pStream->write(len, out_pBuffer);
  720. } else {
  721. pStream->writeFlag(true);
  722. pStream->writeInt(len, 8);
  723. for (i = 0; i < len; i++) {
  724. HuffLeaf& rLeaf = m_huffLeaves[((unsigned char)out_pBuffer[i])];
  725. pStream->writeBits(rLeaf.numBits, &rLeaf.code);
  726. }
  727. }
  728. return true;
  729. }
  730. const U32 HuffmanProcessor::csm_charFreqs[256] = {
  731. 0 ,
  732. 0 ,
  733. 0 ,
  734. 0 ,
  735. 0 ,
  736. 0 ,
  737. 0 ,
  738. 0 ,
  739. 0 ,
  740. 329 ,
  741. 21 ,
  742. 0 ,
  743. 0 ,
  744. 0 ,
  745. 0 ,
  746. 0 ,
  747. 0 ,
  748. 0 ,
  749. 0 ,
  750. 0 ,
  751. 0 ,
  752. 0 ,
  753. 0 ,
  754. 0 ,
  755. 0 ,
  756. 0 ,
  757. 0 ,
  758. 0 ,
  759. 0 ,
  760. 0 ,
  761. 0 ,
  762. 0 ,
  763. 2809 ,
  764. 68 ,
  765. 0 ,
  766. 27 ,
  767. 0 ,
  768. 58 ,
  769. 3 ,
  770. 62 ,
  771. 4 ,
  772. 7 ,
  773. 0 ,
  774. 0 ,
  775. 15 ,
  776. 65 ,
  777. 554 ,
  778. 3 ,
  779. 394 ,
  780. 404 ,
  781. 189 ,
  782. 117 ,
  783. 30 ,
  784. 51 ,
  785. 27 ,
  786. 15 ,
  787. 34 ,
  788. 32 ,
  789. 80 ,
  790. 1 ,
  791. 142 ,
  792. 3 ,
  793. 142 ,
  794. 39 ,
  795. 0 ,
  796. 144 ,
  797. 125 ,
  798. 44 ,
  799. 122 ,
  800. 275 ,
  801. 70 ,
  802. 135 ,
  803. 61 ,
  804. 127 ,
  805. 8 ,
  806. 12 ,
  807. 113 ,
  808. 246 ,
  809. 122 ,
  810. 36 ,
  811. 185 ,
  812. 1 ,
  813. 149 ,
  814. 309 ,
  815. 335 ,
  816. 12 ,
  817. 11 ,
  818. 14 ,
  819. 54 ,
  820. 151 ,
  821. 0 ,
  822. 0 ,
  823. 2 ,
  824. 0 ,
  825. 0 ,
  826. 211 ,
  827. 0 ,
  828. 2090 ,
  829. 344 ,
  830. 736 ,
  831. 993 ,
  832. 2872 ,
  833. 701 ,
  834. 605 ,
  835. 646 ,
  836. 1552 ,
  837. 328 ,
  838. 305 ,
  839. 1240 ,
  840. 735 ,
  841. 1533 ,
  842. 1713 ,
  843. 562 ,
  844. 3 ,
  845. 1775 ,
  846. 1149 ,
  847. 1469 ,
  848. 979 ,
  849. 407 ,
  850. 553 ,
  851. 59 ,
  852. 279 ,
  853. 31 ,
  854. 0 ,
  855. 0 ,
  856. 0 ,
  857. 68 ,
  858. 0 ,
  859. 0 ,
  860. 0 ,
  861. 0 ,
  862. 0 ,
  863. 0 ,
  864. 0 ,
  865. 0 ,
  866. 0 ,
  867. 0 ,
  868. 0 ,
  869. 0 ,
  870. 0 ,
  871. 0 ,
  872. 0 ,
  873. 0 ,
  874. 0 ,
  875. 0 ,
  876. 0 ,
  877. 0 ,
  878. 0 ,
  879. 0 ,
  880. 0 ,
  881. 0 ,
  882. 0 ,
  883. 0 ,
  884. 0 ,
  885. 0 ,
  886. 0 ,
  887. 0 ,
  888. 0 ,
  889. 0 ,
  890. 0 ,
  891. 0 ,
  892. 0 ,
  893. 0 ,
  894. 0 ,
  895. 0 ,
  896. 0 ,
  897. 0 ,
  898. 0 ,
  899. 0 ,
  900. 0 ,
  901. 0 ,
  902. 0 ,
  903. 0 ,
  904. 0 ,
  905. 0 ,
  906. 0 ,
  907. 0 ,
  908. 0 ,
  909. 0 ,
  910. 0 ,
  911. 0 ,
  912. 0 ,
  913. 0 ,
  914. 0 ,
  915. 0 ,
  916. 0 ,
  917. 0 ,
  918. 0 ,
  919. 0 ,
  920. 0 ,
  921. 0 ,
  922. 0 ,
  923. 0 ,
  924. 0 ,
  925. 0 ,
  926. 0 ,
  927. 0 ,
  928. 0 ,
  929. 0 ,
  930. 0 ,
  931. 0 ,
  932. 0 ,
  933. 0 ,
  934. 0 ,
  935. 0 ,
  936. 0 ,
  937. 0 ,
  938. 0 ,
  939. 0 ,
  940. 0 ,
  941. 0 ,
  942. 0 ,
  943. 0 ,
  944. 0 ,
  945. 0 ,
  946. 0 ,
  947. 0 ,
  948. 0 ,
  949. 0 ,
  950. 0 ,
  951. 0 ,
  952. 0 ,
  953. 0 ,
  954. 0 ,
  955. 0 ,
  956. 0 ,
  957. 0 ,
  958. 0 ,
  959. 0 ,
  960. 0 ,
  961. 0 ,
  962. 0 ,
  963. 0 ,
  964. 0 ,
  965. 0 ,
  966. 0 ,
  967. 0 ,
  968. 0 ,
  969. 0 ,
  970. 0 ,
  971. 0 ,
  972. 0 ,
  973. 0 ,
  974. 0 ,
  975. 0 ,
  976. 0 ,
  977. 0 ,
  978. 0 ,
  979. 0 ,
  980. 0 ,
  981. 0 ,
  982. 0 ,
  983. 0 ,
  984. 0 ,
  985. 0 ,
  986. 0
  987. };