bitwise.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858
  1. /********************************************************************
  2. * *
  3. * THIS FILE IS PART OF THE Ogg CONTAINER SOURCE CODE. *
  4. * USE, DISTRIBUTION AND REPRODUCTION OF THIS LIBRARY SOURCE IS *
  5. * GOVERNED BY A BSD-STYLE SOURCE LICENSE INCLUDED WITH THIS SOURCE *
  6. * IN 'COPYING'. PLEASE READ THESE TERMS BEFORE DISTRIBUTING. *
  7. * *
  8. * THE OggVorbis SOURCE CODE IS (C) COPYRIGHT 1994-2010 *
  9. * by the Xiph.Org Foundation http://www.xiph.org/ *
  10. * *
  11. ********************************************************************
  12. function: packing variable sized words into an octet stream
  13. last mod: $Id: bitwise.c 17287 2010-06-10 13:42:06Z tterribe $
  14. ********************************************************************/
  15. /* We're 'LSb' endian; if we write a word but read individual bits,
  16. then we'll read the lsb first */
  17. #include <string.h>
  18. #include <stdlib.h>
  19. #include <limits.h>
  20. #include <ogg/ogg.h>
  21. #define BUFFER_INCREMENT 256
  22. static const unsigned long mask[]=
  23. {0x00000000,0x00000001,0x00000003,0x00000007,0x0000000f,
  24. 0x0000001f,0x0000003f,0x0000007f,0x000000ff,0x000001ff,
  25. 0x000003ff,0x000007ff,0x00000fff,0x00001fff,0x00003fff,
  26. 0x00007fff,0x0000ffff,0x0001ffff,0x0003ffff,0x0007ffff,
  27. 0x000fffff,0x001fffff,0x003fffff,0x007fffff,0x00ffffff,
  28. 0x01ffffff,0x03ffffff,0x07ffffff,0x0fffffff,0x1fffffff,
  29. 0x3fffffff,0x7fffffff,0xffffffff };
  30. static const unsigned int mask8B[]=
  31. {0x00,0x80,0xc0,0xe0,0xf0,0xf8,0xfc,0xfe,0xff};
  32. void oggpack_writeinit(oggpack_buffer *b){
  33. memset(b,0,sizeof(*b));
  34. b->ptr=b->buffer=_ogg_malloc(BUFFER_INCREMENT);
  35. b->buffer[0]='\0';
  36. b->storage=BUFFER_INCREMENT;
  37. }
  38. void oggpackB_writeinit(oggpack_buffer *b){
  39. oggpack_writeinit(b);
  40. }
  41. int oggpack_writecheck(oggpack_buffer *b){
  42. if(!b->ptr || !b->storage)return -1;
  43. return 0;
  44. }
  45. int oggpackB_writecheck(oggpack_buffer *b){
  46. return oggpack_writecheck(b);
  47. }
  48. void oggpack_writetrunc(oggpack_buffer *b,long bits){
  49. long bytes=bits>>3;
  50. if(b->ptr){
  51. bits-=bytes*8;
  52. b->ptr=b->buffer+bytes;
  53. b->endbit=bits;
  54. b->endbyte=bytes;
  55. *b->ptr&=mask[bits];
  56. }
  57. }
  58. void oggpackB_writetrunc(oggpack_buffer *b,long bits){
  59. long bytes=bits>>3;
  60. if(b->ptr){
  61. bits-=bytes*8;
  62. b->ptr=b->buffer+bytes;
  63. b->endbit=bits;
  64. b->endbyte=bytes;
  65. *b->ptr&=mask8B[bits];
  66. }
  67. }
  68. /* Takes only up to 32 bits. */
  69. void oggpack_write(oggpack_buffer *b,unsigned long value,int bits){
  70. if(bits<0 || bits>32) goto err;
  71. if(b->endbyte>=b->storage-4){
  72. void *ret;
  73. if(!b->ptr)return;
  74. if(b->storage>LONG_MAX-BUFFER_INCREMENT) goto err;
  75. ret=_ogg_realloc(b->buffer,b->storage+BUFFER_INCREMENT);
  76. if(!ret) goto err;
  77. b->buffer=ret;
  78. b->storage+=BUFFER_INCREMENT;
  79. b->ptr=b->buffer+b->endbyte;
  80. }
  81. value&=mask[bits];
  82. bits+=b->endbit;
  83. b->ptr[0]|=value<<b->endbit;
  84. if(bits>=8){
  85. b->ptr[1]=(unsigned char)(value>>(8-b->endbit));
  86. if(bits>=16){
  87. b->ptr[2]=(unsigned char)(value>>(16-b->endbit));
  88. if(bits>=24){
  89. b->ptr[3]=(unsigned char)(value>>(24-b->endbit));
  90. if(bits>=32){
  91. if(b->endbit)
  92. b->ptr[4]=(unsigned char)(value>>(32-b->endbit));
  93. else
  94. b->ptr[4]=0;
  95. }
  96. }
  97. }
  98. }
  99. b->endbyte+=bits/8;
  100. b->ptr+=bits/8;
  101. b->endbit=bits&7;
  102. return;
  103. err:
  104. oggpack_writeclear(b);
  105. }
  106. /* Takes only up to 32 bits. */
  107. void oggpackB_write(oggpack_buffer *b,unsigned long value,int bits){
  108. if(bits<0 || bits>32) goto err;
  109. if(b->endbyte>=b->storage-4){
  110. void *ret;
  111. if(!b->ptr)return;
  112. if(b->storage>LONG_MAX-BUFFER_INCREMENT) goto err;
  113. ret=_ogg_realloc(b->buffer,b->storage+BUFFER_INCREMENT);
  114. if(!ret) goto err;
  115. b->buffer=ret;
  116. b->storage+=BUFFER_INCREMENT;
  117. b->ptr=b->buffer+b->endbyte;
  118. }
  119. value=(value&mask[bits])<<(32-bits);
  120. bits+=b->endbit;
  121. b->ptr[0]|=value>>(24+b->endbit);
  122. if(bits>=8){
  123. b->ptr[1]=(unsigned char)(value>>(16+b->endbit));
  124. if(bits>=16){
  125. b->ptr[2]=(unsigned char)(value>>(8+b->endbit));
  126. if(bits>=24){
  127. b->ptr[3]=(unsigned char)(value>>(b->endbit));
  128. if(bits>=32){
  129. if(b->endbit)
  130. b->ptr[4]=(unsigned char)(value<<(8-b->endbit));
  131. else
  132. b->ptr[4]=0;
  133. }
  134. }
  135. }
  136. }
  137. b->endbyte+=bits/8;
  138. b->ptr+=bits/8;
  139. b->endbit=bits&7;
  140. return;
  141. err:
  142. oggpack_writeclear(b);
  143. }
  144. void oggpack_writealign(oggpack_buffer *b){
  145. int bits=8-b->endbit;
  146. if(bits<8)
  147. oggpack_write(b,0,bits);
  148. }
  149. void oggpackB_writealign(oggpack_buffer *b){
  150. int bits=8-b->endbit;
  151. if(bits<8)
  152. oggpackB_write(b,0,bits);
  153. }
  154. static void oggpack_writecopy_helper(oggpack_buffer *b,
  155. void *source,
  156. long bits,
  157. void (*w)(oggpack_buffer *,
  158. unsigned long,
  159. int),
  160. int msb){
  161. unsigned char *ptr=(unsigned char *)source;
  162. long bytes=bits/8;
  163. bits-=bytes*8;
  164. if(b->endbit){
  165. int i;
  166. /* unaligned copy. Do it the hard way. */
  167. for(i=0;i<bytes;i++)
  168. w(b,(unsigned long)(ptr[i]),8);
  169. }else{
  170. /* aligned block copy */
  171. if(b->endbyte+bytes+1>=b->storage){
  172. void *ret;
  173. if(!b->ptr) goto err;
  174. if(b->endbyte+bytes+BUFFER_INCREMENT>b->storage) goto err;
  175. b->storage=b->endbyte+bytes+BUFFER_INCREMENT;
  176. ret=_ogg_realloc(b->buffer,b->storage);
  177. if(!ret) goto err;
  178. b->buffer=ret;
  179. b->ptr=b->buffer+b->endbyte;
  180. }
  181. memmove(b->ptr,source,bytes);
  182. b->ptr+=bytes;
  183. b->endbyte+=bytes;
  184. *b->ptr=0;
  185. }
  186. if(bits){
  187. if(msb)
  188. w(b,(unsigned long)(ptr[bytes]>>(8-bits)),bits);
  189. else
  190. w(b,(unsigned long)(ptr[bytes]),bits);
  191. }
  192. return;
  193. err:
  194. oggpack_writeclear(b);
  195. }
  196. void oggpack_writecopy(oggpack_buffer *b,void *source,long bits){
  197. oggpack_writecopy_helper(b,source,bits,oggpack_write,0);
  198. }
  199. void oggpackB_writecopy(oggpack_buffer *b,void *source,long bits){
  200. oggpack_writecopy_helper(b,source,bits,oggpackB_write,1);
  201. }
  202. void oggpack_reset(oggpack_buffer *b){
  203. if(!b->ptr)return;
  204. b->ptr=b->buffer;
  205. b->buffer[0]=0;
  206. b->endbit=b->endbyte=0;
  207. }
  208. void oggpackB_reset(oggpack_buffer *b){
  209. oggpack_reset(b);
  210. }
  211. void oggpack_writeclear(oggpack_buffer *b){
  212. if(b->buffer)_ogg_free(b->buffer);
  213. memset(b,0,sizeof(*b));
  214. }
  215. void oggpackB_writeclear(oggpack_buffer *b){
  216. oggpack_writeclear(b);
  217. }
  218. void oggpack_readinit(oggpack_buffer *b,unsigned char *buf,int bytes){
  219. memset(b,0,sizeof(*b));
  220. b->buffer=b->ptr=buf;
  221. b->storage=bytes;
  222. }
  223. void oggpackB_readinit(oggpack_buffer *b,unsigned char *buf,int bytes){
  224. oggpack_readinit(b,buf,bytes);
  225. }
  226. /* Read in bits without advancing the bitptr; bits <= 32 */
  227. long oggpack_look(oggpack_buffer *b,int bits){
  228. unsigned long ret;
  229. unsigned long m;
  230. if(bits<0 || bits>32) return -1;
  231. m=mask[bits];
  232. bits+=b->endbit;
  233. if(b->endbyte >= b->storage-4){
  234. /* not the main path */
  235. if(b->endbyte > b->storage-((bits+7)>>3)) return -1;
  236. /* special case to avoid reading b->ptr[0], which might be past the end of
  237. the buffer; also skips some useless accounting */
  238. else if(!bits)return(0L);
  239. }
  240. ret=b->ptr[0]>>b->endbit;
  241. if(bits>8){
  242. ret|=b->ptr[1]<<(8-b->endbit);
  243. if(bits>16){
  244. ret|=b->ptr[2]<<(16-b->endbit);
  245. if(bits>24){
  246. ret|=b->ptr[3]<<(24-b->endbit);
  247. if(bits>32 && b->endbit)
  248. ret|=b->ptr[4]<<(32-b->endbit);
  249. }
  250. }
  251. }
  252. return(m&ret);
  253. }
  254. /* Read in bits without advancing the bitptr; bits <= 32 */
  255. long oggpackB_look(oggpack_buffer *b,int bits){
  256. unsigned long ret;
  257. int m=32-bits;
  258. if(m<0 || m>32) return -1;
  259. bits+=b->endbit;
  260. if(b->endbyte >= b->storage-4){
  261. /* not the main path */
  262. if(b->endbyte > b->storage-((bits+7)>>3)) return -1;
  263. /* special case to avoid reading b->ptr[0], which might be past the end of
  264. the buffer; also skips some useless accounting */
  265. else if(!bits)return(0L);
  266. }
  267. ret=b->ptr[0]<<(24+b->endbit);
  268. if(bits>8){
  269. ret|=b->ptr[1]<<(16+b->endbit);
  270. if(bits>16){
  271. ret|=b->ptr[2]<<(8+b->endbit);
  272. if(bits>24){
  273. ret|=b->ptr[3]<<(b->endbit);
  274. if(bits>32 && b->endbit)
  275. ret|=b->ptr[4]>>(8-b->endbit);
  276. }
  277. }
  278. }
  279. return ((ret&0xffffffff)>>(m>>1))>>((m+1)>>1);
  280. }
  281. long oggpack_look1(oggpack_buffer *b){
  282. if(b->endbyte>=b->storage)return(-1);
  283. return((b->ptr[0]>>b->endbit)&1);
  284. }
  285. long oggpackB_look1(oggpack_buffer *b){
  286. if(b->endbyte>=b->storage)return(-1);
  287. return((b->ptr[0]>>(7-b->endbit))&1);
  288. }
  289. void oggpack_adv(oggpack_buffer *b,int bits){
  290. bits+=b->endbit;
  291. if(b->endbyte > b->storage-((bits+7)>>3)) goto overflow;
  292. b->ptr+=bits/8;
  293. b->endbyte+=bits/8;
  294. b->endbit=bits&7;
  295. return;
  296. overflow:
  297. b->ptr=NULL;
  298. b->endbyte=b->storage;
  299. b->endbit=1;
  300. }
  301. void oggpackB_adv(oggpack_buffer *b,int bits){
  302. oggpack_adv(b,bits);
  303. }
  304. void oggpack_adv1(oggpack_buffer *b){
  305. if(++(b->endbit)>7){
  306. b->endbit=0;
  307. b->ptr++;
  308. b->endbyte++;
  309. }
  310. }
  311. void oggpackB_adv1(oggpack_buffer *b){
  312. oggpack_adv1(b);
  313. }
  314. /* bits <= 32 */
  315. long oggpack_read(oggpack_buffer *b,int bits){
  316. long ret;
  317. unsigned long m;
  318. if(bits<0 || bits>32) goto err;
  319. m=mask[bits];
  320. bits+=b->endbit;
  321. if(b->endbyte >= b->storage-4){
  322. /* not the main path */
  323. if(b->endbyte > b->storage-((bits+7)>>3)) goto overflow;
  324. /* special case to avoid reading b->ptr[0], which might be past the end of
  325. the buffer; also skips some useless accounting */
  326. else if(!bits)return(0L);
  327. }
  328. ret=b->ptr[0]>>b->endbit;
  329. if(bits>8){
  330. ret|=b->ptr[1]<<(8-b->endbit);
  331. if(bits>16){
  332. ret|=b->ptr[2]<<(16-b->endbit);
  333. if(bits>24){
  334. ret|=b->ptr[3]<<(24-b->endbit);
  335. if(bits>32 && b->endbit){
  336. ret|=b->ptr[4]<<(32-b->endbit);
  337. }
  338. }
  339. }
  340. }
  341. ret&=m;
  342. b->ptr+=bits/8;
  343. b->endbyte+=bits/8;
  344. b->endbit=bits&7;
  345. return ret;
  346. overflow:
  347. err:
  348. b->ptr=NULL;
  349. b->endbyte=b->storage;
  350. b->endbit=1;
  351. return -1L;
  352. }
  353. /* bits <= 32 */
  354. long oggpackB_read(oggpack_buffer *b,int bits){
  355. long ret;
  356. long m=32-bits;
  357. if(m<0 || m>32) goto err;
  358. bits+=b->endbit;
  359. if(b->endbyte+4>=b->storage){
  360. /* not the main path */
  361. if(b->endbyte > b->storage-((bits+7)>>3)) goto overflow;
  362. /* special case to avoid reading b->ptr[0], which might be past the end of
  363. the buffer; also skips some useless accounting */
  364. else if(!bits)return(0L);
  365. }
  366. ret=b->ptr[0]<<(24+b->endbit);
  367. if(bits>8){
  368. ret|=b->ptr[1]<<(16+b->endbit);
  369. if(bits>16){
  370. ret|=b->ptr[2]<<(8+b->endbit);
  371. if(bits>24){
  372. ret|=b->ptr[3]<<(b->endbit);
  373. if(bits>32 && b->endbit)
  374. ret|=b->ptr[4]>>(8-b->endbit);
  375. }
  376. }
  377. }
  378. ret=((ret&0xffffffffUL)>>(m>>1))>>((m+1)>>1);
  379. b->ptr+=bits/8;
  380. b->endbyte+=bits/8;
  381. b->endbit=bits&7;
  382. return ret;
  383. overflow:
  384. err:
  385. b->ptr=NULL;
  386. b->endbyte=b->storage;
  387. b->endbit=1;
  388. return -1L;
  389. }
  390. long oggpack_read1(oggpack_buffer *b){
  391. long ret;
  392. if(b->endbyte >= b->storage) goto overflow;
  393. ret=(b->ptr[0]>>b->endbit)&1;
  394. b->endbit++;
  395. if(b->endbit>7){
  396. b->endbit=0;
  397. b->ptr++;
  398. b->endbyte++;
  399. }
  400. return ret;
  401. overflow:
  402. b->ptr=NULL;
  403. b->endbyte=b->storage;
  404. b->endbit=1;
  405. return -1L;
  406. }
  407. long oggpackB_read1(oggpack_buffer *b){
  408. long ret;
  409. if(b->endbyte >= b->storage) goto overflow;
  410. ret=(b->ptr[0]>>(7-b->endbit))&1;
  411. b->endbit++;
  412. if(b->endbit>7){
  413. b->endbit=0;
  414. b->ptr++;
  415. b->endbyte++;
  416. }
  417. return ret;
  418. overflow:
  419. b->ptr=NULL;
  420. b->endbyte=b->storage;
  421. b->endbit=1;
  422. return -1L;
  423. }
  424. long oggpack_bytes(oggpack_buffer *b){
  425. return(b->endbyte+(b->endbit+7)/8);
  426. }
  427. long oggpack_bits(oggpack_buffer *b){
  428. return(b->endbyte*8+b->endbit);
  429. }
  430. long oggpackB_bytes(oggpack_buffer *b){
  431. return oggpack_bytes(b);
  432. }
  433. long oggpackB_bits(oggpack_buffer *b){
  434. return oggpack_bits(b);
  435. }
  436. unsigned char *oggpack_get_buffer(oggpack_buffer *b){
  437. return(b->buffer);
  438. }
  439. unsigned char *oggpackB_get_buffer(oggpack_buffer *b){
  440. return oggpack_get_buffer(b);
  441. }
  442. /* Self test of the bitwise routines; everything else is based on
  443. them, so they damned well better be solid. */
  444. #ifdef _V_SELFTEST
  445. #include <stdio.h>
  446. static int ilog(unsigned int v){
  447. int ret=0;
  448. while(v){
  449. ret++;
  450. v>>=1;
  451. }
  452. return(ret);
  453. }
  454. oggpack_buffer o;
  455. oggpack_buffer r;
  456. void report(char *in){
  457. fprintf(stderr,"%s",in);
  458. exit(1);
  459. }
  460. void cliptest(unsigned long *b,int vals,int bits,int *comp,int compsize){
  461. long bytes,i;
  462. unsigned char *buffer;
  463. oggpack_reset(&o);
  464. for(i=0;i<vals;i++)
  465. oggpack_write(&o,b[i],bits?bits:ilog(b[i]));
  466. buffer=oggpack_get_buffer(&o);
  467. bytes=oggpack_bytes(&o);
  468. if(bytes!=compsize)report("wrong number of bytes!\n");
  469. for(i=0;i<bytes;i++)if(buffer[i]!=comp[i]){
  470. for(i=0;i<bytes;i++)fprintf(stderr,"%x %x\n",(int)buffer[i],(int)comp[i]);
  471. report("wrote incorrect value!\n");
  472. }
  473. oggpack_readinit(&r,buffer,bytes);
  474. for(i=0;i<vals;i++){
  475. int tbit=bits?bits:ilog(b[i]);
  476. if(oggpack_look(&r,tbit)==-1)
  477. report("out of data!\n");
  478. if(oggpack_look(&r,tbit)!=(b[i]&mask[tbit]))
  479. report("looked at incorrect value!\n");
  480. if(tbit==1)
  481. if(oggpack_look1(&r)!=(b[i]&mask[tbit]))
  482. report("looked at single bit incorrect value!\n");
  483. if(tbit==1){
  484. if(oggpack_read1(&r)!=(b[i]&mask[tbit]))
  485. report("read incorrect single bit value!\n");
  486. }else{
  487. if(oggpack_read(&r,tbit)!=(b[i]&mask[tbit]))
  488. report("read incorrect value!\n");
  489. }
  490. }
  491. if(oggpack_bytes(&r)!=bytes)report("leftover bytes after read!\n");
  492. }
  493. void cliptestB(unsigned long *b,int vals,int bits,int *comp,int compsize){
  494. long bytes,i;
  495. unsigned char *buffer;
  496. oggpackB_reset(&o);
  497. for(i=0;i<vals;i++)
  498. oggpackB_write(&o,b[i],bits?bits:ilog(b[i]));
  499. buffer=oggpackB_get_buffer(&o);
  500. bytes=oggpackB_bytes(&o);
  501. if(bytes!=compsize)report("wrong number of bytes!\n");
  502. for(i=0;i<bytes;i++)if(buffer[i]!=comp[i]){
  503. for(i=0;i<bytes;i++)fprintf(stderr,"%x %x\n",(int)buffer[i],(int)comp[i]);
  504. report("wrote incorrect value!\n");
  505. }
  506. oggpackB_readinit(&r,buffer,bytes);
  507. for(i=0;i<vals;i++){
  508. int tbit=bits?bits:ilog(b[i]);
  509. if(oggpackB_look(&r,tbit)==-1)
  510. report("out of data!\n");
  511. if(oggpackB_look(&r,tbit)!=(b[i]&mask[tbit]))
  512. report("looked at incorrect value!\n");
  513. if(tbit==1)
  514. if(oggpackB_look1(&r)!=(b[i]&mask[tbit]))
  515. report("looked at single bit incorrect value!\n");
  516. if(tbit==1){
  517. if(oggpackB_read1(&r)!=(b[i]&mask[tbit]))
  518. report("read incorrect single bit value!\n");
  519. }else{
  520. if(oggpackB_read(&r,tbit)!=(b[i]&mask[tbit]))
  521. report("read incorrect value!\n");
  522. }
  523. }
  524. if(oggpackB_bytes(&r)!=bytes)report("leftover bytes after read!\n");
  525. }
  526. int main(void){
  527. unsigned char *buffer;
  528. long bytes,i;
  529. static unsigned long testbuffer1[]=
  530. {18,12,103948,4325,543,76,432,52,3,65,4,56,32,42,34,21,1,23,32,546,456,7,
  531. 567,56,8,8,55,3,52,342,341,4,265,7,67,86,2199,21,7,1,5,1,4};
  532. int test1size=43;
  533. static unsigned long testbuffer2[]=
  534. {216531625L,1237861823,56732452,131,3212421,12325343,34547562,12313212,
  535. 1233432,534,5,346435231,14436467,7869299,76326614,167548585,
  536. 85525151,0,12321,1,349528352};
  537. int test2size=21;
  538. static unsigned long testbuffer3[]=
  539. {1,0,14,0,1,0,12,0,1,0,0,0,1,1,0,1,0,1,0,1,0,1,0,1,0,1,0,0,1,1,1,1,1,0,0,1,
  540. 0,1,30,1,1,1,0,0,1,0,0,0,12,0,11,0,1,0,0,1};
  541. int test3size=56;
  542. static unsigned long large[]=
  543. {2136531625L,2137861823,56732452,131,3212421,12325343,34547562,12313212,
  544. 1233432,534,5,2146435231,14436467,7869299,76326614,167548585,
  545. 85525151,0,12321,1,2146528352};
  546. int onesize=33;
  547. static int one[33]={146,25,44,151,195,15,153,176,233,131,196,65,85,172,47,40,
  548. 34,242,223,136,35,222,211,86,171,50,225,135,214,75,172,
  549. 223,4};
  550. static int oneB[33]={150,101,131,33,203,15,204,216,105,193,156,65,84,85,222,
  551. 8,139,145,227,126,34,55,244,171,85,100,39,195,173,18,
  552. 245,251,128};
  553. int twosize=6;
  554. static int two[6]={61,255,255,251,231,29};
  555. static int twoB[6]={247,63,255,253,249,120};
  556. int threesize=54;
  557. static int three[54]={169,2,232,252,91,132,156,36,89,13,123,176,144,32,254,
  558. 142,224,85,59,121,144,79,124,23,67,90,90,216,79,23,83,
  559. 58,135,196,61,55,129,183,54,101,100,170,37,127,126,10,
  560. 100,52,4,14,18,86,77,1};
  561. static int threeB[54]={206,128,42,153,57,8,183,251,13,89,36,30,32,144,183,
  562. 130,59,240,121,59,85,223,19,228,180,134,33,107,74,98,
  563. 233,253,196,135,63,2,110,114,50,155,90,127,37,170,104,
  564. 200,20,254,4,58,106,176,144,0};
  565. int foursize=38;
  566. static int four[38]={18,6,163,252,97,194,104,131,32,1,7,82,137,42,129,11,72,
  567. 132,60,220,112,8,196,109,64,179,86,9,137,195,208,122,169,
  568. 28,2,133,0,1};
  569. static int fourB[38]={36,48,102,83,243,24,52,7,4,35,132,10,145,21,2,93,2,41,
  570. 1,219,184,16,33,184,54,149,170,132,18,30,29,98,229,67,
  571. 129,10,4,32};
  572. int fivesize=45;
  573. static int five[45]={169,2,126,139,144,172,30,4,80,72,240,59,130,218,73,62,
  574. 241,24,210,44,4,20,0,248,116,49,135,100,110,130,181,169,
  575. 84,75,159,2,1,0,132,192,8,0,0,18,22};
  576. static int fiveB[45]={1,84,145,111,245,100,128,8,56,36,40,71,126,78,213,226,
  577. 124,105,12,0,133,128,0,162,233,242,67,152,77,205,77,
  578. 172,150,169,129,79,128,0,6,4,32,0,27,9,0};
  579. int sixsize=7;
  580. static int six[7]={17,177,170,242,169,19,148};
  581. static int sixB[7]={136,141,85,79,149,200,41};
  582. /* Test read/write together */
  583. /* Later we test against pregenerated bitstreams */
  584. oggpack_writeinit(&o);
  585. fprintf(stderr,"\nSmall preclipped packing (LSb): ");
  586. cliptest(testbuffer1,test1size,0,one,onesize);
  587. fprintf(stderr,"ok.");
  588. fprintf(stderr,"\nNull bit call (LSb): ");
  589. cliptest(testbuffer3,test3size,0,two,twosize);
  590. fprintf(stderr,"ok.");
  591. fprintf(stderr,"\nLarge preclipped packing (LSb): ");
  592. cliptest(testbuffer2,test2size,0,three,threesize);
  593. fprintf(stderr,"ok.");
  594. fprintf(stderr,"\n32 bit preclipped packing (LSb): ");
  595. oggpack_reset(&o);
  596. for(i=0;i<test2size;i++)
  597. oggpack_write(&o,large[i],32);
  598. buffer=oggpack_get_buffer(&o);
  599. bytes=oggpack_bytes(&o);
  600. oggpack_readinit(&r,buffer,bytes);
  601. for(i=0;i<test2size;i++){
  602. if(oggpack_look(&r,32)==-1)report("out of data. failed!");
  603. if(oggpack_look(&r,32)!=large[i]){
  604. fprintf(stderr,"%ld != %ld (%lx!=%lx):",oggpack_look(&r,32),large[i],
  605. oggpack_look(&r,32),large[i]);
  606. report("read incorrect value!\n");
  607. }
  608. oggpack_adv(&r,32);
  609. }
  610. if(oggpack_bytes(&r)!=bytes)report("leftover bytes after read!\n");
  611. fprintf(stderr,"ok.");
  612. fprintf(stderr,"\nSmall unclipped packing (LSb): ");
  613. cliptest(testbuffer1,test1size,7,four,foursize);
  614. fprintf(stderr,"ok.");
  615. fprintf(stderr,"\nLarge unclipped packing (LSb): ");
  616. cliptest(testbuffer2,test2size,17,five,fivesize);
  617. fprintf(stderr,"ok.");
  618. fprintf(stderr,"\nSingle bit unclipped packing (LSb): ");
  619. cliptest(testbuffer3,test3size,1,six,sixsize);
  620. fprintf(stderr,"ok.");
  621. fprintf(stderr,"\nTesting read past end (LSb): ");
  622. oggpack_readinit(&r,(unsigned char *)"\0\0\0\0\0\0\0\0",8);
  623. for(i=0;i<64;i++){
  624. if(oggpack_read(&r,1)!=0){
  625. fprintf(stderr,"failed; got -1 prematurely.\n");
  626. exit(1);
  627. }
  628. }
  629. if(oggpack_look(&r,1)!=-1 ||
  630. oggpack_read(&r,1)!=-1){
  631. fprintf(stderr,"failed; read past end without -1.\n");
  632. exit(1);
  633. }
  634. oggpack_readinit(&r,(unsigned char *)"\0\0\0\0\0\0\0\0",8);
  635. if(oggpack_read(&r,30)!=0 || oggpack_read(&r,16)!=0){
  636. fprintf(stderr,"failed 2; got -1 prematurely.\n");
  637. exit(1);
  638. }
  639. if(oggpack_look(&r,18)!=0 ||
  640. oggpack_look(&r,18)!=0){
  641. fprintf(stderr,"failed 3; got -1 prematurely.\n");
  642. exit(1);
  643. }
  644. if(oggpack_look(&r,19)!=-1 ||
  645. oggpack_look(&r,19)!=-1){
  646. fprintf(stderr,"failed; read past end without -1.\n");
  647. exit(1);
  648. }
  649. if(oggpack_look(&r,32)!=-1 ||
  650. oggpack_look(&r,32)!=-1){
  651. fprintf(stderr,"failed; read past end without -1.\n");
  652. exit(1);
  653. }
  654. oggpack_writeclear(&o);
  655. fprintf(stderr,"ok.\n");
  656. /********** lazy, cut-n-paste retest with MSb packing ***********/
  657. /* Test read/write together */
  658. /* Later we test against pregenerated bitstreams */
  659. oggpackB_writeinit(&o);
  660. fprintf(stderr,"\nSmall preclipped packing (MSb): ");
  661. cliptestB(testbuffer1,test1size,0,oneB,onesize);
  662. fprintf(stderr,"ok.");
  663. fprintf(stderr,"\nNull bit call (MSb): ");
  664. cliptestB(testbuffer3,test3size,0,twoB,twosize);
  665. fprintf(stderr,"ok.");
  666. fprintf(stderr,"\nLarge preclipped packing (MSb): ");
  667. cliptestB(testbuffer2,test2size,0,threeB,threesize);
  668. fprintf(stderr,"ok.");
  669. fprintf(stderr,"\n32 bit preclipped packing (MSb): ");
  670. oggpackB_reset(&o);
  671. for(i=0;i<test2size;i++)
  672. oggpackB_write(&o,large[i],32);
  673. buffer=oggpackB_get_buffer(&o);
  674. bytes=oggpackB_bytes(&o);
  675. oggpackB_readinit(&r,buffer,bytes);
  676. for(i=0;i<test2size;i++){
  677. if(oggpackB_look(&r,32)==-1)report("out of data. failed!");
  678. if(oggpackB_look(&r,32)!=large[i]){
  679. fprintf(stderr,"%ld != %ld (%lx!=%lx):",oggpackB_look(&r,32),large[i],
  680. oggpackB_look(&r,32),large[i]);
  681. report("read incorrect value!\n");
  682. }
  683. oggpackB_adv(&r,32);
  684. }
  685. if(oggpackB_bytes(&r)!=bytes)report("leftover bytes after read!\n");
  686. fprintf(stderr,"ok.");
  687. fprintf(stderr,"\nSmall unclipped packing (MSb): ");
  688. cliptestB(testbuffer1,test1size,7,fourB,foursize);
  689. fprintf(stderr,"ok.");
  690. fprintf(stderr,"\nLarge unclipped packing (MSb): ");
  691. cliptestB(testbuffer2,test2size,17,fiveB,fivesize);
  692. fprintf(stderr,"ok.");
  693. fprintf(stderr,"\nSingle bit unclipped packing (MSb): ");
  694. cliptestB(testbuffer3,test3size,1,sixB,sixsize);
  695. fprintf(stderr,"ok.");
  696. fprintf(stderr,"\nTesting read past end (MSb): ");
  697. oggpackB_readinit(&r,(unsigned char *)"\0\0\0\0\0\0\0\0",8);
  698. for(i=0;i<64;i++){
  699. if(oggpackB_read(&r,1)!=0){
  700. fprintf(stderr,"failed; got -1 prematurely.\n");
  701. exit(1);
  702. }
  703. }
  704. if(oggpackB_look(&r,1)!=-1 ||
  705. oggpackB_read(&r,1)!=-1){
  706. fprintf(stderr,"failed; read past end without -1.\n");
  707. exit(1);
  708. }
  709. oggpackB_readinit(&r,(unsigned char *)"\0\0\0\0\0\0\0\0",8);
  710. if(oggpackB_read(&r,30)!=0 || oggpackB_read(&r,16)!=0){
  711. fprintf(stderr,"failed 2; got -1 prematurely.\n");
  712. exit(1);
  713. }
  714. if(oggpackB_look(&r,18)!=0 ||
  715. oggpackB_look(&r,18)!=0){
  716. fprintf(stderr,"failed 3; got -1 prematurely.\n");
  717. exit(1);
  718. }
  719. if(oggpackB_look(&r,19)!=-1 ||
  720. oggpackB_look(&r,19)!=-1){
  721. fprintf(stderr,"failed; read past end without -1.\n");
  722. exit(1);
  723. }
  724. if(oggpackB_look(&r,32)!=-1 ||
  725. oggpackB_look(&r,32)!=-1){
  726. fprintf(stderr,"failed; read past end without -1.\n");
  727. exit(1);
  728. }
  729. oggpackB_writeclear(&o);
  730. fprintf(stderr,"ok.\n\n");
  731. return(0);
  732. }
  733. #endif /* _V_SELFTEST */
  734. #undef BUFFER_INCREMENT