You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

500 lines
15KB

  1. /*
  2. * Copyright (C) 2003 the ffmpeg project
  3. *
  4. * This library is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU Lesser General Public
  6. * License as published by the Free Software Foundation; either
  7. * version 2 of the License, or (at your option) any later version.
  8. *
  9. * This library is distributed in the hope that it will be useful,
  10. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  12. * Lesser General Public License for more details.
  13. *
  14. * You should have received a copy of the GNU Lesser General Public
  15. * License along with this library; if not, write to the Free Software
  16. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  17. *
  18. */
  19. /**
  20. * @file roqvideo.c
  21. * Id RoQ Video Decoder by Dr. Tim Ferguson
  22. * For more information about the Id RoQ format, visit:
  23. * http://www.csse.monash.edu.au/~timf/
  24. */
  25. #include <stdio.h>
  26. #include <stdlib.h>
  27. #include <string.h>
  28. #include <unistd.h>
  29. #include "common.h"
  30. #include "avcodec.h"
  31. #include "dsputil.h"
  32. typedef struct {
  33. unsigned char y0, y1, y2, y3, u, v;
  34. } roq_cell;
  35. typedef struct {
  36. int idx[4];
  37. } roq_qcell;
  38. static int uiclip[1024], *uiclp; /* clipping table */
  39. #define avg2(a,b) uiclp[(((int)(a)+(int)(b)+1)>>1)]
  40. #define avg4(a,b,c,d) uiclp[(((int)(a)+(int)(b)+(int)(c)+(int)(d)+2)>>2)]
  41. typedef struct RoqContext {
  42. AVCodecContext *avctx;
  43. DSPContext dsp;
  44. AVFrame last_frame;
  45. AVFrame current_frame;
  46. int first_frame;
  47. int y_stride;
  48. int c_stride;
  49. roq_cell cells[256];
  50. roq_qcell qcells[256];
  51. unsigned char *buf;
  52. int size;
  53. } RoqContext;
  54. #define RoQ_INFO 0x1001
  55. #define RoQ_QUAD_CODEBOOK 0x1002
  56. #define RoQ_QUAD_VQ 0x1011
  57. #define RoQ_SOUND_MONO 0x1020
  58. #define RoQ_SOUND_STEREO 0x1021
  59. #define RoQ_ID_MOT 0x00
  60. #define RoQ_ID_FCC 0x01
  61. #define RoQ_ID_SLD 0x02
  62. #define RoQ_ID_CCC 0x03
  63. #define get_byte(in_buffer) *(in_buffer++)
  64. #define get_word(in_buffer) ((unsigned short)(in_buffer += 2, \
  65. (in_buffer[-1] << 8 | in_buffer[-2])))
  66. #define get_long(in_buffer) ((unsigned long)(in_buffer += 4, \
  67. (in_buffer[-1] << 24 | in_buffer[-2] << 16 | in_buffer[-3] << 8 | in_buffer[-4])))
  68. static void apply_vector_2x2(RoqContext *ri, int x, int y, roq_cell *cell)
  69. {
  70. unsigned char *yptr;
  71. yptr = ri->current_frame.data[0] + (y * ri->y_stride) + x;
  72. *yptr++ = cell->y0;
  73. *yptr++ = cell->y1;
  74. yptr += (ri->y_stride - 2);
  75. *yptr++ = cell->y2;
  76. *yptr++ = cell->y3;
  77. ri->current_frame.data[1][(y/2) * (ri->c_stride) + x/2] = cell->u;
  78. ri->current_frame.data[2][(y/2) * (ri->c_stride) + x/2] = cell->v;
  79. }
  80. static void apply_vector_4x4(RoqContext *ri, int x, int y, roq_cell *cell)
  81. {
  82. unsigned long row_inc, c_row_inc;
  83. register unsigned char y0, y1, u, v;
  84. unsigned char *yptr, *uptr, *vptr;
  85. yptr = ri->current_frame.data[0] + (y * ri->y_stride) + x;
  86. uptr = ri->current_frame.data[1] + (y/2) * (ri->c_stride) + x/2;
  87. vptr = ri->current_frame.data[2] + (y/2) * (ri->c_stride) + x/2;
  88. row_inc = ri->y_stride - 4;
  89. c_row_inc = (ri->c_stride) - 2;
  90. *yptr++ = y0 = cell->y0; *uptr++ = u = cell->u; *vptr++ = v = cell->v;
  91. *yptr++ = y0;
  92. *yptr++ = y1 = cell->y1; *uptr++ = u; *vptr++ = v;
  93. *yptr++ = y1;
  94. yptr += row_inc;
  95. *yptr++ = y0;
  96. *yptr++ = y0;
  97. *yptr++ = y1;
  98. *yptr++ = y1;
  99. yptr += row_inc; uptr += c_row_inc; vptr += c_row_inc;
  100. *yptr++ = y0 = cell->y2; *uptr++ = u; *vptr++ = v;
  101. *yptr++ = y0;
  102. *yptr++ = y1 = cell->y3; *uptr++ = u; *vptr++ = v;
  103. *yptr++ = y1;
  104. yptr += row_inc;
  105. *yptr++ = y0;
  106. *yptr++ = y0;
  107. *yptr++ = y1;
  108. *yptr++ = y1;
  109. }
  110. static void apply_motion_4x4(RoqContext *ri, int x, int y, unsigned char mv,
  111. signed char mean_x, signed char mean_y)
  112. {
  113. int i, hw, mx, my;
  114. unsigned char *pa, *pb;
  115. mx = x + 8 - (mv >> 4) - mean_x;
  116. my = y + 8 - (mv & 0xf) - mean_y;
  117. pa = ri->current_frame.data[0] + (y * ri->y_stride) + x;
  118. pb = ri->last_frame.data[0] + (my * ri->y_stride) + mx;
  119. for(i = 0; i < 4; i++) {
  120. pa[0] = pb[0];
  121. pa[1] = pb[1];
  122. pa[2] = pb[2];
  123. pa[3] = pb[3];
  124. pa += ri->y_stride;
  125. pb += ri->y_stride;
  126. }
  127. #if 0
  128. pa = ri->current_frame.data[1] + (y/2) * (ri->c_stride) + x/2;
  129. pb = ri->last_frame.data[1] + (my/2) * (ri->c_stride) + (mx + 1)/2;
  130. for(i = 0; i < 2; i++) {
  131. pa[0] = pb[0];
  132. pa[1] = pb[1];
  133. pa += ri->c_stride;
  134. pb += ri->c_stride;
  135. }
  136. pa = ri->current_frame.data[2] + (y/2) * (ri->c_stride) + x/2;
  137. pb = ri->last_frame.data[2] + (my/2) * (ri->c_stride) + (mx + 1)/2;
  138. for(i = 0; i < 2; i++) {
  139. pa[0] = pb[0];
  140. pa[1] = pb[1];
  141. pa += ri->c_stride;
  142. pb += ri->c_stride;
  143. }
  144. #else
  145. hw = ri->y_stride/2;
  146. pa = ri->current_frame.data[1] + (y * ri->y_stride)/4 + x/2;
  147. pb = ri->last_frame.data[1] + (my/2) * (ri->y_stride/2) + (mx + 1)/2;
  148. for(i = 0; i < 2; i++) {
  149. switch(((my & 0x01) << 1) | (mx & 0x01)) {
  150. case 0:
  151. pa[0] = pb[0];
  152. pa[1] = pb[1];
  153. pa[hw] = pb[hw];
  154. pa[hw+1] = pb[hw+1];
  155. break;
  156. case 1:
  157. pa[0] = avg2(pb[0], pb[1]);
  158. pa[1] = avg2(pb[1], pb[2]);
  159. pa[hw] = avg2(pb[hw], pb[hw+1]);
  160. pa[hw+1] = avg2(pb[hw+1], pb[hw+2]);
  161. break;
  162. case 2:
  163. pa[0] = avg2(pb[0], pb[hw]);
  164. pa[1] = avg2(pb[1], pb[hw+1]);
  165. pa[hw] = avg2(pb[hw], pb[hw*2]);
  166. pa[hw+1] = avg2(pb[hw+1], pb[(hw*2)+1]);
  167. break;
  168. case 3:
  169. pa[0] = avg4(pb[0], pb[1], pb[hw], pb[hw+1]);
  170. pa[1] = avg4(pb[1], pb[2], pb[hw+1], pb[hw+2]);
  171. pa[hw] = avg4(pb[hw], pb[hw+1], pb[hw*2], pb[(hw*2)+1]);
  172. pa[hw+1] = avg4(pb[hw+1], pb[hw+2], pb[(hw*2)+1], pb[(hw*2)+1]);
  173. break;
  174. }
  175. pa = ri->current_frame.data[2] + (y * ri->y_stride)/4 + x/2;
  176. pb = ri->last_frame.data[2] + (my/2) * (ri->y_stride/2) + (mx + 1)/2;
  177. }
  178. #endif
  179. }
  180. static void apply_motion_8x8(RoqContext *ri, int x, int y,
  181. unsigned char mv, signed char mean_x, signed char mean_y)
  182. {
  183. int mx, my, i, j, hw;
  184. unsigned char *pa, *pb;
  185. mx = x + 8 - (mv >> 4) - mean_x;
  186. my = y + 8 - (mv & 0xf) - mean_y;
  187. pa = ri->current_frame.data[0] + (y * ri->y_stride) + x;
  188. pb = ri->last_frame.data[0] + (my * ri->y_stride) + mx;
  189. for(i = 0; i < 8; i++) {
  190. pa[0] = pb[0];
  191. pa[1] = pb[1];
  192. pa[2] = pb[2];
  193. pa[3] = pb[3];
  194. pa[4] = pb[4];
  195. pa[5] = pb[5];
  196. pa[6] = pb[6];
  197. pa[7] = pb[7];
  198. pa += ri->y_stride;
  199. pb += ri->y_stride;
  200. }
  201. #if 0
  202. pa = ri->current_frame.data[1] + (y/2) * (ri->c_stride) + x/2;
  203. pb = ri->last_frame.data[1] + (my/2) * (ri->c_stride) + (mx + 1)/2;
  204. for(i = 0; i < 4; i++) {
  205. pa[0] = pb[0];
  206. pa[1] = pb[1];
  207. pa[2] = pb[2];
  208. pa[3] = pb[3];
  209. pa += ri->c_stride;
  210. pb += ri->c_stride;
  211. }
  212. pa = ri->current_frame.data[2] + (y/2) * (ri->c_stride) + x/2;
  213. pb = ri->last_frame.data[2] + (my/2) * (ri->c_stride) + (mx + 1)/2;
  214. for(i = 0; i < 4; i++) {
  215. pa[0] = pb[0];
  216. pa[1] = pb[1];
  217. pa[2] = pb[2];
  218. pa[3] = pb[3];
  219. pa += ri->c_stride;
  220. pb += ri->c_stride;
  221. }
  222. #else
  223. hw = ri->c_stride;
  224. pa = ri->current_frame.data[1] + (y * ri->y_stride)/4 + x/2;
  225. pb = ri->last_frame.data[1] + (my/2) * (ri->y_stride/2) + (mx + 1)/2;
  226. for(j = 0; j < 2; j++) {
  227. for(i = 0; i < 4; i++) {
  228. switch(((my & 0x01) << 1) | (mx & 0x01)) {
  229. case 0:
  230. pa[0] = pb[0];
  231. pa[1] = pb[1];
  232. pa[2] = pb[2];
  233. pa[3] = pb[3];
  234. break;
  235. case 1:
  236. pa[0] = avg2(pb[0], pb[1]);
  237. pa[1] = avg2(pb[1], pb[2]);
  238. pa[2] = avg2(pb[2], pb[3]);
  239. pa[3] = avg2(pb[3], pb[4]);
  240. break;
  241. case 2:
  242. pa[0] = avg2(pb[0], pb[hw]);
  243. pa[1] = avg2(pb[1], pb[hw+1]);
  244. pa[2] = avg2(pb[2], pb[hw+2]);
  245. pa[3] = avg2(pb[3], pb[hw+3]);
  246. break;
  247. case 3:
  248. pa[0] = avg4(pb[0], pb[1], pb[hw], pb[hw+1]);
  249. pa[1] = avg4(pb[1], pb[2], pb[hw+1], pb[hw+2]);
  250. pa[2] = avg4(pb[2], pb[3], pb[hw+2], pb[hw+3]);
  251. pa[3] = avg4(pb[3], pb[4], pb[hw+3], pb[hw+4]);
  252. break;
  253. }
  254. pa += ri->c_stride;
  255. pb += ri->c_stride;
  256. }
  257. pa = ri->current_frame.data[2] + (y * ri->y_stride)/4 + x/2;
  258. pb = ri->last_frame.data[2] + (my/2) * (ri->y_stride/2) + (mx + 1)/2;
  259. }
  260. #endif
  261. }
  262. static void roqvideo_decode_frame(RoqContext *ri)
  263. {
  264. unsigned int chunk_id = 0, chunk_arg = 0;
  265. unsigned long chunk_size = 0;
  266. int i, j, k, nv1, nv2, vqflg = 0, vqflg_pos = -1;
  267. int vqid, bpos, xpos, ypos, xp, yp, x, y;
  268. int frame_stats[2][4] = {{0},{0}};
  269. roq_qcell *qcell;
  270. unsigned char *buf = ri->buf;
  271. unsigned char *buf_end = ri->buf + ri->size;
  272. while (buf < buf_end) {
  273. chunk_id = get_word(buf);
  274. chunk_size = get_long(buf);
  275. chunk_arg = get_word(buf);
  276. if(chunk_id == RoQ_QUAD_VQ)
  277. break;
  278. if(chunk_id == RoQ_QUAD_CODEBOOK) {
  279. if((nv1 = chunk_arg >> 8) == 0)
  280. nv1 = 256;
  281. if((nv2 = chunk_arg & 0xff) == 0 && nv1 * 6 < chunk_size)
  282. nv2 = 256;
  283. for(i = 0; i < nv1; i++) {
  284. ri->cells[i].y0 = get_byte(buf);
  285. ri->cells[i].y1 = get_byte(buf);
  286. ri->cells[i].y2 = get_byte(buf);
  287. ri->cells[i].y3 = get_byte(buf);
  288. ri->cells[i].u = get_byte(buf);
  289. ri->cells[i].v = get_byte(buf);
  290. }
  291. for(i = 0; i < nv2; i++)
  292. for(j = 0; j < 4; j++)
  293. ri->qcells[i].idx[j] = get_byte(buf);
  294. }
  295. }
  296. bpos = xpos = ypos = 0;
  297. while(bpos < chunk_size) {
  298. for (yp = ypos; yp < ypos + 16; yp += 8)
  299. for (xp = xpos; xp < xpos + 16; xp += 8) {
  300. if (vqflg_pos < 0) {
  301. vqflg = buf[bpos++]; vqflg |= (buf[bpos++] << 8);
  302. vqflg_pos = 7;
  303. }
  304. vqid = (vqflg >> (vqflg_pos * 2)) & 0x3;
  305. frame_stats[0][vqid]++;
  306. vqflg_pos--;
  307. switch(vqid) {
  308. case RoQ_ID_MOT:
  309. apply_motion_8x8(ri, xp, yp, 0, 8, 8);
  310. break;
  311. case RoQ_ID_FCC:
  312. apply_motion_8x8(ri, xp, yp, buf[bpos++], chunk_arg >> 8,
  313. chunk_arg & 0xff);
  314. break;
  315. case RoQ_ID_SLD:
  316. qcell = ri->qcells + buf[bpos++];
  317. apply_vector_4x4(ri, xp, yp, ri->cells + qcell->idx[0]);
  318. apply_vector_4x4(ri, xp+4, yp, ri->cells + qcell->idx[1]);
  319. apply_vector_4x4(ri, xp, yp+4, ri->cells + qcell->idx[2]);
  320. apply_vector_4x4(ri, xp+4, yp+4, ri->cells + qcell->idx[3]);
  321. break;
  322. case RoQ_ID_CCC:
  323. for (k = 0; k < 4; k++) {
  324. x = xp; y = yp;
  325. if(k & 0x01) x += 4;
  326. if(k & 0x02) y += 4;
  327. if (vqflg_pos < 0) {
  328. vqflg = buf[bpos++];
  329. vqflg |= (buf[bpos++] << 8);
  330. vqflg_pos = 7;
  331. }
  332. vqid = (vqflg >> (vqflg_pos * 2)) & 0x3;
  333. frame_stats[1][vqid]++;
  334. vqflg_pos--;
  335. switch(vqid) {
  336. case RoQ_ID_MOT:
  337. apply_motion_4x4(ri, x, y, 0, 8, 8);
  338. break;
  339. case RoQ_ID_FCC:
  340. apply_motion_4x4(ri, x, y, buf[bpos++],
  341. chunk_arg >> 8, chunk_arg & 0xff);
  342. break;
  343. case RoQ_ID_SLD:
  344. qcell = ri->qcells + buf[bpos++];
  345. apply_vector_2x2(ri, x, y, ri->cells + qcell->idx[0]);
  346. apply_vector_2x2(ri, x+2, y, ri->cells + qcell->idx[1]);
  347. apply_vector_2x2(ri, x, y+2, ri->cells + qcell->idx[2]);
  348. apply_vector_2x2(ri, x+2, y+2, ri->cells + qcell->idx[3]);
  349. break;
  350. case RoQ_ID_CCC:
  351. apply_vector_2x2(ri, x, y, ri->cells + buf[bpos]);
  352. apply_vector_2x2(ri, x+2, y, ri->cells + buf[bpos+1]);
  353. apply_vector_2x2(ri, x, y+2, ri->cells + buf[bpos+2]);
  354. apply_vector_2x2(ri, x+2, y+2, ri->cells + buf[bpos+3]);
  355. bpos += 4;
  356. break;
  357. }
  358. }
  359. break;
  360. default:
  361. av_log(ri->avctx, AV_LOG_ERROR, "Unknown vq code: %d\n", vqid);
  362. }
  363. }
  364. xpos += 16;
  365. if (xpos >= ri->avctx->width) {
  366. xpos -= ri->avctx->width;
  367. ypos += 16;
  368. }
  369. if(ypos >= ri->avctx->height)
  370. break;
  371. }
  372. }
  373. static int roq_decode_init(AVCodecContext *avctx)
  374. {
  375. RoqContext *s = avctx->priv_data;
  376. int i;
  377. s->avctx = avctx;
  378. s->first_frame = 1;
  379. avctx->pix_fmt = PIX_FMT_YUV420P;
  380. avctx->has_b_frames = 0;
  381. dsputil_init(&s->dsp, avctx);
  382. uiclp = uiclip+512;
  383. for(i = -512; i < 512; i++)
  384. uiclp[i] = (i < 0 ? 0 : (i > 255 ? 255 : i));
  385. return 0;
  386. }
  387. static int roq_decode_frame(AVCodecContext *avctx,
  388. void *data, int *data_size,
  389. uint8_t *buf, int buf_size)
  390. {
  391. RoqContext *s = avctx->priv_data;
  392. if (avctx->get_buffer(avctx, &s->current_frame)) {
  393. av_log(avctx, AV_LOG_ERROR, " RoQ: get_buffer() failed\n");
  394. return -1;
  395. }
  396. s->y_stride = s->current_frame.linesize[0];
  397. s->c_stride = s->current_frame.linesize[1];
  398. s->buf = buf;
  399. s->size = buf_size;
  400. roqvideo_decode_frame(s);
  401. /* release the last frame if it is allocated */
  402. if (s->first_frame)
  403. s->first_frame = 0;
  404. else
  405. avctx->release_buffer(avctx, &s->last_frame);
  406. /* shuffle frames */
  407. s->last_frame = s->current_frame;
  408. *data_size = sizeof(AVFrame);
  409. *(AVFrame*)data = s->current_frame;
  410. return buf_size;
  411. }
  412. static int roq_decode_end(AVCodecContext *avctx)
  413. {
  414. RoqContext *s = avctx->priv_data;
  415. /* release the last frame */
  416. avctx->release_buffer(avctx, &s->last_frame);
  417. return 0;
  418. }
  419. AVCodec roq_decoder = {
  420. "roqvideo",
  421. CODEC_TYPE_VIDEO,
  422. CODEC_ID_ROQ,
  423. sizeof(RoqContext),
  424. roq_decode_init,
  425. NULL,
  426. roq_decode_end,
  427. roq_decode_frame,
  428. CODEC_CAP_DR1,
  429. };