Mercurial > hg > forks > libbpg
annotate bpgenc.c @ 3:ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
| author | Matti Hamalainen <ccr@tnsp.org> |
|---|---|
| date | Wed, 07 Dec 2016 10:35:38 +0200 |
| parents | 772086c29cc7 |
| children | bbd61622856a |
| rev | line source |
|---|---|
| 0 | 1 /* |
| 2 * BPG encoder | |
| 3 * | |
| 4 * Copyright (c) 2014 Fabrice Bellard | |
| 5 * | |
| 6 * Permission is hereby granted, free of charge, to any person obtaining a copy | |
| 7 * of this software and associated documentation files (the "Software"), to deal | |
| 8 * in the Software without restriction, including without limitation the rights | |
| 9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | |
| 10 * copies of the Software, and to permit persons to whom the Software is | |
| 11 * furnished to do so, subject to the following conditions: | |
| 12 * | |
| 13 * The above copyright notice and this permission notice shall be included in | |
| 14 * all copies or substantial portions of the Software. | |
| 15 * | |
| 16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
| 17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
| 18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
| 19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |
| 20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |
| 21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | |
| 22 * THE SOFTWARE. | |
| 23 */ | |
| 24 #include <stdlib.h> | |
| 25 #include <stdio.h> | |
| 26 #include <string.h> | |
| 27 #include <inttypes.h> | |
| 28 #include <getopt.h> | |
| 29 #include <math.h> | |
| 30 #include <assert.h> | |
| 31 | |
| 32 #include <png.h> | |
| 33 #include <jpeglib.h> | |
| 34 | |
| 35 #include "bpgenc.h" | |
| 36 | |
| 37 typedef uint16_t PIXEL; | |
| 38 | |
| 39 static void put_ue(uint8_t **pp, uint32_t v); | |
| 40 | |
| 41 static inline int clamp_pix(int a, int pixel_max) | |
| 42 { | |
| 43 if (a < 0) | |
| 44 return 0; | |
| 45 else if (a > pixel_max) | |
| 46 return pixel_max; | |
| 47 else | |
| 48 return a; | |
| 49 } | |
| 50 | |
| 51 static inline int sub_mod_int(int a, int b, int m) | |
| 52 { | |
| 53 a -= b; | |
| 54 if (a < 0) | |
| 55 a += m; | |
| 56 return a; | |
| 57 } | |
| 58 | |
| 59 static inline int add_mod_int(int a, int b, int m) | |
| 60 { | |
| 61 a += b; | |
| 62 if (a >= m) | |
| 63 a -= m; | |
| 64 return a; | |
| 65 } | |
| 66 | |
| 67 typedef struct { | |
| 68 int c_shift; | |
| 69 int c_rnd; | |
| 70 int c_0_25, c_0_5, c_one; | |
| 71 int rgb_to_ycc[3 * 3]; | |
| 72 int y_one; | |
| 73 int y_offset; | |
| 74 int bit_depth; | |
| 75 int pixel_max; | |
| 76 int c_center; | |
| 77 } ColorConvertState; | |
| 78 | |
| 79 static void convert_init(ColorConvertState *s, int in_bit_depth, | |
| 80 int out_bit_depth, BPGColorSpaceEnum color_space, | |
| 81 int limited_range) | |
| 82 { | |
| 83 double k_r, k_b, mult, mult_y, mult_c; | |
| 84 int in_pixel_max, out_pixel_max, c_shift, i; | |
| 85 double rgb_to_ycc[3 * 3]; | |
| 86 | |
| 87 /* XXX: could use one more bit */ | |
| 88 c_shift = 31 - out_bit_depth; | |
| 89 in_pixel_max = (1 << in_bit_depth) - 1; | |
| 90 out_pixel_max = (1 << out_bit_depth) - 1; | |
| 91 mult = (double)out_pixel_max * (1 << c_shift) / (double)in_pixel_max; | |
| 92 // printf("mult=%f c_shift=%d\n", mult, c_shift); | |
| 93 if (limited_range) { | |
| 94 mult_y = (double)(219 << (out_bit_depth - 8)) * (1 << c_shift) / | |
| 95 (double)in_pixel_max; | |
| 96 mult_c = (double)(224 << (out_bit_depth - 8)) * (1 << c_shift) / | |
| 97 (double)in_pixel_max; | |
| 98 } else { | |
| 99 mult_y = mult; | |
| 100 mult_c = mult; | |
| 101 } | |
| 102 switch(color_space) { | |
| 103 case BPG_CS_YCbCr: | |
| 104 k_r = 0.299; | |
| 105 k_b = 0.114; | |
| 106 goto convert_ycc; | |
| 107 | |
| 108 case BPG_CS_YCbCr_BT709: | |
| 109 k_r = 0.2126; | |
| 110 k_b = 0.0722; | |
| 111 goto convert_ycc; | |
| 112 | |
| 113 case BPG_CS_YCbCr_BT2020: | |
| 114 k_r = 0.2627; | |
| 115 k_b = 0.0593; | |
| 116 convert_ycc: | |
| 117 rgb_to_ycc[0] = k_r; | |
| 118 rgb_to_ycc[1] = 1 - k_r - k_b; | |
| 119 rgb_to_ycc[2] = k_b; | |
| 120 rgb_to_ycc[3] = -0.5 * k_r / (1 - k_b); | |
| 121 rgb_to_ycc[4] = -0.5 * (1 - k_r - k_b) / (1 - k_b); | |
| 122 rgb_to_ycc[5] = 0.5; | |
| 123 rgb_to_ycc[6] = 0.5; | |
| 124 rgb_to_ycc[7] = -0.5 * (1 - k_r - k_b) / (1 - k_r); | |
| 125 rgb_to_ycc[8] = -0.5 * k_b / (1 - k_r); | |
| 126 | |
| 127 for(i = 0; i < 3; i++) | |
| 128 s->rgb_to_ycc[i] = lrint(rgb_to_ycc[i] * mult_y); | |
| 129 for(i = 3; i < 9; i++) | |
| 130 s->rgb_to_ycc[i] = lrint(rgb_to_ycc[i] * mult_c); | |
| 131 break; | |
| 132 case BPG_CS_YCgCo: | |
| 133 s->c_0_25 = lrint(0.25 * mult_y); | |
| 134 s->c_0_5 = lrint(0.5 * mult_y); | |
| 135 break; | |
| 136 default: | |
| 137 break; | |
| 138 } | |
| 139 | |
| 140 s->c_one = lrint(mult); | |
| 141 s->c_shift = c_shift; | |
| 142 s->c_rnd = (1 << (c_shift - 1)); | |
| 143 if (limited_range) { | |
| 144 s->y_offset = s->c_rnd + (16 << (c_shift + out_bit_depth - 8)); | |
| 145 s->y_one = lrint(mult_y); | |
| 146 } else { | |
| 147 s->y_offset = s->c_rnd; | |
| 148 s->y_one = s->c_one; | |
| 149 } | |
| 150 | |
| 151 s->bit_depth = out_bit_depth; | |
| 152 s->c_center = 1 << (out_bit_depth - 1); | |
| 153 s->pixel_max = out_pixel_max; | |
| 154 } | |
| 155 | |
| 156 /* 8 bit input */ | |
| 157 static void rgb24_to_ycc(ColorConvertState *s, | |
| 158 PIXEL *y_ptr, PIXEL *cb_ptr, PIXEL *cr_ptr, | |
| 159 const void *src1, int n, int incr) | |
| 160 { | |
| 161 const uint8_t *src = src1; | |
| 162 int i, r, g, b, c0, c1, c2, c3, c4, c5, c6, c7, c8, shift, rnd, center; | |
| 163 int pixel_max, y_offset; | |
| 164 | |
| 165 c0 = s->rgb_to_ycc[0]; | |
| 166 c1 = s->rgb_to_ycc[1]; | |
| 167 c2 = s->rgb_to_ycc[2]; | |
| 168 c3 = s->rgb_to_ycc[3]; | |
| 169 c4 = s->rgb_to_ycc[4]; | |
| 170 c5 = s->rgb_to_ycc[5]; | |
| 171 c6 = s->rgb_to_ycc[6]; | |
| 172 c7 = s->rgb_to_ycc[7]; | |
| 173 c8 = s->rgb_to_ycc[8]; | |
| 174 shift = s->c_shift; | |
| 175 rnd = s->c_rnd; | |
| 176 y_offset = s->y_offset; | |
| 177 center = s->c_center; | |
| 178 pixel_max = s->pixel_max; | |
| 179 for(i = 0; i < n; i++) { | |
| 180 r = src[0]; | |
| 181 g = src[1]; | |
| 182 b = src[2]; | |
| 183 y_ptr[i] = clamp_pix((c0 * r + c1 * g + c2 * b + | |
| 184 y_offset) >> shift, pixel_max); | |
| 185 cb_ptr[i] = clamp_pix(((c3 * r + c4 * g + c5 * b + | |
| 186 rnd) >> shift) + center, pixel_max); | |
| 187 cr_ptr[i] = clamp_pix(((c6 * r + c7 * g + c8 * b + | |
| 188 rnd) >> shift) + center, pixel_max); | |
| 189 src += incr; | |
| 190 } | |
| 191 } | |
| 192 | |
| 193 static void rgb24_to_rgb(ColorConvertState *s, | |
| 194 PIXEL *y_ptr, PIXEL *cb_ptr, PIXEL *cr_ptr, | |
| 195 const void *src1, int n, int incr) | |
| 196 { | |
| 197 const uint8_t *src = src1; | |
| 198 int i, r, g, b, c, shift, rnd; | |
| 199 | |
| 200 c = s->y_one; | |
| 201 shift = s->c_shift; | |
| 202 rnd = s->y_offset; | |
| 203 for(i = 0; i < n; i++) { | |
| 204 r = src[0]; | |
| 205 g = src[1]; | |
| 206 b = src[2]; | |
| 207 y_ptr[i] = (c * g + rnd) >> shift; | |
| 208 cb_ptr[i] = (c * b + rnd) >> shift; | |
| 209 cr_ptr[i] = (c * r + rnd) >> shift; | |
| 210 src += incr; | |
| 211 } | |
| 212 } | |
| 213 | |
| 214 static void rgb24_to_ycgco(ColorConvertState *s, | |
| 215 PIXEL *y_ptr, PIXEL *cb_ptr, PIXEL *cr_ptr, | |
| 216 const void *src1, int n, int incr) | |
| 217 { | |
| 218 const uint8_t *src = src1; | |
| 219 int i, r, g, b, t1, t2, pixel_max, c_0_5, c_0_25, rnd, shift, center; | |
| 220 int y_offset; | |
| 221 | |
| 222 c_0_25 = s->c_0_25; | |
| 223 c_0_5 = s->c_0_5; | |
| 224 rnd = s->c_rnd; | |
| 225 shift = s->c_shift; | |
| 226 pixel_max = s->pixel_max; | |
| 227 center = s->c_center; | |
| 228 y_offset = s->y_offset; | |
| 229 for(i = 0; i < n; i++) { | |
| 230 r = src[0]; | |
| 231 g = src[1]; | |
| 232 b = src[2]; | |
| 233 t1 = c_0_5 * g; | |
| 234 t2 = c_0_25 * (r + b); | |
| 235 y_ptr[i] = clamp_pix((t1 + t2 + y_offset) >> shift, pixel_max); | |
| 236 cb_ptr[i] = clamp_pix(((t1 - t2 + rnd) >> shift) + center, | |
| 237 pixel_max); | |
| 238 cr_ptr[i] = clamp_pix(((c_0_5 * (r - b) + | |
| 239 rnd) >> shift) + center, pixel_max); | |
| 240 src += incr; | |
| 241 } | |
| 242 } | |
| 243 | |
| 244 /* Note: used for alpha/W so no limited range */ | |
| 245 static void gray8_to_gray(ColorConvertState *s, | |
| 246 PIXEL *y_ptr, const uint8_t *src, int n, int incr) | |
| 247 { | |
| 248 int i, g, c, shift, rnd; | |
| 249 | |
| 250 c = s->c_one; | |
| 251 shift = s->c_shift; | |
| 252 rnd = s->c_rnd; | |
| 253 for(i = 0; i < n; i++) { | |
| 254 g = src[0]; | |
| 255 y_ptr[i] = (c * g + rnd) >> shift; | |
| 256 src += incr; | |
| 257 } | |
| 258 } | |
| 259 | |
| 260 static void luma8_to_gray(ColorConvertState *s, | |
| 261 PIXEL *y_ptr, const uint8_t *src, int n, int incr) | |
| 262 { | |
| 263 int i, g, c, shift, rnd; | |
| 264 | |
| 265 c = s->y_one; | |
| 266 shift = s->c_shift; | |
| 267 rnd = s->y_offset; | |
| 268 for(i = 0; i < n; i++) { | |
| 269 g = src[0]; | |
| 270 y_ptr[i] = (c * g + rnd) >> shift; | |
| 271 src += incr; | |
| 272 } | |
| 273 } | |
| 274 | |
| 275 /* 16 bit input */ | |
| 276 | |
| 277 static void rgb48_to_ycc(ColorConvertState *s, | |
| 278 PIXEL *y_ptr, PIXEL *cb_ptr, PIXEL *cr_ptr, | |
| 279 const void *src1, int n, int incr) | |
| 280 { | |
| 281 const uint16_t *src = src1; | |
| 282 int i, r, g, b, c0, c1, c2, c3, c4, c5, c6, c7, c8, shift, rnd, center; | |
| 283 int pixel_max, y_offset; | |
| 284 | |
| 285 c0 = s->rgb_to_ycc[0]; | |
| 286 c1 = s->rgb_to_ycc[1]; | |
| 287 c2 = s->rgb_to_ycc[2]; | |
| 288 c3 = s->rgb_to_ycc[3]; | |
| 289 c4 = s->rgb_to_ycc[4]; | |
| 290 c5 = s->rgb_to_ycc[5]; | |
| 291 c6 = s->rgb_to_ycc[6]; | |
| 292 c7 = s->rgb_to_ycc[7]; | |
| 293 c8 = s->rgb_to_ycc[8]; | |
| 294 shift = s->c_shift; | |
| 295 rnd = s->c_rnd; | |
| 296 y_offset = s->y_offset; | |
| 297 center = s->c_center; | |
| 298 pixel_max = s->pixel_max; | |
| 299 for(i = 0; i < n; i++) { | |
| 300 r = src[0]; | |
| 301 g = src[1]; | |
| 302 b = src[2]; | |
| 303 y_ptr[i] = clamp_pix((c0 * r + c1 * g + c2 * b + | |
| 304 y_offset) >> shift, pixel_max); | |
| 305 cb_ptr[i] = clamp_pix(((c3 * r + c4 * g + c5 * b + | |
| 306 rnd) >> shift) + center, pixel_max); | |
| 307 cr_ptr[i] = clamp_pix(((c6 * r + c7 * g + c8 * b + | |
| 308 rnd) >> shift) + center, pixel_max); | |
| 309 src += incr; | |
| 310 } | |
| 311 } | |
| 312 | |
| 313 static void rgb48_to_ycgco(ColorConvertState *s, | |
| 314 PIXEL *y_ptr, PIXEL *cb_ptr, PIXEL *cr_ptr, | |
| 315 const void *src1, int n, int incr) | |
| 316 { | |
| 317 const uint16_t *src = src1; | |
| 318 int i, r, g, b, t1, t2, pixel_max, c_0_5, c_0_25, rnd, shift, center; | |
| 319 int y_offset; | |
| 320 | |
| 321 c_0_25 = s->c_0_25; | |
| 322 c_0_5 = s->c_0_5; | |
| 323 rnd = s->c_rnd; | |
| 324 y_offset = s->y_offset; | |
| 325 shift = s->c_shift; | |
| 326 pixel_max = s->pixel_max; | |
| 327 center = s->c_center; | |
| 328 for(i = 0; i < n; i++) { | |
| 329 r = src[0]; | |
| 330 g = src[1]; | |
| 331 b = src[2]; | |
| 332 t1 = c_0_5 * g; | |
| 333 t2 = c_0_25 * (r + b); | |
| 334 y_ptr[i] = clamp_pix((t1 + t2 + y_offset) >> shift, pixel_max); | |
| 335 cb_ptr[i] = clamp_pix(((t1 - t2 + rnd) >> shift) + center, | |
| 336 pixel_max); | |
| 337 cr_ptr[i] = clamp_pix(((c_0_5 * (r - b) + | |
| 338 rnd) >> shift) + center, pixel_max); | |
| 339 src += incr; | |
| 340 } | |
| 341 } | |
| 342 | |
| 343 /* Note: use for alpha/W so no limited range */ | |
| 344 static void gray16_to_gray(ColorConvertState *s, | |
| 345 PIXEL *y_ptr, const uint16_t *src, int n, int incr) | |
| 346 { | |
| 347 int i, g, c, shift, rnd; | |
| 348 | |
| 349 c = s->c_one; | |
| 350 shift = s->c_shift; | |
| 351 rnd = s->c_rnd; | |
| 352 for(i = 0; i < n; i++) { | |
| 353 g = src[0]; | |
| 354 y_ptr[i] = (c * g + rnd) >> shift; | |
| 355 src += incr; | |
| 356 } | |
| 357 } | |
| 358 | |
| 359 static void luma16_to_gray(ColorConvertState *s, | |
| 360 PIXEL *y_ptr, const uint16_t *src, int n, int incr) | |
| 361 { | |
| 362 int i, g, c, shift, rnd; | |
| 363 | |
| 364 c = s->y_one; | |
| 365 shift = s->c_shift; | |
| 366 rnd = s->y_offset; | |
| 367 for(i = 0; i < n; i++) { | |
| 368 g = src[0]; | |
| 369 y_ptr[i] = (c * g + rnd) >> shift; | |
| 370 src += incr; | |
| 371 } | |
| 372 } | |
| 373 | |
| 374 static void rgb48_to_rgb(ColorConvertState *s, | |
| 375 PIXEL *y_ptr, PIXEL *cb_ptr, PIXEL *cr_ptr, | |
| 376 const void *src1, int n, int incr) | |
| 377 { | |
| 378 const uint16_t *src = src1; | |
| 379 | |
| 380 luma16_to_gray(s, y_ptr, src + 1, n, incr); | |
| 381 luma16_to_gray(s, cb_ptr, src + 2, n, incr); | |
| 382 luma16_to_gray(s, cr_ptr, src + 0, n, incr); | |
| 383 } | |
| 384 | |
| 385 typedef void RGBConvertFunc(ColorConvertState *s, | |
| 386 PIXEL *y_ptr, PIXEL *cb_ptr, PIXEL *cr_ptr, | |
| 387 const void *src, int n, int incr); | |
| 388 | |
| 389 static RGBConvertFunc *rgb_to_cs[2][BPG_CS_COUNT] = { | |
| 390 { | |
| 391 rgb24_to_ycc, | |
| 392 rgb24_to_rgb, | |
| 393 rgb24_to_ycgco, | |
| 394 rgb24_to_ycc, | |
| 395 rgb24_to_ycc, | |
| 396 }, | |
| 397 { | |
| 398 rgb48_to_ycc, | |
| 399 rgb48_to_rgb, | |
| 400 rgb48_to_ycgco, | |
| 401 rgb48_to_ycc, | |
| 402 rgb48_to_ycc, | |
| 403 } | |
| 404 }; | |
| 405 | |
| 406 /* val = 1.0 - val */ | |
| 407 static void gray_one_minus(ColorConvertState *s, PIXEL *y_ptr, int n) | |
| 408 { | |
| 409 int pixel_max = s->pixel_max; | |
| 410 int i; | |
| 411 | |
| 412 for(i = 0; i < n; i++) { | |
| 413 y_ptr[i] = pixel_max - y_ptr[i]; | |
| 414 } | |
| 415 } | |
| 416 | |
| 417 /* val = -val for chroma */ | |
| 418 static void gray_neg_c(ColorConvertState *s, PIXEL *y_ptr, int n) | |
| 419 { | |
| 420 int pixel_max = s->pixel_max; | |
| 421 int i, v; | |
| 422 | |
| 423 for(i = 0; i < n; i++) { | |
| 424 v = y_ptr[i]; | |
| 425 if (v == 0) | |
| 426 v = pixel_max; | |
| 427 else | |
| 428 v = pixel_max + 1 - v; | |
| 429 y_ptr[i] = v; | |
| 430 } | |
| 431 } | |
| 432 | |
| 433 | |
| 434 /* decimation */ | |
| 435 | |
| 436 /* phase = 0 */ | |
| 437 #define DP0TAPS2 7 | |
| 438 #define DP0TAPS (2 * DP0TAPS + 1) | |
| 439 #define DP0C0 64 | |
| 440 #define DP0C1 40 | |
| 441 #define DP0C3 (-11) | |
| 442 #define DP0C5 4 | |
| 443 #define DP0C7 (-1) | |
| 444 | |
| 445 /* phase = 0.5 */ | |
| 446 #define DP1TAPS2 5 | |
| 447 #define DP1TAPS (2 * DP1TAPS2) | |
| 448 #define DP1C0 57 | |
| 449 #define DP1C1 17 | |
| 450 #define DP1C2 (-8) | |
| 451 #define DP1C3 (-4) | |
| 452 #define DP1C4 2 | |
| 453 | |
| 454 #define DTAPS_MAX 7 | |
| 455 | |
| 456 /* chroma aligned with luma samples */ | |
| 457 static void decimate2p0_simple(PIXEL *dst, PIXEL *src, int n, int bit_depth) | |
| 458 { | |
| 459 int n2, i, pixel_max; | |
| 460 pixel_max = (1 << bit_depth) - 1; | |
| 461 n2 = (n + 1) / 2; | |
| 462 for(i = 0; i < n2; i++) { | |
| 463 dst[i] = clamp_pix(((src[-7] + src[7]) * DP0C7 + | |
| 464 (src[-5] + src[5]) * DP0C5 + | |
| 465 (src[-3] + src[3]) * DP0C3 + | |
| 466 (src[-1] + src[1]) * DP0C1 + | |
| 467 src[0] * DP0C0 + 64) >> 7, pixel_max); | |
| 468 src += 2; | |
| 469 } | |
| 470 } | |
| 471 | |
| 472 /* same with more precision and no saturation */ | |
| 473 static void decimate2p0_simple16(int16_t *dst, PIXEL *src, int n, int bit_depth) | |
| 474 { | |
| 475 int n2, i, shift, rnd; | |
| 476 shift = bit_depth - 7; | |
| 477 rnd = 1 << (shift - 1); | |
| 478 n2 = (n + 1) / 2; | |
| 479 for(i = 0; i < n2; i++) { | |
| 480 dst[i] = ((src[-7] + src[7]) * DP0C7 + | |
| 481 (src[-5] + src[5]) * DP0C5 + | |
| 482 (src[-3] + src[3]) * DP0C3 + | |
| 483 (src[-1] + src[1]) * DP0C1 + | |
| 484 src[0] * DP0C0 + rnd) >> shift; | |
| 485 src += 2; | |
| 486 } | |
| 487 } | |
| 488 | |
| 489 | |
| 490 /* chroma half way between luma samples */ | |
| 491 static void decimate2p1_simple(PIXEL *dst, PIXEL *src, int n, int bit_depth) | |
| 492 { | |
| 493 int n2, i, pixel_max; | |
| 494 pixel_max = (1 << bit_depth) - 1; | |
| 495 n2 = (n + 1) / 2; | |
| 496 for(i = 0; i < n2; i++) { | |
| 497 dst[i] = clamp_pix(((src[-4] + src[5]) * DP1C4 + | |
| 498 (src[-3] + src[4]) * DP1C3 + | |
| 499 (src[-2] + src[3]) * DP1C2 + | |
| 500 (src[-1] + src[2]) * DP1C1 + | |
| 501 (src[0] + src[1]) * DP1C0 + 64) >> 7, pixel_max); | |
| 502 src += 2; | |
| 503 } | |
| 504 } | |
| 505 | |
| 506 /* same with more precision and no saturation */ | |
| 507 static void decimate2p1_simple16(int16_t *dst, PIXEL *src, int n, int bit_depth) | |
| 508 { | |
| 509 int n2, i, shift, rnd; | |
| 510 shift = bit_depth - 7; | |
| 511 rnd = 1 << (shift - 1); | |
| 512 n2 = (n + 1) / 2; | |
| 513 for(i = 0; i < n2; i++) { | |
| 514 dst[i] = ((src[-4] + src[5]) * DP1C4 + | |
| 515 (src[-3] + src[4]) * DP1C3 + | |
| 516 (src[-2] + src[3]) * DP1C2 + | |
| 517 (src[-1] + src[2]) * DP1C1 + | |
| 518 (src[0] + src[1]) * DP1C0 + rnd) >> shift; | |
| 519 src += 2; | |
| 520 } | |
| 521 } | |
| 522 | |
| 523 static void decimate2_h(PIXEL *dst, PIXEL *src, int n, int bit_depth, int phase) | |
| 524 { | |
| 525 PIXEL *src1, v; | |
| 526 int d, i; | |
| 527 | |
| 528 if (phase == 0) | |
| 529 d = DP0TAPS2; | |
| 530 else | |
| 531 d = DP1TAPS2; | |
| 532 /* add edge pixels */ | |
| 533 src1 = malloc(sizeof(PIXEL) * (n + 2 * d)); | |
| 534 v = src[0]; | |
| 535 for(i = 0; i < d; i++) | |
| 536 src1[i] = v; | |
| 537 memcpy(src1 + d, src, n * sizeof(PIXEL)); | |
| 538 v = src[n - 1]; | |
| 539 for(i = 0; i < d; i++) | |
| 540 src1[d + n + i] = v; | |
| 541 if (phase == 0) | |
| 542 decimate2p0_simple(dst, src1 + d, n, bit_depth); | |
| 543 else | |
| 544 decimate2p1_simple(dst, src1 + d, n, bit_depth); | |
| 545 free(src1); | |
| 546 } | |
| 547 | |
| 548 /* src1 is a temporary buffer of length n + 2 * DTAPS */ | |
| 549 static void decimate2_h16(int16_t *dst, PIXEL *src, int n, PIXEL *src1, | |
| 550 int bit_depth, int phase) | |
| 551 { | |
| 552 PIXEL v; | |
| 553 int d, i; | |
| 554 | |
| 555 if (phase == 0) | |
| 556 d = DP0TAPS2; | |
| 557 else | |
| 558 d = DP1TAPS2; | |
| 559 /* add edge pixels */ | |
| 560 v = src[0]; | |
| 561 for(i = 0; i < d; i++) | |
| 562 src1[i] = v; | |
| 563 memcpy(src1 + d, src, n * sizeof(PIXEL)); | |
| 564 v = src[n - 1]; | |
| 565 for(i = 0; i < d; i++) | |
| 566 src1[d + n + i] = v; | |
| 567 if (phase == 0) | |
| 568 decimate2p0_simple16(dst, src1 + d, n, bit_depth); | |
| 569 else | |
| 570 decimate2p1_simple16(dst, src1 + d, n, bit_depth); | |
| 571 | |
| 572 } | |
| 573 | |
| 574 static void decimate2_v(PIXEL *dst, int16_t **src, int pos, int n, | |
| 575 int bit_depth) | |
| 576 { | |
| 577 int16_t *src0, *src1, *src2, *src3, *src4, *src5, *srcm1, *srcm2, *srcm3, *srcm4; | |
| 578 int i, shift, offset, pixel_max; | |
| 579 | |
| 580 pos = sub_mod_int(pos, 4, DP1TAPS); | |
| 581 srcm4 = src[pos]; | |
| 582 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 583 srcm3 = src[pos]; | |
| 584 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 585 srcm2 = src[pos]; | |
| 586 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 587 srcm1 = src[pos]; | |
| 588 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 589 src0 = src[pos]; | |
| 590 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 591 src1 = src[pos]; | |
| 592 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 593 src2 = src[pos]; | |
| 594 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 595 src3 = src[pos]; | |
| 596 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 597 src4 = src[pos]; | |
| 598 pos = add_mod_int(pos, 1, DP1TAPS); | |
| 599 src5 = src[pos]; | |
| 600 | |
| 601 shift = 21 - bit_depth; | |
| 602 offset = 1 << (shift - 1); | |
| 603 pixel_max = (1 << bit_depth) - 1; | |
| 604 for(i = 0; i < n; i++) { | |
| 605 dst[i] = clamp_pix(((srcm4[i] + src5[i]) * DP1C4 + | |
| 606 (srcm3[i] + src4[i]) * DP1C3 + | |
| 607 (srcm2[i] + src3[i]) * DP1C2 + | |
| 608 (srcm1[i] + src2[i]) * DP1C1 + | |
| 609 (src0[i] + src1[i]) * DP1C0 + offset) >> shift, pixel_max); | |
| 610 } | |
| 611 } | |
| 612 | |
| 613 /* Note: we do the horizontal decimation first to use less CPU cache */ | |
| 614 static void decimate2_hv(uint8_t *dst, int dst_linesize, | |
| 615 uint8_t *src, int src_linesize, | |
| 616 int w, int h, int bit_depth, int h_phase) | |
| 617 { | |
| 618 PIXEL *buf1; | |
| 619 int16_t *buf2[DP1TAPS]; | |
| 620 int w2, pos, i, y, y1, y2; | |
| 621 | |
| 622 w2 = (w + 1) / 2; | |
| 623 | |
| 624 buf1 = malloc(sizeof(PIXEL) * (w + 2 * DTAPS_MAX)); | |
| 625 /* init line buffer */ | |
| 626 for(i = 0; i < DP1TAPS; i++) { | |
| 627 buf2[i] = malloc(sizeof(int16_t) * w2); | |
| 628 y = i; | |
| 629 if (y > DP1TAPS2) | |
| 630 y -= DP1TAPS; | |
| 631 if (y < 0) { | |
| 632 /* copy from first line */ | |
| 633 memcpy(buf2[i], buf2[0], sizeof(int16_t) * w2); | |
| 634 } else if (y >= h) { | |
| 635 /* copy from last line (only happens for small height) */ | |
| 636 memcpy(buf2[i], buf2[h - 1], sizeof(int16_t) * w2); | |
| 637 } else { | |
| 638 decimate2_h16(buf2[i], (PIXEL *)(src + src_linesize * y), w, | |
| 639 buf1, bit_depth, h_phase); | |
| 640 } | |
| 641 } | |
| 642 | |
| 643 for(y = 0; y < h; y++) { | |
| 644 pos = y % DP1TAPS; | |
| 645 if ((y & 1) == 0) { | |
| 646 /* filter one line */ | |
| 647 y2 = y >> 1; | |
| 648 decimate2_v((PIXEL *)(dst + y2 * dst_linesize), buf2, | |
| 649 pos, w2, bit_depth); | |
| 650 } | |
| 651 /* add a new line in the buffer */ | |
| 652 y1 = y + DP1TAPS2 + 1; | |
| 653 pos = add_mod_int(pos, DP1TAPS2 + 1, DP1TAPS); | |
| 654 if (y1 >= h) { | |
| 655 /* copy last line */ | |
| 656 memcpy(buf2[pos], buf2[sub_mod_int(pos, 1, DP1TAPS)], | |
| 657 sizeof(int16_t) * w2); | |
| 658 } else { | |
| 659 /* horizontally decimate new line */ | |
| 660 decimate2_h16(buf2[pos], (PIXEL *)(src + src_linesize * y1), w, | |
| 661 buf1, bit_depth, h_phase); | |
| 662 } | |
| 663 } | |
| 664 | |
| 665 for(i = 0; i < DP1TAPS; i++) | |
| 666 free(buf2[i]); | |
| 667 free(buf1); | |
| 668 } | |
| 669 | |
| 670 static void get_plane_res(Image *img, int *pw, int *ph, int i) | |
| 671 { | |
| 672 if (img->format == BPG_FORMAT_420 && (i == 1 || i == 2)) { | |
| 673 *pw = (img->w + 1) / 2; | |
| 674 *ph = (img->h + 1) / 2; | |
| 675 } else if (img->format == BPG_FORMAT_422 && (i == 1 || i == 2)) { | |
| 676 *pw = (img->w + 1) / 2; | |
| 677 *ph = img->h; | |
| 678 } else { | |
| 679 *pw = img->w; | |
| 680 *ph = img->h; | |
| 681 } | |
| 682 } | |
| 683 | |
| 684 #define W_PAD 16 | |
| 685 | |
| 686 Image *image_alloc(int w, int h, BPGImageFormatEnum format, int has_alpha, | |
| 687 BPGColorSpaceEnum color_space, int bit_depth) | |
| 688 { | |
| 689 Image *img; | |
| 690 int i, linesize, w1, h1, c_count; | |
| 691 | |
| 692 img = malloc(sizeof(Image)); | |
| 693 memset(img, 0, sizeof(*img)); | |
| 694 | |
| 695 img->w = w; | |
| 696 img->h = h; | |
| 697 img->format = format; | |
| 698 img->has_alpha = has_alpha; | |
| 699 img->bit_depth = bit_depth; | |
| 700 img->color_space = color_space; | |
| 701 img->pixel_shift = 1; | |
| 702 img->c_h_phase = 1; | |
| 703 | |
| 704 if (img->format == BPG_FORMAT_GRAY) | |
| 705 c_count = 1; | |
| 706 else | |
| 707 c_count = 3; | |
| 708 if (has_alpha) | |
| 709 c_count++; | |
| 710 for(i = 0; i < c_count; i++) { | |
| 711 get_plane_res(img, &w1, &h1, i); | |
| 712 /* multiple of 16 pixels to add borders */ | |
| 713 w1 = (w1 + (W_PAD - 1)) & ~(W_PAD - 1); | |
| 714 h1 = (h1 + (W_PAD - 1)) & ~(W_PAD - 1); | |
| 715 | |
| 716 linesize = w1 << img->pixel_shift; | |
| 717 img->data[i] = malloc(linesize * h1); | |
| 718 img->linesize[i] = linesize; | |
| 719 } | |
| 720 return img; | |
| 721 } | |
| 722 | |
| 723 void image_free(Image *img) | |
| 724 { | |
| 725 int i, c_count; | |
| 726 if (img->format == BPG_FORMAT_GRAY) | |
| 727 c_count = 1; | |
| 728 else | |
| 729 c_count = 3; | |
| 730 if (img->has_alpha) | |
| 731 c_count++; | |
| 732 for(i = 0; i < c_count; i++) | |
| 733 free(img->data[i]); | |
| 734 free(img); | |
| 735 } | |
| 736 | |
| 737 int image_ycc444_to_ycc422(Image *img, int h_phase) | |
| 738 { | |
| 739 uint8_t *data1; | |
| 740 int w1, h1, bpp, linesize1, i, y; | |
| 741 | |
| 742 if (img->format != BPG_FORMAT_444 || img->pixel_shift != 1) | |
| 743 return -1; | |
| 744 bpp = 2; | |
| 745 w1 = (img->w + 1) / 2; | |
| 746 w1 = (w1 + (W_PAD - 1)) & ~(W_PAD - 1); | |
| 747 h1 = (img->h + (W_PAD - 1)) & ~(W_PAD - 1); | |
| 748 linesize1 = bpp * w1; | |
| 749 for(i = 1; i <= 2; i++) { | |
| 750 data1 = malloc(linesize1 * h1); | |
| 751 for(y = 0; y < img->h; y++) { | |
| 752 decimate2_h((PIXEL *)(data1 + y * linesize1), | |
| 753 (PIXEL *)(img->data[i] + y * img->linesize[i]), | |
| 754 img->w, img->bit_depth, h_phase); | |
| 755 } | |
| 756 free(img->data[i]); | |
| 757 img->data[i] = data1; | |
| 758 img->linesize[i] = linesize1; | |
| 759 } | |
| 760 img->format = BPG_FORMAT_422; | |
| 761 img->c_h_phase = h_phase; | |
| 762 return 0; | |
| 763 } | |
| 764 | |
| 765 int image_ycc444_to_ycc420(Image *img, int h_phase) | |
| 766 { | |
| 767 uint8_t *data1; | |
| 768 int w1, h1, bpp, linesize1, i; | |
| 769 | |
| 770 if (img->format != BPG_FORMAT_444 || img->pixel_shift != 1) | |
| 771 return -1; | |
| 772 bpp = 2; | |
| 773 w1 = (img->w + 1) / 2; | |
| 774 h1 = (img->h + 1) / 2; | |
| 775 w1 = (w1 + (W_PAD - 1)) & ~(W_PAD - 1); | |
| 776 h1 = (h1 + (W_PAD - 1)) & ~(W_PAD - 1); | |
| 777 linesize1 = bpp * w1; | |
| 778 for(i = 1; i <= 2; i++) { | |
| 779 data1 = malloc(linesize1 * h1); | |
| 780 decimate2_hv(data1, linesize1, | |
| 781 img->data[i], img->linesize[i], | |
| 782 img->w, img->h, img->bit_depth, h_phase); | |
| 783 free(img->data[i]); | |
| 784 img->data[i] = data1; | |
| 785 img->linesize[i] = linesize1; | |
| 786 } | |
| 787 img->format = BPG_FORMAT_420; | |
| 788 img->c_h_phase = h_phase; | |
| 789 return 0; | |
| 790 } | |
| 791 | |
| 792 /* duplicate right and bottom samples so that the image has a width | |
| 793 and height multiple of cb_size (power of two) */ | |
| 794 void image_pad(Image *img, int cb_size) | |
| 795 { | |
| 796 int w1, h1, x, y, c_count, c_w, c_h, c_w1, c_h1, h_shift, v_shift, c_idx; | |
| 797 PIXEL *ptr, v, *ptr1; | |
| 798 | |
| 799 assert(img->pixel_shift == 1); | |
| 800 if (cb_size <= 1) | |
| 801 return; | |
| 802 w1 = (img->w + cb_size - 1) & ~(cb_size - 1); | |
| 803 h1 = (img->h + cb_size - 1) & ~(cb_size - 1); | |
| 804 | |
| 805 if (img->format == BPG_FORMAT_GRAY) | |
| 806 c_count = 1; | |
| 807 else | |
| 808 c_count = 3; | |
| 809 if (img->has_alpha) | |
| 810 c_count++; | |
| 811 for(c_idx = 0; c_idx < c_count; c_idx++) { | |
| 812 if (img->format == BPG_FORMAT_420 && | |
| 813 (c_idx == 1 || c_idx == 2)) { | |
| 814 h_shift = 1; | |
| 815 v_shift = 1; | |
| 816 } else if (img->format == BPG_FORMAT_422 && | |
| 817 (c_idx == 1 || c_idx == 2)) { | |
| 818 h_shift = 1; | |
| 819 v_shift = 0; | |
| 820 } else { | |
| 821 h_shift = 0; | |
| 822 v_shift = 0; | |
| 823 } | |
| 824 | |
| 825 c_w = (img->w + h_shift) >> h_shift; | |
| 826 c_h = (img->h + v_shift) >> v_shift; | |
| 827 c_w1 = w1 >> h_shift; | |
| 828 c_h1 = h1 >> v_shift; | |
| 829 | |
| 830 /* pad horizontally */ | |
| 831 for(y = 0; y < c_h; y++) { | |
| 832 ptr = (PIXEL *)(img->data[c_idx] + img->linesize[c_idx] * y); | |
| 833 v = ptr[c_w - 1]; | |
| 834 for(x = c_w; x < c_w1; x++) { | |
| 835 ptr[x] = v; | |
| 836 } | |
| 837 } | |
| 838 | |
| 839 /* pad vertically */ | |
| 840 ptr1 = (PIXEL *)(img->data[c_idx] + img->linesize[c_idx] * (c_h - 1)); | |
| 841 for(y = c_h; y < c_h1; y++) { | |
| 842 ptr = (PIXEL *)(img->data[c_idx] + img->linesize[c_idx] * y); | |
| 843 memcpy(ptr, ptr1, c_w1 * sizeof(PIXEL)); | |
| 844 } | |
| 845 } | |
| 846 img->w = w1; | |
| 847 img->h = h1; | |
| 848 } | |
| 849 | |
| 850 /* convert the 16 bit components to 8 bits */ | |
| 851 void image_convert16to8(Image *img) | |
| 852 { | |
| 853 int w, h, stride, y, x, c_count, i; | |
| 854 uint8_t *plane; | |
| 855 | |
| 856 if (img->bit_depth > 8 || img->pixel_shift != 1) | |
| 857 return; | |
| 858 if (img->format == BPG_FORMAT_GRAY) | |
| 859 c_count = 1; | |
| 860 else | |
| 861 c_count = 3; | |
| 862 if (img->has_alpha) | |
| 863 c_count++; | |
| 864 for(i = 0; i < c_count; i++) { | |
| 865 get_plane_res(img, &w, &h, i); | |
| 866 stride = w; | |
| 867 plane = malloc(stride * h); | |
| 868 for(y = 0; y < h; y++) { | |
| 869 const uint16_t *src; | |
| 870 uint8_t *dst; | |
| 871 dst = plane + stride * y; | |
| 872 src = (uint16_t *)(img->data[i] + img->linesize[i] * y); | |
| 873 for(x = 0; x < w; x++) | |
| 874 dst[x] = src[x]; | |
| 875 } | |
| 876 free(img->data[i]); | |
| 877 img->data[i] = plane; | |
| 878 img->linesize[i] = stride; | |
| 879 } | |
| 880 img->pixel_shift = 0; | |
| 881 } | |
| 882 | |
| 883 typedef struct BPGMetaData { | |
| 884 uint32_t tag; | |
| 885 uint8_t *buf; | |
| 886 int buf_len; | |
| 887 struct BPGMetaData *next; | |
| 888 } BPGMetaData; | |
| 889 | |
| 890 BPGMetaData *bpg_md_alloc(uint32_t tag) | |
| 891 { | |
| 892 BPGMetaData *md; | |
| 893 md = malloc(sizeof(BPGMetaData)); | |
| 894 memset(md, 0, sizeof(*md)); | |
| 895 md->tag = tag; | |
| 896 return md; | |
| 897 } | |
| 898 | |
| 899 void bpg_md_free(BPGMetaData *md) | |
| 900 { | |
| 901 BPGMetaData *md_next; | |
| 902 | |
| 903 while (md != NULL) { | |
| 904 md_next = md->next; | |
| 905 free(md->buf); | |
| 906 free(md); | |
| 907 md = md_next; | |
| 908 } | |
| 909 } | |
| 910 | |
| 911 Image *read_png(BPGMetaData **pmd, | |
| 912 FILE *f, BPGColorSpaceEnum color_space, int out_bit_depth, | |
| 913 int limited_range, int premultiplied_alpha) | |
| 914 { | |
| 915 png_structp png_ptr; | |
| 916 png_infop info_ptr; | |
| 917 int bit_depth, color_type; | |
| 918 Image *img; | |
| 919 uint8_t **rows; | |
| 920 int y, has_alpha, linesize, bpp; | |
| 921 BPGImageFormatEnum format; | |
| 922 ColorConvertState cvt_s, *cvt = &cvt_s; | |
| 923 BPGMetaData *md, **plast_md, *first_md; | |
| 924 | |
| 925 png_ptr = png_create_read_struct(PNG_LIBPNG_VER_STRING, | |
| 926 NULL, NULL, NULL); | |
| 927 if (png_ptr == NULL) { | |
| 928 return NULL; | |
| 929 } | |
| 930 | |
| 931 info_ptr = png_create_info_struct(png_ptr); | |
| 932 if (info_ptr == NULL) { | |
| 933 png_destroy_read_struct(&png_ptr, NULL, NULL); | |
| 934 return NULL; | |
| 935 } | |
| 936 | |
| 937 if (setjmp(png_jmpbuf(png_ptr))) { | |
| 938 png_destroy_read_struct(&png_ptr, &info_ptr, NULL); | |
| 939 return NULL; | |
| 940 } | |
| 941 | |
| 942 png_init_io(png_ptr, f); | |
| 943 | |
| 944 png_read_info(png_ptr, info_ptr); | |
| 945 | |
| 946 bit_depth = png_get_bit_depth(png_ptr, info_ptr); | |
| 947 color_type = png_get_color_type(png_ptr, info_ptr); | |
| 948 | |
| 949 switch (color_type) { | |
| 950 case PNG_COLOR_TYPE_PALETTE: | |
| 951 png_set_palette_to_rgb(png_ptr); | |
| 952 bit_depth = 8; | |
| 953 break; | |
| 954 case PNG_COLOR_TYPE_GRAY: | |
| 955 case PNG_COLOR_TYPE_GRAY_ALPHA: | |
| 956 if (bit_depth < 8) { | |
| 957 png_set_expand_gray_1_2_4_to_8(png_ptr); | |
| 958 bit_depth = 8; | |
| 959 } | |
| 960 break; | |
| 961 } | |
| 962 assert(bit_depth == 8 || bit_depth == 16); | |
| 963 | |
| 964 #if __BYTE_ORDER__ != __ORDER_BIG_ENDIAN__ | |
| 965 if (bit_depth == 16) { | |
| 966 png_set_swap(png_ptr); | |
| 967 } | |
| 968 #endif | |
| 969 | |
| 970 if (color_type == PNG_COLOR_TYPE_GRAY || | |
| 971 color_type == PNG_COLOR_TYPE_GRAY_ALPHA) { | |
| 972 format = BPG_FORMAT_GRAY; | |
| 973 color_space = BPG_CS_YCbCr; | |
| 974 } else { | |
| 975 format = BPG_FORMAT_444; | |
| 976 } | |
| 977 | |
| 978 has_alpha = (color_type == PNG_COLOR_TYPE_GRAY_ALPHA || | |
| 979 color_type == PNG_COLOR_TYPE_RGB_ALPHA); | |
| 980 | |
| 981 if (png_get_valid(png_ptr, info_ptr, PNG_INFO_tRNS)) { | |
| 982 png_set_tRNS_to_alpha(png_ptr); | |
| 983 has_alpha = 1; | |
| 984 } | |
| 985 | |
| 986 if (premultiplied_alpha) { | |
| 987 png_set_alpha_mode(png_ptr, PNG_ALPHA_ASSOCIATED, PNG_GAMMA_LINEAR); | |
| 988 } | |
| 989 | |
| 990 img = image_alloc(png_get_image_width(png_ptr, info_ptr), | |
| 991 png_get_image_height(png_ptr, info_ptr), | |
| 992 format, has_alpha, color_space, | |
| 993 out_bit_depth); | |
| 994 img->limited_range = limited_range; | |
| 995 img->premultiplied_alpha = premultiplied_alpha; | |
| 996 | |
| 997 rows = malloc(sizeof(rows[0]) * img->h); | |
| 998 if (format == BPG_FORMAT_GRAY) | |
| 999 bpp = (1 + has_alpha) * (bit_depth / 8); | |
| 1000 else | |
| 1001 bpp = (3 + has_alpha) * (bit_depth / 8); | |
| 1002 linesize = bpp * img->w; | |
| 1003 for (y = 0; y < img->h; y++) { | |
| 1004 rows[y] = malloc(linesize); | |
| 1005 } | |
| 1006 | |
| 1007 png_read_image(png_ptr, rows); | |
| 1008 | |
| 1009 convert_init(cvt, bit_depth, out_bit_depth, color_space, limited_range); | |
| 1010 | |
| 1011 if (format != BPG_FORMAT_GRAY) { | |
| 1012 int idx; | |
| 1013 RGBConvertFunc *convert_func; | |
| 1014 | |
| 1015 idx = (bit_depth == 16); | |
| 1016 convert_func = rgb_to_cs[idx][color_space]; | |
| 1017 | |
| 1018 for (y = 0; y < img->h; y++) { | |
| 1019 convert_func(cvt, (PIXEL *)(img->data[0] + y * img->linesize[0]), | |
| 1020 (PIXEL *)(img->data[1] + y * img->linesize[1]), | |
| 1021 (PIXEL *)(img->data[2] + y * img->linesize[2]), | |
| 1022 rows[y], img->w, 3 + has_alpha); | |
| 1023 if (has_alpha) { | |
| 1024 if (idx) { | |
| 1025 gray16_to_gray(cvt, (PIXEL *)(img->data[3] + y * img->linesize[3]), | |
| 1026 (uint16_t *)rows[y] + 3, img->w, 4); | |
| 1027 } else { | |
| 1028 gray8_to_gray(cvt, (PIXEL *)(img->data[3] + y * img->linesize[3]), | |
| 1029 rows[y] + 3, img->w, 4); | |
| 1030 } | |
| 1031 } | |
| 1032 } | |
| 1033 } else { | |
| 1034 if (bit_depth == 16) { | |
| 1035 for (y = 0; y < img->h; y++) { | |
| 1036 luma16_to_gray(cvt, (PIXEL *)(img->data[0] + y * img->linesize[0]), | |
| 1037 (uint16_t *)rows[y], img->w, 1 + has_alpha); | |
| 1038 if (has_alpha) { | |
| 1039 gray16_to_gray(cvt, (PIXEL *)(img->data[1] + y * img->linesize[1]), | |
| 1040 (uint16_t *)rows[y] + 1, img->w, 2); | |
| 1041 } | |
| 1042 } | |
| 1043 } else { | |
| 1044 for (y = 0; y < img->h; y++) { | |
| 1045 luma8_to_gray(cvt, (PIXEL *)(img->data[0] + y * img->linesize[0]), | |
| 1046 rows[y], img->w, 1 + has_alpha); | |
| 1047 if (has_alpha) { | |
| 1048 gray8_to_gray(cvt, (PIXEL *)(img->data[1] + y * img->linesize[1]), | |
| 1049 rows[y] + 1, img->w, 2); | |
| 1050 } | |
| 1051 } | |
| 1052 } | |
| 1053 } | |
| 1054 | |
| 1055 for (y = 0; y < img->h; y++) { | |
| 1056 free(rows[y]); | |
| 1057 } | |
| 1058 free(rows); | |
| 1059 | |
| 1060 png_read_end(png_ptr, info_ptr); | |
| 1061 | |
| 1062 /* get the ICC profile if present */ | |
| 1063 first_md = NULL; | |
| 1064 plast_md = &first_md; | |
| 1065 { | |
| 1066 png_charp name; | |
| 1067 int comp_type; | |
| 1068 png_bytep iccp_buf; | |
| 1069 png_uint_32 iccp_buf_len; | |
| 1070 | |
| 1071 if (png_get_iCCP(png_ptr, info_ptr, | |
| 1072 &name, &comp_type, &iccp_buf, &iccp_buf_len) == | |
| 1073 PNG_INFO_iCCP) { | |
| 1074 md = bpg_md_alloc(BPG_EXTENSION_TAG_ICCP); | |
| 1075 md->buf_len = iccp_buf_len; | |
| 1076 md->buf = malloc(iccp_buf_len); | |
| 1077 memcpy(md->buf, iccp_buf, iccp_buf_len); | |
| 1078 *plast_md = md; | |
| 1079 plast_md = &md->next; | |
| 1080 } | |
| 1081 } | |
| 1082 | |
| 1083 png_destroy_read_struct(&png_ptr, &info_ptr, NULL); | |
| 1084 | |
| 1085 *pmd = first_md; | |
| 1086 return img; | |
| 1087 } | |
| 1088 | |
| 1089 static BPGMetaData *jpeg_get_metadata(jpeg_saved_marker_ptr first_marker) | |
| 1090 { | |
| 1091 static const char app1_exif[] = "Exif"; | |
| 1092 static const char app1_xmp[] = "http://ns.adobe.com/xap/1.0/"; | |
| 1093 static const char app2_iccp[] = "ICC_PROFILE"; | |
| 1094 jpeg_saved_marker_ptr marker; | |
| 1095 BPGMetaData *md, **plast_md, *first_md; | |
| 1096 int has_exif, has_xmp, l, iccp_chunk_count, i; | |
| 1097 jpeg_saved_marker_ptr iccp_chunks[256]; | |
| 1098 | |
| 1099 iccp_chunk_count = 0; | |
| 1100 has_exif = 0; | |
| 1101 has_xmp = 0; | |
| 1102 first_md = NULL; | |
| 1103 plast_md = &first_md; | |
| 1104 for (marker = first_marker; marker != NULL; marker = marker->next) { | |
| 1105 #if 0 | |
| 1106 printf("marker=APP%d len=%d\n", | |
| 1107 marker->marker - JPEG_APP0, marker->data_length); | |
| 1108 #endif | |
| 1109 if (!has_exif && marker->marker == JPEG_APP0 + 1 && | |
| 1110 marker->data_length > sizeof(app1_exif) && | |
| 1111 !memcmp(marker->data, app1_exif, sizeof(app1_exif))) { | |
| 1112 md = bpg_md_alloc(BPG_EXTENSION_TAG_EXIF); | |
| 1113 l = sizeof(app1_exif); | |
| 1114 md->buf_len = marker->data_length - l; | |
| 1115 md->buf = malloc(md->buf_len); | |
| 1116 memcpy(md->buf, marker->data + l, md->buf_len); | |
| 1117 *plast_md = md; | |
| 1118 plast_md = &md->next; | |
| 1119 has_exif = 1; | |
| 1120 } else if (!has_xmp && marker->marker == JPEG_APP0 + 1 && | |
| 1121 marker->data_length > sizeof(app1_xmp) && | |
| 1122 !memcmp(marker->data, app1_xmp, sizeof(app1_xmp)) && | |
| 1123 !has_xmp) { | |
| 1124 md = bpg_md_alloc(BPG_EXTENSION_TAG_XMP); | |
| 1125 l = sizeof(app1_xmp); | |
| 1126 md->buf_len = marker->data_length - l; | |
| 1127 md->buf = malloc(md->buf_len); | |
| 1128 memcpy(md->buf, marker->data + l, md->buf_len); | |
| 1129 *plast_md = md; | |
| 1130 plast_md = &md->next; | |
| 1131 has_xmp = 1; | |
| 1132 } else if (marker->marker == JPEG_APP0 + 2 && | |
| 1133 marker->data_length > (sizeof(app2_iccp) + 2) && | |
| 1134 !memcmp(marker->data, app2_iccp, sizeof(app2_iccp))) { | |
| 1135 int chunk_count, chunk_index; | |
| 1136 l = sizeof(app2_iccp); | |
| 1137 chunk_index = marker->data[l]; | |
| 1138 chunk_count = marker->data[l]; | |
| 1139 if (chunk_index == 0 || chunk_count == 0) | |
| 1140 continue; | |
| 1141 if (iccp_chunk_count == 0) { | |
| 1142 iccp_chunk_count = chunk_count; | |
| 1143 for(i = 0; i < chunk_count; i++) { | |
| 1144 iccp_chunks[i] = NULL; | |
| 1145 } | |
| 1146 } else { | |
| 1147 if (chunk_count != iccp_chunk_count) | |
| 1148 continue; | |
| 1149 } | |
| 1150 if (chunk_index > iccp_chunk_count) | |
| 1151 continue; | |
| 1152 iccp_chunks[chunk_index - 1] = marker; | |
| 1153 } | |
| 1154 } | |
| 1155 | |
| 1156 if (iccp_chunk_count != 0) { | |
| 1157 int len, hlen, idx; | |
| 1158 /* check that no chunk are missing */ | |
| 1159 len = 0; | |
| 1160 hlen = sizeof(app2_iccp) + 2; | |
| 1161 for(i = 0; i < iccp_chunk_count; i++) { | |
| 1162 if (!iccp_chunks[i]) | |
| 1163 break; | |
| 1164 len += iccp_chunks[i]->data_length - hlen; | |
| 1165 } | |
| 1166 if (i == iccp_chunk_count) { | |
| 1167 md = bpg_md_alloc(BPG_EXTENSION_TAG_ICCP); | |
| 1168 md->buf_len = len; | |
| 1169 md->buf = malloc(md->buf_len); | |
| 1170 idx = 0; | |
| 1171 for(i = 0; i < iccp_chunk_count; i++) { | |
| 1172 l = iccp_chunks[i]->data_length - hlen; | |
| 1173 memcpy(md->buf + idx, iccp_chunks[i]->data + hlen, l); | |
| 1174 idx += l; | |
| 1175 } | |
| 1176 assert(idx == len); | |
| 1177 *plast_md = md; | |
| 1178 plast_md = &md->next; | |
| 1179 } | |
| 1180 } | |
| 1181 return first_md; | |
| 1182 } | |
| 1183 | |
| 1184 Image *read_jpeg(BPGMetaData **pmd, FILE *f, | |
| 1185 int out_bit_depth) | |
| 1186 { | |
| 1187 struct jpeg_decompress_struct cinfo; | |
| 1188 struct jpeg_error_mgr jerr; | |
| 1189 int w, h, w1, i, y_h, c_h, y, v_shift, c_w, y1, idx, c_idx, h_shift; | |
| 1190 int h1, plane_idx[4], has_alpha, has_w_plane; | |
| 1191 Image *img; | |
| 1192 BPGImageFormatEnum format; | |
| 1193 BPGColorSpaceEnum color_space; | |
| 1194 ColorConvertState cvt_s, *cvt = &cvt_s; | |
| 1195 BPGMetaData *first_md = NULL; | |
| 1196 uint32_t comp_hv; | |
| 1197 | |
| 1198 cinfo.err = jpeg_std_error(&jerr); | |
| 1199 jpeg_create_decompress(&cinfo); | |
| 1200 | |
| 1201 jpeg_save_markers(&cinfo, JPEG_APP0 + 1, 65535); | |
| 1202 jpeg_save_markers(&cinfo, JPEG_APP0 + 2, 65535); | |
| 1203 | |
| 1204 jpeg_stdio_src(&cinfo, f); | |
| 1205 | |
| 1206 jpeg_read_header(&cinfo, TRUE); | |
| 1207 | |
| 1208 cinfo.raw_data_out = TRUE; | |
| 1209 cinfo.do_fancy_upsampling = TRUE; | |
| 1210 | |
| 1211 w = cinfo.image_width; | |
| 1212 h = cinfo.image_height; | |
| 1213 | |
| 1214 has_w_plane = 0; | |
| 1215 comp_hv = 0; | |
| 1216 if (cinfo.num_components < 1 || cinfo.num_components > 4) | |
| 1217 goto unsupported; | |
| 1218 for(i = 0; i < cinfo.num_components; i++) { | |
| 1219 comp_hv |= cinfo.comp_info[i].h_samp_factor << (i * 8 + 4); | |
| 1220 comp_hv |= cinfo.comp_info[i].v_samp_factor << (i * 8); | |
| 1221 } | |
| 1222 switch(cinfo.jpeg_color_space) { | |
| 1223 case JCS_GRAYSCALE: | |
| 1224 if (cinfo.num_components != 1 || comp_hv != 0x11) | |
| 1225 goto unsupported; | |
| 1226 format = BPG_FORMAT_GRAY; | |
| 1227 color_space = BPG_CS_YCbCr; | |
| 1228 break; | |
| 1229 case JCS_YCbCr: | |
| 1230 if (cinfo.num_components != 3) | |
| 1231 goto unsupported; | |
| 1232 switch(comp_hv) { | |
| 1233 case 0x111111: | |
| 1234 format = BPG_FORMAT_444; | |
| 1235 break; | |
| 1236 case 0x111121: | |
| 1237 format = BPG_FORMAT_422; | |
| 1238 break; | |
| 1239 case 0x111122: | |
| 1240 format = BPG_FORMAT_420; | |
| 1241 break; | |
| 1242 default: | |
| 1243 cinfo.raw_data_out = FALSE; | |
| 1244 format = BPG_FORMAT_444; | |
| 1245 cinfo.out_color_space = JCS_YCbCr; | |
| 1246 break; | |
| 1247 } | |
| 1248 color_space = BPG_CS_YCbCr; | |
| 1249 break; | |
| 1250 case JCS_RGB: | |
| 1251 if (cinfo.num_components != 3) | |
| 1252 goto unsupported; | |
| 1253 format = BPG_FORMAT_444; | |
| 1254 color_space = BPG_CS_RGB; | |
| 1255 cinfo.raw_data_out = FALSE; | |
| 1256 cinfo.out_color_space = JCS_RGB; | |
| 1257 break; | |
| 1258 case JCS_YCCK: | |
| 1259 if (cinfo.num_components != 4) | |
| 1260 goto unsupported; | |
| 1261 switch(comp_hv) { | |
| 1262 case 0x11111111: | |
| 1263 format = BPG_FORMAT_444; | |
| 1264 color_space = BPG_CS_YCbCr; | |
| 1265 break; | |
| 1266 case 0x22111121: | |
| 1267 format = BPG_FORMAT_422; | |
| 1268 color_space = BPG_CS_YCbCr; | |
| 1269 break; | |
| 1270 case 0x22111122: | |
| 1271 format = BPG_FORMAT_420; | |
| 1272 color_space = BPG_CS_YCbCr; | |
| 1273 break; | |
| 1274 default: | |
| 1275 cinfo.raw_data_out = FALSE; | |
| 1276 format = BPG_FORMAT_444; | |
| 1277 cinfo.out_color_space = JCS_CMYK; | |
| 1278 color_space = BPG_CS_RGB; | |
| 1279 break; | |
| 1280 } | |
| 1281 has_w_plane = 1; | |
| 1282 break; | |
| 1283 case JCS_CMYK: | |
| 1284 if (cinfo.num_components != 4) | |
| 1285 goto unsupported; | |
| 1286 format = BPG_FORMAT_444; | |
| 1287 color_space = BPG_CS_RGB; | |
| 1288 has_w_plane = 1; | |
| 1289 cinfo.raw_data_out = FALSE; | |
| 1290 cinfo.out_color_space = JCS_CMYK; | |
| 1291 break; | |
| 1292 default: | |
| 1293 unsupported: | |
| 1294 fprintf(stderr, "Unsupported JPEG parameters (cs=%d n_comp=%d comp_hv=%x)\n", | |
| 1295 cinfo.jpeg_color_space, cinfo.num_components, comp_hv); | |
| 1296 img = NULL; | |
| 1297 goto the_end; | |
| 1298 } | |
| 1299 | |
| 1300 v_shift = (format == BPG_FORMAT_420); | |
| 1301 h_shift = (format == BPG_FORMAT_422 || format == BPG_FORMAT_420); | |
| 1302 has_alpha = (cinfo.num_components == 4); | |
| 1303 img = image_alloc(w, h, format, has_alpha, color_space, out_bit_depth); | |
| 1304 img->has_w_plane = has_w_plane; | |
| 1305 | |
| 1306 convert_init(cvt, 8, out_bit_depth, color_space, 0); | |
| 1307 | |
| 1308 jpeg_start_decompress(&cinfo); | |
| 1309 | |
| 1310 if (color_space == BPG_CS_RGB) { | |
| 1311 plane_idx[0] = 2; | |
| 1312 plane_idx[1] = 0; | |
| 1313 plane_idx[2] = 1; | |
| 1314 } else { | |
| 1315 plane_idx[0] = 0; | |
| 1316 plane_idx[1] = 1; | |
| 1317 plane_idx[2] = 2; | |
| 1318 } | |
| 1319 plane_idx[3] = 3; | |
| 1320 | |
| 1321 if (cinfo.raw_data_out) { | |
| 1322 JSAMPROW rows[4][16]; | |
| 1323 JSAMPROW *plane_pointer[4]; | |
| 1324 | |
| 1325 y_h = 8 * cinfo.max_v_samp_factor; | |
| 1326 if (cinfo.num_components == 1) { | |
| 1327 c_h = 0; | |
| 1328 c_w = 0; | |
| 1329 } else { | |
| 1330 c_h = 8; | |
| 1331 if (h_shift) | |
| 1332 c_w = (w + 1) / 2; | |
| 1333 else | |
| 1334 c_w = w; | |
| 1335 } | |
| 1336 w1 = (w + 15) & ~15; | |
| 1337 for(c_idx = 0; c_idx < cinfo.num_components; c_idx++) { | |
| 1338 if (c_idx == 1 || c_idx == 2) { | |
| 1339 h1 = c_h; | |
| 1340 } else { | |
| 1341 h1 = y_h; | |
| 1342 } | |
| 1343 for(i = 0; i < h1; i++) { | |
| 1344 rows[c_idx][i] = malloc(w1); | |
| 1345 } | |
| 1346 plane_pointer[c_idx] = rows[c_idx]; | |
| 1347 } | |
| 1348 | |
| 1349 while (cinfo.output_scanline < cinfo.output_height) { | |
| 1350 y = cinfo.output_scanline; | |
| 1351 jpeg_read_raw_data(&cinfo, plane_pointer, y_h); | |
| 1352 | |
| 1353 for(c_idx = 0; c_idx < cinfo.num_components; c_idx++) { | |
| 1354 if (c_idx == 1 || c_idx == 2) { | |
| 1355 h1 = c_h; | |
| 1356 w1 = c_w; | |
| 1357 y1 = (y >> v_shift); | |
| 1358 } else { | |
| 1359 h1 = y_h; | |
| 1360 w1 = img->w; | |
| 1361 y1 = y; | |
| 1362 } | |
| 1363 idx = plane_idx[c_idx]; | |
| 1364 for(i = 0; i < h1; i++) { | |
| 1365 PIXEL *ptr; | |
| 1366 ptr = (PIXEL *)(img->data[idx] + | |
| 1367 img->linesize[idx] * (y1 + i)); | |
| 1368 gray8_to_gray(cvt, ptr, rows[c_idx][i], w1, 1); | |
| 1369 if (color_space == BPG_CS_YCbCr && has_w_plane) { | |
| 1370 /* negate color */ | |
| 1371 if (c_idx == 0) { | |
| 1372 gray_one_minus(cvt, ptr, w1); | |
| 1373 } else if (c_idx <= 2) { | |
| 1374 gray_neg_c(cvt, ptr, w1); | |
| 1375 } | |
| 1376 } | |
| 1377 } | |
| 1378 } | |
| 1379 } | |
| 1380 | |
| 1381 for(c_idx = 0; c_idx < cinfo.num_components; c_idx++) { | |
| 1382 if (c_idx == 1 || c_idx == 2) { | |
| 1383 h1 = c_h; | |
| 1384 } else { | |
| 1385 h1 = y_h; | |
| 1386 } | |
| 1387 for(i = 0; i < h1; i++) { | |
| 1388 free(rows[c_idx][i]); | |
| 1389 } | |
| 1390 } | |
| 1391 } else { | |
| 1392 JSAMPROW rows[1]; | |
| 1393 uint8_t *buf; | |
| 1394 int c_count; | |
| 1395 | |
| 1396 c_count = 3 + has_w_plane; | |
| 1397 buf = malloc(c_count * w); | |
| 1398 rows[0] = buf; | |
| 1399 while (cinfo.output_scanline < cinfo.output_height) { | |
| 1400 y = cinfo.output_scanline; | |
| 1401 jpeg_read_scanlines(&cinfo, rows, 1); | |
| 1402 | |
| 1403 for(c_idx = 0; c_idx < c_count; c_idx++) { | |
| 1404 idx = plane_idx[c_idx]; | |
| 1405 gray8_to_gray(cvt, (PIXEL *)(img->data[idx] + | |
| 1406 img->linesize[idx] * y), | |
| 1407 buf + c_idx, w, c_count); | |
| 1408 } | |
| 1409 } | |
| 1410 free(buf); | |
| 1411 } | |
| 1412 | |
| 1413 first_md = jpeg_get_metadata(cinfo.marker_list); | |
| 1414 | |
| 1415 the_end: | |
| 1416 jpeg_finish_decompress(&cinfo); | |
| 1417 | |
| 1418 jpeg_destroy_decompress(&cinfo); | |
| 1419 *pmd = first_md; | |
| 1420 return img; | |
| 1421 } | |
| 1422 | |
| 1423 Image *load_image(BPGMetaData **pmd, const char *infilename, | |
| 1424 BPGColorSpaceEnum color_space, int bit_depth, | |
| 1425 int limited_range, int premultiplied_alpha) | |
| 1426 { | |
| 1427 FILE *f; | |
|
3
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1428 Image *img = NULL; |
| 0 | 1429 BPGMetaData *md; |
|
3
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1430 uint8_t buf[PROBE_BUF_SIZE]; |
| 0 | 1431 |
| 1432 *pmd = NULL; | |
| 1433 | |
|
3
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1434 if ((f = fopen(infilename, "rb")) == NULL) |
| 0 | 1435 return NULL; |
|
3
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1436 |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1437 if (fread(buf, 1, PROBE_BUF_SIZE, f) != PROBE_BUF_SIZE) |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1438 goto err; |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1439 |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1440 fseek(f, 0, SEEK_SET); |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1441 |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1442 if (png_sig_cmp(buf, 0, PROBE_BUF_SIZE) == 0) |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1443 img = read_png(&md, f, color_space, bit_depth, limited_range, premultiplied_alpha); |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1444 else |
| 0 | 1445 img = read_jpeg(&md, f, bit_depth); |
|
3
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1446 |
|
ffcd1967fb5c
Clean up load_image() probing code a bit in preparation for TIFF support.
Matti Hamalainen <ccr@tnsp.org>
parents:
0
diff
changeset
|
1447 err: |
| 0 | 1448 fclose(f); |
| 1449 *pmd = md; | |
| 1450 return img; | |
| 1451 } | |
| 1452 | |
| 1453 void save_yuv1(Image *img, FILE *f) | |
| 1454 { | |
| 1455 int c_w, c_h, i, c_count, y; | |
| 1456 | |
| 1457 if (img->format == BPG_FORMAT_GRAY) | |
| 1458 c_count = 1; | |
| 1459 else | |
| 1460 c_count = 3; | |
| 1461 for(i = 0; i < c_count; i++) { | |
| 1462 get_plane_res(img, &c_w, &c_h, i); | |
| 1463 for(y = 0; y < c_h; y++) { | |
| 1464 fwrite(img->data[i] + y * img->linesize[i], | |
| 1465 1, c_w << img->pixel_shift, f); | |
| 1466 } | |
| 1467 } | |
| 1468 } | |
| 1469 | |
| 1470 void save_yuv(Image *img, const char *filename) | |
| 1471 { | |
| 1472 FILE *f; | |
| 1473 | |
| 1474 f = fopen(filename, "wb"); | |
| 1475 if (!f) { | |
| 1476 fprintf(stderr, "Could not open %s\n", filename); | |
| 1477 exit(1); | |
| 1478 } | |
| 1479 save_yuv1(img, f); | |
| 1480 fclose(f); | |
| 1481 } | |
| 1482 | |
| 1483 /* return the position of the end of the NAL or -1 if error */ | |
| 1484 static int find_nal_end(const uint8_t *buf, int buf_len) | |
| 1485 { | |
| 1486 int idx; | |
| 1487 | |
| 1488 idx = 0; | |
| 1489 if (buf_len >= 4 && | |
| 1490 buf[0] == 0 && buf[1] == 0 && buf[2] == 0 && buf[3] == 1) { | |
| 1491 idx = 4; | |
| 1492 } else if (buf_len >= 3 && | |
| 1493 buf[0] == 0 && buf[1] == 0 && buf[2] == 1) { | |
| 1494 idx = 3; | |
| 1495 } else { | |
| 1496 return -1; | |
| 1497 } | |
| 1498 /* NAL header */ | |
| 1499 if (idx + 2 > buf_len) | |
| 1500 return -1; | |
| 1501 /* find the last byte */ | |
| 1502 for(;;) { | |
| 1503 if (idx + 2 >= buf_len) { | |
| 1504 idx = buf_len; | |
| 1505 break; | |
| 1506 } | |
| 1507 if (buf[idx] == 0 && buf[idx + 1] == 0 && buf[idx + 2] == 1) | |
| 1508 break; | |
| 1509 if (idx + 3 < buf_len && | |
| 1510 buf[idx] == 0 && buf[idx + 1] == 0 && buf[idx + 2] == 0 && buf[idx + 3] == 1) | |
| 1511 break; | |
| 1512 idx++; | |
| 1513 } | |
| 1514 return idx; | |
| 1515 } | |
| 1516 | |
| 1517 /* return the position of the end of the NAL or -1 if error */ | |
| 1518 static int extract_nal(uint8_t **pnal_buf, int *pnal_len, | |
| 1519 const uint8_t *buf, int buf_len) | |
| 1520 { | |
| 1521 int idx, start, end, len; | |
| 1522 uint8_t *nal_buf; | |
| 1523 int nal_len; | |
| 1524 | |
| 1525 end = find_nal_end(buf, buf_len); | |
| 1526 if (end < 0) | |
| 1527 return -1; | |
| 1528 if (buf[2] == 1) | |
| 1529 start = 3; | |
| 1530 else | |
| 1531 start = 4; | |
| 1532 len = end - start; | |
| 1533 | |
| 1534 nal_buf = malloc(len); | |
| 1535 nal_len = 0; | |
| 1536 idx = start; | |
| 1537 while (idx < end) { | |
| 1538 if (idx + 2 < end && buf[idx] == 0 && buf[idx + 1] == 0 && buf[idx + 2] == 3) { | |
| 1539 nal_buf[nal_len++] = 0; | |
| 1540 nal_buf[nal_len++] = 0; | |
| 1541 idx += 3; | |
| 1542 } else { | |
| 1543 nal_buf[nal_len++] = buf[idx++]; | |
| 1544 } | |
| 1545 } | |
| 1546 while (idx < end) { | |
| 1547 nal_buf[nal_len++] = buf[idx++]; | |
| 1548 } | |
| 1549 *pnal_buf = nal_buf; | |
| 1550 *pnal_len = nal_len; | |
| 1551 return idx; | |
| 1552 } | |
| 1553 | |
| 1554 /* big endian variable length 7 bit encoding */ | |
| 1555 static void put_ue(uint8_t **pp, uint32_t v) | |
| 1556 { | |
| 1557 uint8_t *p = *pp; | |
| 1558 int i, j; | |
| 1559 | |
| 1560 for(i = 1; i < 5; i++) { | |
| 1561 if (v < (1 << (7 * i))) | |
| 1562 break; | |
| 1563 } | |
| 1564 for(j = i - 1; j >= 1; j--) | |
| 1565 *p++ = ((v >> (7 * j)) & 0x7f) | 0x80; | |
| 1566 *p++ = v & 0x7f; | |
| 1567 *pp = p; | |
| 1568 } | |
| 1569 | |
| 1570 typedef struct { | |
| 1571 const uint8_t *buf; | |
| 1572 int idx; | |
| 1573 int buf_len; | |
| 1574 } GetBitState; | |
| 1575 | |
| 1576 static void init_get_bits(GetBitState *s, const uint8_t *buf, int buf_len) | |
| 1577 { | |
| 1578 s->buf = buf; | |
| 1579 s->buf_len = buf_len; | |
| 1580 s->idx = 0; | |
| 1581 } | |
| 1582 | |
| 1583 static void skip_bits(GetBitState *s, int n) | |
| 1584 { | |
| 1585 s->idx += n; | |
| 1586 } | |
| 1587 | |
| 1588 /* 1 <= n <= 25. return '0' bits if past the end of the buffer. */ | |
| 1589 static uint32_t get_bits(GetBitState *s, int n) | |
| 1590 { | |
| 1591 const uint8_t *buf = s->buf; | |
| 1592 int p, i; | |
| 1593 uint32_t v; | |
| 1594 | |
| 1595 p = s->idx >> 3; | |
| 1596 if ((p + 3) < s->buf_len) { | |
| 1597 v = (buf[p] << 24) | (buf[p + 1] << 16) | | |
| 1598 (buf[p + 2] << 8) | buf[p + 3]; | |
| 1599 } else { | |
| 1600 v = 0; | |
| 1601 for(i = 0; i < 3; i++) { | |
| 1602 if ((p + i) < s->buf_len) | |
| 1603 v |= buf[p + i] << (24 - i * 8); | |
| 1604 } | |
| 1605 } | |
| 1606 v = (v >> (32 - (s->idx & 7) - n)) & ((1 << n) - 1); | |
| 1607 s->idx += n; | |
| 1608 return v; | |
| 1609 } | |
| 1610 | |
| 1611 /* 1 <= n <= 32 */ | |
| 1612 static uint32_t get_bits_long(GetBitState *s, int n) | |
| 1613 { | |
| 1614 uint32_t v; | |
| 1615 | |
| 1616 if (n <= 25) { | |
| 1617 v = get_bits(s, n); | |
| 1618 } else { | |
| 1619 n -= 16; | |
| 1620 v = get_bits(s, 16) << n; | |
| 1621 v |= get_bits(s, n); | |
| 1622 } | |
| 1623 return v; | |
| 1624 } | |
| 1625 | |
| 1626 /* at most 32 bits are supported */ | |
| 1627 static uint32_t get_ue_golomb(GetBitState *s) | |
| 1628 { | |
| 1629 int i; | |
| 1630 i = 0; | |
| 1631 for(;;) { | |
| 1632 if (get_bits(s, 1)) | |
| 1633 break; | |
| 1634 i++; | |
| 1635 if (i == 32) | |
| 1636 return 0xffffffff; | |
| 1637 } | |
| 1638 if (i == 0) | |
| 1639 return 0; | |
| 1640 else | |
| 1641 return ((1 << i) | get_bits_long(s, i)) - 1; | |
| 1642 } | |
| 1643 | |
| 1644 typedef struct { | |
| 1645 uint8_t *buf; | |
| 1646 int idx; | |
| 1647 } PutBitState; | |
| 1648 | |
| 1649 static void init_put_bits(PutBitState *s, uint8_t *buf) | |
| 1650 { | |
| 1651 s->buf = buf; | |
| 1652 s->idx = 0; | |
| 1653 } | |
| 1654 | |
| 1655 static void put_bit(PutBitState *s, int bit) | |
| 1656 { | |
| 1657 s->buf[s->idx >> 3] |= bit << (7 - (s->idx & 7)); | |
| 1658 s->idx++; | |
| 1659 } | |
| 1660 | |
| 1661 static void put_bits(PutBitState *s, int n, uint32_t v) | |
| 1662 { | |
| 1663 int i; | |
| 1664 | |
| 1665 for(i = 0; i < n; i++) { | |
| 1666 put_bit(s, (v >> (n - 1 - i)) & 1); | |
| 1667 } | |
| 1668 } | |
| 1669 | |
| 1670 static void put_ue_golomb(PutBitState *s, uint32_t v) | |
| 1671 { | |
| 1672 uint32_t a; | |
| 1673 int n; | |
| 1674 | |
| 1675 v++; | |
| 1676 n = 0; | |
| 1677 a = v; | |
| 1678 while (a != 0) { | |
| 1679 a >>= 1; | |
| 1680 n++; | |
| 1681 } | |
| 1682 if (n > 1) | |
| 1683 put_bits(s, n - 1, 0); | |
| 1684 put_bits(s, n, v); | |
| 1685 } | |
| 1686 | |
| 1687 typedef struct { | |
| 1688 uint8_t *buf; | |
| 1689 int size; | |
| 1690 int len; | |
| 1691 } DynBuf; | |
| 1692 | |
| 1693 static void dyn_buf_init(DynBuf *s) | |
| 1694 { | |
| 1695 s->buf = NULL; | |
| 1696 s->size = 0; | |
| 1697 s->len = 0; | |
| 1698 } | |
| 1699 | |
| 1700 static int dyn_buf_resize(DynBuf *s, int size) | |
| 1701 { | |
| 1702 int new_size; | |
| 1703 uint8_t *new_buf; | |
| 1704 | |
| 1705 if (size <= s->size) | |
| 1706 return 0; | |
| 1707 new_size = (s->size * 3) / 2; | |
| 1708 if (new_size < size) | |
| 1709 new_size = size; | |
| 1710 new_buf = realloc(s->buf, new_size); | |
| 1711 if (!new_buf) | |
| 1712 return -1; | |
| 1713 s->buf = new_buf; | |
| 1714 s->size = new_size; | |
| 1715 return 0; | |
| 1716 } | |
| 1717 | |
| 1718 /* suppress the VPS NAL and keep only the useful part of the SPS | |
| 1719 header. The decoder can rebuild a valid HEVC stream if needed. */ | |
| 1720 static int build_modified_sps(uint8_t **pout_buf, int *pout_buf_len, | |
| 1721 const uint8_t *buf, int buf_len) | |
| 1722 { | |
| 1723 int nal_unit_type, nal_len, idx, i, ret, msps_buf_len; | |
| 1724 int out_buf_len, out_buf_len_max; | |
| 1725 uint8_t *nal_buf, *msps_buf, *out_buf; | |
| 1726 GetBitState gb_s, *gb = &gb_s; | |
| 1727 PutBitState pb_s, *pb = &pb_s; | |
| 1728 uint8_t *p; | |
| 1729 | |
| 1730 idx = extract_nal(&nal_buf, &nal_len, buf, buf_len); | |
| 1731 if (idx < 0) | |
| 1732 return -1; | |
| 1733 if (nal_len < 2) { | |
| 1734 free(nal_buf); | |
| 1735 return -1; | |
| 1736 } | |
| 1737 nal_unit_type = (nal_buf[0] >> 1) & 0x3f; | |
| 1738 free(nal_buf); | |
| 1739 if (nal_unit_type != 32) { | |
| 1740 fprintf(stderr, "expecting VPS nal (%d)\n", nal_unit_type); | |
| 1741 return -1; /* expect VPS nal */ | |
| 1742 } | |
| 1743 | |
| 1744 ret = extract_nal(&nal_buf, &nal_len, buf + idx, buf_len); | |
| 1745 if (ret < 0) | |
| 1746 return -1; | |
| 1747 idx += ret; | |
| 1748 if (nal_len < 2) | |
| 1749 return -1; | |
| 1750 nal_unit_type = (nal_buf[0] >> 1) & 0x3f; | |
| 1751 if (nal_unit_type != 33) { | |
| 1752 fprintf(stderr, "expecting SPS nal (%d)\n", nal_unit_type); | |
| 1753 return -1; /* expect SPS nal */ | |
| 1754 } | |
| 1755 | |
| 1756 /* skip the initial part of the SPS up to and including | |
| 1757 log2_min_cb_size */ | |
| 1758 { | |
| 1759 int vps_id, max_sub_layers, profile_idc, sps_id; | |
| 1760 int chroma_format_idc, width, height, bit_depth_luma, bit_depth_chroma; | |
| 1761 int log2_max_poc_lsb, sublayer_ordering_info, log2_min_cb_size; | |
| 1762 int log2_diff_max_min_coding_block_size, log2_min_tb_size; | |
| 1763 int log2_diff_max_min_transform_block_size; | |
| 1764 int max_transform_hierarchy_depth_inter; | |
| 1765 int max_transform_hierarchy_depth_intra; | |
| 1766 int scaling_list_enable_flag, amp_enabled_flag, sao_enabled; | |
| 1767 int pcm_enabled_flag, nb_st_rps; | |
| 1768 int long_term_ref_pics_present_flag, sps_strong_intra_smoothing_enable_flag, vui_present; | |
| 1769 int sps_temporal_mvp_enabled_flag; | |
| 1770 int pcm_sample_bit_depth_luma_minus1; | |
| 1771 int pcm_sample_bit_depth_chroma_minus1; | |
| 1772 int log2_min_pcm_luma_coding_block_size_minus3; | |
| 1773 int log2_diff_max_min_pcm_luma_coding_block_size; | |
| 1774 int pcm_loop_filter_disabled_flag; | |
| 1775 int sps_extension_flag, sps_range_extension_flag, sps_extension_7bits; | |
| 1776 int sps_range_extension_flags; | |
| 1777 | |
| 1778 init_get_bits(gb, nal_buf, nal_len); | |
| 1779 skip_bits(gb, 16); /* nal header */ | |
| 1780 vps_id = get_bits(gb, 4); | |
| 1781 if (vps_id != 0) { | |
| 1782 fprintf(stderr, "VPS id 0 expected\n"); | |
| 1783 return -1; | |
| 1784 } | |
| 1785 max_sub_layers = get_bits(gb, 3); | |
| 1786 if (max_sub_layers != 0) { | |
| 1787 fprintf(stderr, "max_sub_layers == 0 expected\n"); | |
| 1788 return -1; | |
| 1789 } | |
| 1790 skip_bits(gb, 1); /* temporal_id_nesting_flag */ | |
| 1791 /* profile tier level */ | |
| 1792 skip_bits(gb, 2); /* profile_space */ | |
| 1793 skip_bits(gb, 1); /* tier_flag */ | |
| 1794 profile_idc = get_bits(gb, 5); | |
| 1795 for(i = 0; i < 32; i++) { | |
| 1796 skip_bits(gb, 1); /* profile_compatibility_flag */ | |
| 1797 } | |
| 1798 skip_bits(gb, 1); /* progressive_source_flag */ | |
| 1799 skip_bits(gb, 1); /* interlaced_source_flag */ | |
| 1800 skip_bits(gb, 1); /* non_packed_constraint_flag */ | |
| 1801 skip_bits(gb, 1); /* frame_only_constraint_flag */ | |
| 1802 skip_bits(gb, 44); /* XXX_reserved_zero_44 */ | |
| 1803 skip_bits(gb, 8); /* level_idc */ | |
| 1804 | |
| 1805 sps_id = get_ue_golomb(gb); | |
| 1806 if (sps_id != 0) { | |
| 1807 fprintf(stderr, "SPS id 0 expected (%d)\n", sps_id); | |
| 1808 return -1; | |
| 1809 } | |
| 1810 chroma_format_idc = get_ue_golomb(gb); | |
| 1811 if (chroma_format_idc == 3) { | |
| 1812 get_bits(gb, 1); /* separate_colour_plane_flag */ | |
| 1813 } | |
| 1814 width = get_ue_golomb(gb); | |
| 1815 height = get_ue_golomb(gb); | |
| 1816 /* pic conformance_flag */ | |
| 1817 if (get_bits(gb, 1)) { | |
| 1818 get_ue_golomb(gb); /* left_offset */ | |
| 1819 get_ue_golomb(gb); /* right_offset */ | |
| 1820 get_ue_golomb(gb); /* top_offset */ | |
| 1821 get_ue_golomb(gb); /* bottom_offset */ | |
| 1822 } | |
| 1823 bit_depth_luma = get_ue_golomb(gb) + 8; | |
| 1824 bit_depth_chroma = get_ue_golomb(gb) + 8; | |
| 1825 log2_max_poc_lsb = get_ue_golomb(gb) + 4; | |
| 1826 if (log2_max_poc_lsb != 8) { | |
| 1827 fprintf(stderr, "log2_max_poc_lsb must be 8 (%d)\n", log2_max_poc_lsb); | |
| 1828 return -1; | |
| 1829 } | |
| 1830 sublayer_ordering_info = get_bits(gb, 1); | |
| 1831 get_ue_golomb(gb); /* max_dec_pic_buffering */ | |
| 1832 get_ue_golomb(gb); /* num_reorder_pics */ | |
| 1833 get_ue_golomb(gb); /* max_latency_increase */ | |
| 1834 | |
| 1835 log2_min_cb_size = get_ue_golomb(gb) + 3; | |
| 1836 log2_diff_max_min_coding_block_size = get_ue_golomb(gb); | |
| 1837 log2_min_tb_size = get_ue_golomb(gb) + 2; | |
| 1838 log2_diff_max_min_transform_block_size = get_ue_golomb(gb); | |
| 1839 | |
| 1840 max_transform_hierarchy_depth_inter = get_ue_golomb(gb); | |
| 1841 max_transform_hierarchy_depth_intra = get_ue_golomb(gb); | |
| 1842 if (max_transform_hierarchy_depth_inter != max_transform_hierarchy_depth_intra) { | |
| 1843 fprintf(stderr, "max_transform_hierarchy_depth_inter must be the same as max_transform_hierarchy_depth_intra (%d %d)\n", max_transform_hierarchy_depth_inter, max_transform_hierarchy_depth_intra); | |
| 1844 return -1; | |
| 1845 } | |
| 1846 | |
| 1847 scaling_list_enable_flag = get_bits(gb, 1); | |
| 1848 if (scaling_list_enable_flag != 0) { | |
| 1849 fprintf(stderr, "scaling_list_enable_flag must be 0\n"); | |
| 1850 return -1; | |
| 1851 } | |
| 1852 amp_enabled_flag = get_bits(gb, 1); | |
| 1853 if (!amp_enabled_flag) { | |
| 1854 fprintf(stderr, "amp_enabled_flag must be set\n"); | |
| 1855 return -1; | |
| 1856 } | |
| 1857 sao_enabled = get_bits(gb, 1); | |
| 1858 pcm_enabled_flag = get_bits(gb, 1); | |
| 1859 if (pcm_enabled_flag) { | |
| 1860 pcm_sample_bit_depth_luma_minus1 = get_bits(gb, 4); | |
| 1861 pcm_sample_bit_depth_chroma_minus1 = get_bits(gb, 4); | |
| 1862 log2_min_pcm_luma_coding_block_size_minus3 = get_ue_golomb(gb); | |
| 1863 log2_diff_max_min_pcm_luma_coding_block_size = get_ue_golomb(gb); | |
| 1864 pcm_loop_filter_disabled_flag = get_bits(gb, 1); | |
| 1865 } | |
| 1866 nb_st_rps = get_ue_golomb(gb); | |
| 1867 if (nb_st_rps != 0) { | |
| 1868 fprintf(stderr, "nb_st_rps must be 0 (%d)\n", nb_st_rps); | |
| 1869 return -1; | |
| 1870 } | |
| 1871 long_term_ref_pics_present_flag = get_bits(gb, 1); | |
| 1872 if (long_term_ref_pics_present_flag) { | |
| 1873 fprintf(stderr, "nlong_term_ref_pics_present_flag must be 0 (%d)\n", nb_st_rps); | |
| 1874 return -1; | |
| 1875 } | |
| 1876 sps_temporal_mvp_enabled_flag = get_bits(gb, 1); | |
| 1877 if (!sps_temporal_mvp_enabled_flag) { | |
| 1878 fprintf(stderr, "sps_temporal_mvp_enabled_flag must be set\n"); | |
| 1879 return -1; | |
| 1880 } | |
| 1881 sps_strong_intra_smoothing_enable_flag = get_bits(gb, 1); | |
| 1882 vui_present = get_bits(gb, 1); | |
| 1883 if (vui_present) { | |
| 1884 int sar_present, sar_idx, overscan_info_present_flag; | |
| 1885 int video_signal_type_present_flag, chroma_loc_info_present_flag; | |
| 1886 int default_display_window_flag, vui_timing_info_present_flag; | |
| 1887 int vui_poc_proportional_to_timing_flag; | |
| 1888 int vui_hrd_parameters_present_flag, bitstream_restriction_flag; | |
| 1889 | |
| 1890 sar_present = get_bits(gb, 1); | |
| 1891 if (sar_present) { | |
| 1892 sar_idx = get_bits(gb, 8); | |
| 1893 if (sar_idx == 255) { | |
| 1894 skip_bits(gb, 16); /* sar_num */ | |
| 1895 skip_bits(gb, 16); /* sar_den */ | |
| 1896 } | |
| 1897 } | |
| 1898 | |
| 1899 overscan_info_present_flag = get_bits(gb, 1); | |
| 1900 if (overscan_info_present_flag) { | |
| 1901 skip_bits(gb, 1); /* overscan_appropriate_flag */ | |
| 1902 } | |
| 1903 | |
| 1904 video_signal_type_present_flag = get_bits(gb, 1); | |
| 1905 if (video_signal_type_present_flag) { | |
| 1906 fprintf(stderr, "video_signal_type_present_flag must be 0\n"); | |
| 1907 return -1; | |
| 1908 } | |
| 1909 chroma_loc_info_present_flag = get_bits(gb, 1); | |
| 1910 if (chroma_loc_info_present_flag) { | |
| 1911 get_ue_golomb(gb); | |
| 1912 get_ue_golomb(gb); | |
| 1913 } | |
| 1914 skip_bits(gb, 1); /* neutra_chroma_indication_flag */ | |
| 1915 skip_bits(gb, 1); | |
| 1916 skip_bits(gb, 1); | |
| 1917 default_display_window_flag = get_bits(gb, 1); | |
| 1918 if (default_display_window_flag) { | |
| 1919 fprintf(stderr, "default_display_window_flag must be 0\n"); | |
| 1920 return -1; | |
| 1921 } | |
| 1922 vui_timing_info_present_flag = get_bits(gb, 1); | |
| 1923 if (vui_timing_info_present_flag) { | |
| 1924 skip_bits(gb, 32); | |
| 1925 skip_bits(gb, 32); | |
| 1926 vui_poc_proportional_to_timing_flag = get_bits(gb, 1); | |
| 1927 if (vui_poc_proportional_to_timing_flag) { | |
| 1928 get_ue_golomb(gb); | |
| 1929 } | |
| 1930 vui_hrd_parameters_present_flag = get_bits(gb, 1); | |
| 1931 if (vui_hrd_parameters_present_flag) { | |
| 1932 fprintf(stderr, "vui_hrd_parameters_present_flag must be 0\n"); | |
| 1933 return -1; | |
| 1934 } | |
| 1935 } | |
| 1936 bitstream_restriction_flag = get_bits(gb, 1); | |
| 1937 if (bitstream_restriction_flag) { | |
| 1938 skip_bits(gb, 1); | |
| 1939 skip_bits(gb, 1); | |
| 1940 skip_bits(gb, 1); | |
| 1941 get_ue_golomb(gb); | |
| 1942 get_ue_golomb(gb); | |
| 1943 get_ue_golomb(gb); | |
| 1944 get_ue_golomb(gb); | |
| 1945 get_ue_golomb(gb); | |
| 1946 } | |
| 1947 } | |
| 1948 sps_extension_flag = get_bits(gb, 1); | |
| 1949 sps_range_extension_flag = 0; | |
| 1950 sps_range_extension_flags = 0; | |
| 1951 if (sps_extension_flag) { | |
| 1952 sps_range_extension_flag = get_bits(gb, 1); | |
| 1953 sps_extension_7bits = get_bits(gb, 7); | |
| 1954 if (sps_extension_7bits != 0) { | |
| 1955 fprintf(stderr, "sps_extension_7bits must be 0\n"); | |
| 1956 return -1; | |
| 1957 } | |
| 1958 if (sps_range_extension_flag) { | |
| 1959 sps_range_extension_flags = get_bits(gb, 9); | |
| 1960 if (sps_range_extension_flags & ((1 << (8 - 3)) | | |
| 1961 (1 << (8 - 4)) | | |
| 1962 (1 << (8 - 6)) | | |
| 1963 (1 << (8 - 8)))) { | |
| 1964 fprintf(stderr, "unsupported range extensions (0x%x)\n", | |
| 1965 sps_range_extension_flags); | |
| 1966 return -1; | |
| 1967 } | |
| 1968 } | |
| 1969 } | |
| 1970 | |
| 1971 /* build the modified SPS */ | |
| 1972 msps_buf = malloc(nal_len + 32); | |
| 1973 memset(msps_buf, 0, nal_len + 16); | |
| 1974 | |
| 1975 init_put_bits(pb, msps_buf); | |
| 1976 put_ue_golomb(pb, log2_min_cb_size - 3); | |
| 1977 put_ue_golomb(pb, log2_diff_max_min_coding_block_size); | |
| 1978 put_ue_golomb(pb, log2_min_tb_size - 2); | |
| 1979 put_ue_golomb(pb, log2_diff_max_min_transform_block_size); | |
| 1980 put_ue_golomb(pb, max_transform_hierarchy_depth_intra); | |
| 1981 put_bits(pb, 1, sao_enabled); | |
| 1982 put_bits(pb, 1, pcm_enabled_flag); | |
| 1983 if (pcm_enabled_flag) { | |
| 1984 put_bits(pb, 4, pcm_sample_bit_depth_luma_minus1); | |
| 1985 put_bits(pb, 4, pcm_sample_bit_depth_chroma_minus1); | |
| 1986 put_ue_golomb(pb, log2_min_pcm_luma_coding_block_size_minus3); | |
| 1987 put_ue_golomb(pb, log2_diff_max_min_pcm_luma_coding_block_size); | |
| 1988 put_bits(pb, 1, pcm_loop_filter_disabled_flag); | |
| 1989 } | |
| 1990 put_bits(pb, 1, sps_strong_intra_smoothing_enable_flag); | |
| 1991 put_bits(pb, 1, sps_extension_flag); | |
| 1992 if (sps_extension_flag) { | |
| 1993 put_bits(pb, 1, sps_range_extension_flag); | |
| 1994 put_bits(pb, 7, 0); | |
| 1995 if (sps_range_extension_flag) { | |
| 1996 put_bits(pb, 9, sps_range_extension_flags); | |
| 1997 } | |
| 1998 } | |
| 1999 msps_buf_len = (pb->idx + 7) >> 3; | |
| 2000 | |
| 2001 out_buf_len_max = 5 + msps_buf_len; | |
| 2002 out_buf = malloc(out_buf_len_max); | |
| 2003 | |
| 2004 // printf("msps_n_bits=%d\n", pb->idx); | |
| 2005 p = out_buf; | |
| 2006 put_ue(&p, msps_buf_len); /* header length */ | |
| 2007 | |
| 2008 memcpy(p, msps_buf, msps_buf_len); | |
| 2009 p += msps_buf_len; | |
| 2010 | |
| 2011 out_buf_len = p - out_buf; | |
| 2012 free(msps_buf); | |
| 2013 free(nal_buf); | |
| 2014 } | |
| 2015 *pout_buf = out_buf; | |
| 2016 *pout_buf_len = out_buf_len; | |
| 2017 return idx; | |
| 2018 } | |
| 2019 | |
| 2020 static int add_frame_duration_sei(DynBuf *out_buf, uint16_t frame_ticks) | |
| 2021 { | |
| 2022 uint8_t nal_buf[128], *q; | |
| 2023 int nut, nal_len; | |
| 2024 | |
| 2025 q = nal_buf; | |
| 2026 *q++ = 0x00; | |
| 2027 *q++ = 0x00; | |
| 2028 *q++ = 0x01; | |
| 2029 nut = 39; /* prefix SEI NUT */ | |
| 2030 *q++ = (nut << 1); | |
| 2031 *q++ = 1; | |
| 2032 *q++ = 0xff; /* payload_type = 257 */ | |
| 2033 *q++ = 0x02; | |
| 2034 *q++ = 2; /* payload_size = 2 */ | |
| 2035 *q++ = frame_ticks >> 8; | |
| 2036 *q++ = frame_ticks; | |
| 2037 *q++ = 0x80; /* extra '1' bit and align to byte */ | |
| 2038 /* Note: the 0x00 0x00 b pattern with b <= 3 cannot happen, so no | |
| 2039 need to escape */ | |
| 2040 nal_len = q - nal_buf; | |
| 2041 if (dyn_buf_resize(out_buf, out_buf->len + nal_len) < 0) | |
| 2042 return -1; | |
| 2043 memcpy(out_buf->buf + out_buf->len, nal_buf, nal_len); | |
| 2044 out_buf->len += nal_len; | |
| 2045 return 0; | |
| 2046 } | |
| 2047 | |
| 2048 static int build_modified_hevc(uint8_t **pout_buf, | |
| 2049 const uint8_t *cbuf, int cbuf_len, | |
| 2050 const uint8_t *abuf, int abuf_len, | |
| 2051 const uint16_t *frame_duration_tab, | |
| 2052 int frame_count) | |
| 2053 { | |
| 2054 DynBuf out_buf_s, *out_buf = &out_buf_s; | |
| 2055 uint8_t *msps; | |
| 2056 const uint8_t *nal_buf; | |
| 2057 int msps_len, cidx, aidx, is_alpha, nal_len, first_nal, start, l, frame_num; | |
| 2058 | |
| 2059 dyn_buf_init(out_buf); | |
| 2060 | |
| 2061 /* add alpha MSPS */ | |
| 2062 aidx = 0; /* avoids warning */ | |
| 2063 if (abuf) { | |
| 2064 aidx = build_modified_sps(&msps, &msps_len, abuf, abuf_len); | |
| 2065 if (aidx < 0) | |
| 2066 goto fail; | |
| 2067 if (dyn_buf_resize(out_buf, out_buf->len + msps_len) < 0) | |
| 2068 goto fail; | |
| 2069 memcpy(out_buf->buf + out_buf->len, msps, msps_len); | |
| 2070 out_buf->len += msps_len; | |
| 2071 free(msps); | |
| 2072 } | |
| 2073 | |
| 2074 /* add color MSPS */ | |
| 2075 cidx = build_modified_sps(&msps, &msps_len, cbuf, cbuf_len); | |
| 2076 if (cidx < 0) | |
| 2077 goto fail; | |
| 2078 if (dyn_buf_resize(out_buf, out_buf->len + msps_len) < 0) | |
| 2079 goto fail; | |
| 2080 memcpy(out_buf->buf + out_buf->len, msps, msps_len); | |
| 2081 out_buf->len += msps_len; | |
| 2082 free(msps); | |
| 2083 | |
| 2084 /* add the remaining NALs, alternating between alpha (if present) | |
| 2085 and color. */ | |
| 2086 is_alpha = (abuf != NULL); | |
| 2087 first_nal = 1; | |
| 2088 frame_num = 0; | |
| 2089 for(;;) { | |
| 2090 if (!is_alpha) { | |
| 2091 if (cidx >= cbuf_len) { | |
| 2092 if (abuf) { | |
| 2093 fprintf(stderr, "Incorrect number of alpha NALs\n"); | |
| 2094 goto fail; | |
| 2095 } | |
| 2096 break; | |
| 2097 } | |
| 2098 nal_buf = cbuf + cidx; | |
| 2099 nal_len = find_nal_end(nal_buf, cbuf_len - cidx); | |
| 2100 // printf("cidx=%d/%d nal_len=%d\n", cidx, cbuf_len, nal_len); | |
| 2101 if (nal_len < 0) | |
| 2102 goto fail; | |
| 2103 cidx += nal_len; | |
| 2104 } else { | |
| 2105 if (aidx >= abuf_len) | |
| 2106 break; | |
| 2107 nal_buf = abuf + aidx; | |
| 2108 nal_len = find_nal_end(nal_buf, abuf_len - aidx); | |
| 2109 // printf("aidx=%d/%d nal_len=%d\n", aidx, abuf_len, nal_len); | |
| 2110 if (nal_len < 0) | |
| 2111 goto fail; | |
| 2112 aidx += nal_len; | |
| 2113 } | |
| 2114 start = 3 + (nal_buf[2] == 0); | |
| 2115 if (!is_alpha) { | |
| 2116 int nut; | |
| 2117 /* add SEI NAL for the frame duration (animation case) */ | |
| 2118 nut = (nal_buf[start] >> 1) & 0x3f; | |
| 2119 if ((nut <= 9 || (nut >= 16 && nut <= 21)) && | |
| 2120 start + 2 < nal_len && (nal_buf[start + 2] & 0x80)) { | |
| 2121 int frame_ticks; | |
| 2122 assert(frame_num < frame_count); | |
| 2123 frame_ticks = frame_duration_tab[frame_num]; | |
| 2124 if (frame_ticks > 1) { | |
| 2125 add_frame_duration_sei(out_buf, frame_ticks); | |
| 2126 } | |
| 2127 frame_num++; | |
| 2128 } | |
| 2129 } | |
| 2130 if (first_nal) { | |
| 2131 /* skip first start code */ | |
| 2132 l = start; | |
| 2133 } else { | |
| 2134 l = 0; | |
| 2135 } | |
| 2136 if (dyn_buf_resize(out_buf, out_buf->len + nal_len - l) < 0) | |
| 2137 goto fail; | |
| 2138 // printf("add nal len=%d\n", nal_len - l); | |
| 2139 memcpy(out_buf->buf + out_buf->len, nal_buf + l, nal_len - l); | |
| 2140 if (is_alpha) { | |
| 2141 /* set nul_layer_id of alpha to '1' */ | |
| 2142 out_buf->buf[out_buf->len + (start - l) + 1] |= 1 << 3; | |
| 2143 } | |
| 2144 out_buf->len += nal_len - l; | |
| 2145 | |
| 2146 if (abuf) { | |
| 2147 is_alpha ^= 1; | |
| 2148 } | |
| 2149 first_nal = 0; | |
| 2150 } | |
| 2151 *pout_buf = out_buf->buf; | |
| 2152 return out_buf->len; | |
| 2153 fail: | |
| 2154 free(out_buf->buf); | |
| 2155 return -1; | |
| 2156 } | |
| 2157 | |
| 2158 typedef enum { | |
| 2159 #if defined(USE_X265) | |
| 2160 HEVC_ENCODER_X265, | |
| 2161 #endif | |
| 2162 #if defined(USE_JCTVC) | |
| 2163 HEVC_ENCODER_JCTVC, | |
| 2164 #endif | |
| 2165 | |
| 2166 HEVC_ENCODER_COUNT, | |
| 2167 } HEVCEncoderEnum; | |
| 2168 | |
| 2169 static char *hevc_encoder_name[HEVC_ENCODER_COUNT] = { | |
| 2170 #if defined(USE_X265) | |
| 2171 "x265", | |
| 2172 #endif | |
| 2173 #if defined(USE_JCTVC) | |
| 2174 "jctvc", | |
| 2175 #endif | |
| 2176 }; | |
| 2177 | |
| 2178 static HEVCEncoder *hevc_encoder_tab[HEVC_ENCODER_COUNT] = { | |
| 2179 #if defined(USE_X265) | |
| 2180 &x265_hevc_encoder, | |
| 2181 #endif | |
| 2182 #if defined(USE_JCTVC) | |
| 2183 &jctvc_encoder, | |
| 2184 #endif | |
| 2185 }; | |
| 2186 | |
| 2187 #define IMAGE_HEADER_MAGIC 0x425047fb | |
| 2188 | |
| 2189 #define DEFAULT_OUTFILENAME "out.bpg" | |
| 2190 #define DEFAULT_QP 29 | |
| 2191 #define DEFAULT_BIT_DEPTH 8 | |
| 2192 | |
| 2193 #ifdef RExt__HIGH_BIT_DEPTH_SUPPORT | |
| 2194 #define BIT_DEPTH_MAX 14 | |
| 2195 #else | |
| 2196 #define BIT_DEPTH_MAX 12 | |
| 2197 #endif | |
| 2198 #define DEFAULT_COMPRESS_LEVEL 8 | |
| 2199 | |
| 2200 | |
| 2201 typedef struct BPGEncoderContext BPGEncoderContext; | |
| 2202 | |
| 2203 typedef struct BPGEncoderParameters { | |
| 2204 int qp; /* 0 ... 51 */ | |
| 2205 int alpha_qp; /* -1 ... 51. -1 means same as qp */ | |
| 2206 int lossless; /* true if lossless compression (qp and alpha_qp are | |
| 2207 ignored) */ | |
| 2208 BPGImageFormatEnum preferred_chroma_format; | |
| 2209 int sei_decoded_picture_hash; /* 0, 1 */ | |
| 2210 int compress_level; /* 1 ... 9 */ | |
| 2211 int verbose; | |
| 2212 HEVCEncoderEnum encoder_type; | |
| 2213 int animated; /* 0 ... 1: if true, encode as animated image */ | |
| 2214 uint16_t loop_count; /* animations: number of loops. 0=infinite */ | |
| 2215 /* animations: the frame delay is a multiple of | |
| 2216 frame_delay_num/frame_delay_den seconds */ | |
| 2217 uint16_t frame_delay_num; | |
| 2218 uint16_t frame_delay_den; | |
| 2219 } BPGEncoderParameters; | |
| 2220 | |
| 2221 typedef int BPGEncoderWriteFunc(void *opaque, const uint8_t *buf, int buf_len); | |
| 2222 | |
| 2223 struct BPGEncoderContext { | |
| 2224 BPGEncoderParameters params; | |
| 2225 BPGMetaData *first_md; | |
| 2226 HEVCEncoder *encoder; | |
| 2227 int frame_count; | |
| 2228 HEVCEncoderContext *enc_ctx; | |
| 2229 HEVCEncoderContext *alpha_enc_ctx; | |
| 2230 int frame_ticks; | |
| 2231 uint16_t *frame_duration_tab; | |
| 2232 int frame_duration_tab_size; | |
| 2233 }; | |
| 2234 | |
| 2235 void *mallocz(size_t size) | |
| 2236 { | |
| 2237 void *ptr; | |
| 2238 ptr = malloc(size); | |
| 2239 if (!ptr) | |
| 2240 return NULL; | |
| 2241 memset(ptr, 0, size); | |
| 2242 return ptr; | |
| 2243 } | |
| 2244 | |
| 2245 BPGEncoderParameters *bpg_encoder_param_alloc(void) | |
| 2246 { | |
| 2247 BPGEncoderParameters *p; | |
| 2248 p = mallocz(sizeof(BPGEncoderParameters)); | |
| 2249 if (!p) | |
| 2250 return NULL; | |
| 2251 p->qp = DEFAULT_QP; | |
| 2252 p->alpha_qp = -1; | |
| 2253 p->preferred_chroma_format = BPG_FORMAT_420; | |
| 2254 p->compress_level = DEFAULT_COMPRESS_LEVEL; | |
| 2255 p->frame_delay_num = 1; | |
| 2256 p->frame_delay_den = 25; | |
| 2257 p->loop_count = 0; | |
| 2258 return p; | |
| 2259 } | |
| 2260 | |
| 2261 void bpg_encoder_param_free(BPGEncoderParameters *p) | |
| 2262 { | |
| 2263 free(p); | |
| 2264 } | |
| 2265 | |
| 2266 BPGEncoderContext *bpg_encoder_open(BPGEncoderParameters *p) | |
| 2267 { | |
| 2268 BPGEncoderContext *s; | |
| 2269 | |
| 2270 s = mallocz(sizeof(BPGEncoderContext)); | |
| 2271 if (!s) | |
| 2272 return NULL; | |
| 2273 s->params = *p; | |
| 2274 s->encoder = hevc_encoder_tab[s->params.encoder_type]; | |
| 2275 s->frame_ticks = 1; | |
| 2276 return s; | |
| 2277 } | |
| 2278 | |
| 2279 void bpg_encoder_set_extension_data(BPGEncoderContext *s, | |
| 2280 BPGMetaData *md) | |
| 2281 { | |
| 2282 s->first_md = md; | |
| 2283 } | |
| 2284 | |
| 2285 static int bpg_encoder_encode_trailer(BPGEncoderContext *s, | |
| 2286 BPGEncoderWriteFunc *write_func, | |
| 2287 void *opaque) | |
| 2288 { | |
| 2289 uint8_t *out_buf, *alpha_buf, *hevc_buf; | |
| 2290 int out_buf_len, alpha_buf_len, hevc_buf_len; | |
| 2291 | |
| 2292 out_buf_len = s->encoder->close(s->enc_ctx, &out_buf); | |
| 2293 if (out_buf_len < 0) { | |
| 2294 fprintf(stderr, "Error while encoding picture\n"); | |
| 2295 exit(1); | |
| 2296 } | |
| 2297 s->enc_ctx = NULL; | |
| 2298 | |
| 2299 alpha_buf = NULL; | |
| 2300 alpha_buf_len = 0; | |
| 2301 if (s->alpha_enc_ctx) { | |
| 2302 alpha_buf_len = s->encoder->close(s->alpha_enc_ctx, &alpha_buf); | |
| 2303 if (alpha_buf_len < 0) { | |
| 2304 fprintf(stderr, "Error while encoding picture (alpha plane)\n"); | |
| 2305 exit(1); | |
| 2306 } | |
| 2307 s->alpha_enc_ctx = NULL; | |
| 2308 } | |
| 2309 | |
| 2310 hevc_buf = NULL; | |
| 2311 hevc_buf_len = build_modified_hevc(&hevc_buf, out_buf, out_buf_len, | |
| 2312 alpha_buf, alpha_buf_len, | |
| 2313 s->frame_duration_tab, s->frame_count); | |
| 2314 if (hevc_buf_len < 0) { | |
| 2315 fprintf(stderr, "Error while creating HEVC data\n"); | |
| 2316 exit(1); | |
| 2317 } | |
| 2318 free(out_buf); | |
| 2319 free(alpha_buf); | |
| 2320 | |
| 2321 if (write_func(opaque, hevc_buf, hevc_buf_len) != hevc_buf_len) { | |
| 2322 fprintf(stderr, "Error while writing HEVC data\n"); | |
| 2323 exit(1); | |
| 2324 } | |
| 2325 free(hevc_buf); | |
| 2326 return 0; | |
| 2327 } | |
| 2328 | |
| 2329 int bpg_encoder_set_frame_duration(BPGEncoderContext *s, int frame_ticks) | |
| 2330 { | |
| 2331 if (frame_ticks >= 1 && frame_ticks <= 65535) { | |
| 2332 s->frame_ticks = frame_ticks; | |
| 2333 return 0; | |
| 2334 } else { | |
| 2335 return -1; | |
| 2336 } | |
| 2337 } | |
| 2338 | |
| 2339 /* Warning: currently 'img' is modified. When encoding animations, img | |
| 2340 = NULL indicates the end of the stream. */ | |
| 2341 int bpg_encoder_encode(BPGEncoderContext *s, Image *img, | |
| 2342 BPGEncoderWriteFunc *write_func, | |
| 2343 void *opaque) | |
| 2344 { | |
| 2345 const BPGEncoderParameters *p = &s->params; | |
| 2346 Image *img_alpha; | |
| 2347 HEVCEncodeParams ep_s, *ep = &ep_s; | |
| 2348 uint8_t *extension_buf; | |
| 2349 int extension_buf_len; | |
| 2350 int cb_size, width, height; | |
| 2351 | |
| 2352 if (p->animated && !img) { | |
| 2353 return bpg_encoder_encode_trailer(s, write_func, opaque); | |
| 2354 } | |
| 2355 | |
| 2356 /* extract the alpha plane */ | |
| 2357 if (img->has_alpha) { | |
| 2358 int c_idx; | |
| 2359 | |
| 2360 img_alpha = malloc(sizeof(Image)); | |
| 2361 memset(img_alpha, 0, sizeof(*img_alpha)); | |
| 2362 if (img->format == BPG_FORMAT_GRAY) | |
| 2363 c_idx = 1; | |
| 2364 else | |
| 2365 c_idx = 3; | |
| 2366 | |
| 2367 img_alpha->w = img->w; | |
| 2368 img_alpha->h = img->h; | |
| 2369 img_alpha->format = BPG_FORMAT_GRAY; | |
| 2370 img_alpha->has_alpha = 0; | |
| 2371 img_alpha->color_space = BPG_CS_YCbCr; | |
| 2372 img_alpha->bit_depth = img->bit_depth; | |
| 2373 img_alpha->pixel_shift = img->pixel_shift; | |
| 2374 img_alpha->data[0] = img->data[c_idx]; | |
| 2375 img_alpha->linesize[0] = img->linesize[c_idx]; | |
| 2376 | |
| 2377 img->data[c_idx] = NULL; | |
| 2378 img->has_alpha = 0; | |
| 2379 } else { | |
| 2380 img_alpha = NULL; | |
| 2381 } | |
| 2382 | |
| 2383 if (img->format == BPG_FORMAT_444 && img->color_space != BPG_CS_RGB) { | |
| 2384 if (p->preferred_chroma_format == BPG_FORMAT_420 || | |
| 2385 p->preferred_chroma_format == BPG_FORMAT_420_VIDEO) { | |
| 2386 int c_h_phase = (p->preferred_chroma_format == BPG_FORMAT_420); | |
| 2387 if (image_ycc444_to_ycc420(img, c_h_phase) != 0) | |
| 2388 goto error_convert; | |
| 2389 } else if (p->preferred_chroma_format == BPG_FORMAT_422 || | |
| 2390 p->preferred_chroma_format == BPG_FORMAT_422_VIDEO) { | |
| 2391 int c_h_phase = (p->preferred_chroma_format == BPG_FORMAT_422); | |
| 2392 if (image_ycc444_to_ycc422(img, c_h_phase) != 0) { | |
| 2393 error_convert: | |
| 2394 fprintf(stderr, "Cannot convert image\n"); | |
| 2395 exit(1); | |
| 2396 } | |
| 2397 } | |
| 2398 } | |
| 2399 | |
| 2400 cb_size = 8; /* XXX: should make it configurable. We assume the | |
| 2401 HEVC encoder uses the same value */ | |
| 2402 width = img->w; | |
| 2403 height = img->h; | |
| 2404 image_pad(img, cb_size); | |
| 2405 if (img_alpha) | |
| 2406 image_pad(img_alpha, cb_size); | |
| 2407 | |
| 2408 /* convert to the allocated pixel width to 8 bit if needed by the | |
| 2409 HEVC encoder */ | |
| 2410 if (img->bit_depth == 8) { | |
| 2411 image_convert16to8(img); | |
| 2412 if (img_alpha) | |
| 2413 image_convert16to8(img_alpha); | |
| 2414 } | |
| 2415 | |
| 2416 if (s->frame_count == 0) { | |
| 2417 memset(ep, 0, sizeof(*ep)); | |
| 2418 ep->qp = p->qp; | |
| 2419 ep->width = img->w; | |
| 2420 ep->height = img->h; | |
| 2421 ep->chroma_format = img->format; | |
| 2422 ep->bit_depth = img->bit_depth; | |
| 2423 ep->intra_only = !p->animated; | |
| 2424 ep->lossless = p->lossless; | |
| 2425 ep->sei_decoded_picture_hash = p->sei_decoded_picture_hash; | |
| 2426 ep->compress_level = p->compress_level; | |
| 2427 ep->verbose = p->verbose; | |
| 2428 | |
| 2429 s->enc_ctx = s->encoder->open(ep); | |
| 2430 if (!s->enc_ctx) { | |
| 2431 fprintf(stderr, "Error while opening encoder\n"); | |
| 2432 exit(1); | |
| 2433 } | |
| 2434 | |
| 2435 if (img_alpha) { | |
| 2436 if (p->alpha_qp < 0) | |
| 2437 ep->qp = p->qp; | |
| 2438 else | |
| 2439 ep->qp = p->alpha_qp; | |
| 2440 ep->chroma_format = 0; | |
| 2441 | |
| 2442 s->alpha_enc_ctx = s->encoder->open(ep); | |
| 2443 if (!s->alpha_enc_ctx) { | |
| 2444 fprintf(stderr, "Error while opening alpha encoder\n"); | |
| 2445 exit(1); | |
| 2446 } | |
| 2447 } | |
| 2448 | |
| 2449 /* prepare the extension data */ | |
| 2450 if (p->animated) { | |
| 2451 BPGMetaData *md; | |
| 2452 uint8_t buf[15], *q; | |
| 2453 | |
| 2454 md = bpg_md_alloc(BPG_EXTENSION_TAG_ANIM_CONTROL); | |
| 2455 q = buf; | |
| 2456 put_ue(&q, p->loop_count); | |
| 2457 put_ue(&q, p->frame_delay_num); | |
| 2458 put_ue(&q, p->frame_delay_den); | |
| 2459 md->buf_len = q - buf; | |
| 2460 md->buf = malloc(md->buf_len); | |
| 2461 memcpy(md->buf, buf, md->buf_len); | |
| 2462 md->next = s->first_md; | |
| 2463 s->first_md = md; | |
| 2464 } | |
| 2465 | |
| 2466 extension_buf = NULL; | |
| 2467 extension_buf_len = 0; | |
| 2468 if (s->first_md) { | |
| 2469 BPGMetaData *md1; | |
| 2470 int max_len; | |
| 2471 uint8_t *q; | |
| 2472 | |
| 2473 max_len = 0; | |
| 2474 for(md1 = s->first_md; md1 != NULL; md1 = md1->next) { | |
| 2475 max_len += md1->buf_len + 5 * 2; | |
| 2476 } | |
| 2477 extension_buf = malloc(max_len); | |
| 2478 q = extension_buf; | |
| 2479 for(md1 = s->first_md; md1 != NULL; md1 = md1->next) { | |
| 2480 put_ue(&q, md1->tag); | |
| 2481 put_ue(&q, md1->buf_len); | |
| 2482 memcpy(q, md1->buf, md1->buf_len); | |
| 2483 q += md1->buf_len; | |
| 2484 } | |
| 2485 extension_buf_len = q - extension_buf; | |
| 2486 | |
| 2487 bpg_md_free(s->first_md); | |
| 2488 s->first_md = NULL; | |
| 2489 } | |
| 2490 | |
| 2491 { | |
| 2492 uint8_t img_header[128], *q; | |
| 2493 int v, has_alpha, has_extension, alpha2_flag, alpha1_flag, format; | |
| 2494 | |
| 2495 has_alpha = (img_alpha != NULL); | |
| 2496 has_extension = (extension_buf_len > 0); | |
| 2497 | |
| 2498 | |
| 2499 if (has_alpha) { | |
| 2500 if (img->has_w_plane) { | |
| 2501 alpha1_flag = 0; | |
| 2502 alpha2_flag = 1; | |
| 2503 } else { | |
| 2504 alpha1_flag = 1; | |
| 2505 alpha2_flag = img->premultiplied_alpha; | |
| 2506 } | |
| 2507 } else { | |
| 2508 alpha1_flag = 0; | |
| 2509 alpha2_flag = 0; | |
| 2510 } | |
| 2511 | |
| 2512 q = img_header; | |
| 2513 *q++ = (IMAGE_HEADER_MAGIC >> 24) & 0xff; | |
| 2514 *q++ = (IMAGE_HEADER_MAGIC >> 16) & 0xff; | |
| 2515 *q++ = (IMAGE_HEADER_MAGIC >> 8) & 0xff; | |
| 2516 *q++ = (IMAGE_HEADER_MAGIC >> 0) & 0xff; | |
| 2517 | |
| 2518 if (img->c_h_phase == 0 && img->format == BPG_FORMAT_420) | |
| 2519 format = BPG_FORMAT_420_VIDEO; | |
| 2520 else if (img->c_h_phase == 0 && img->format == BPG_FORMAT_422) | |
| 2521 format = BPG_FORMAT_422_VIDEO; | |
| 2522 else | |
| 2523 format = img->format; | |
| 2524 v = (format << 5) | (alpha1_flag << 4) | (img->bit_depth - 8); | |
| 2525 *q++ = v; | |
| 2526 v = (img->color_space << 4) | (has_extension << 3) | | |
| 2527 (alpha2_flag << 2) | (img->limited_range << 1) | | |
| 2528 p->animated; | |
| 2529 *q++ = v; | |
| 2530 put_ue(&q, width); | |
| 2531 put_ue(&q, height); | |
| 2532 | |
| 2533 put_ue(&q, 0); /* zero length means up to the end of the file */ | |
| 2534 if (has_extension) { | |
| 2535 put_ue(&q, extension_buf_len); /* extension data length */ | |
| 2536 } | |
| 2537 | |
| 2538 write_func(opaque, img_header, q - img_header); | |
| 2539 | |
| 2540 if (has_extension) { | |
| 2541 if (write_func(opaque, extension_buf, extension_buf_len) != extension_buf_len) { | |
| 2542 fprintf(stderr, "Error while writing extension data\n"); | |
| 2543 exit(1); | |
| 2544 } | |
| 2545 free(extension_buf); | |
| 2546 } | |
| 2547 } | |
| 2548 } | |
| 2549 | |
| 2550 /* store the frame duration */ | |
| 2551 if ((s->frame_count + 1) > s->frame_duration_tab_size) { | |
| 2552 s->frame_duration_tab_size = (s->frame_duration_tab_size * 3) / 2; | |
| 2553 if (s->frame_duration_tab_size < (s->frame_count + 1)) | |
| 2554 s->frame_duration_tab_size = (s->frame_count + 1); | |
| 2555 s->frame_duration_tab = realloc(s->frame_duration_tab, | |
| 2556 sizeof(s->frame_duration_tab) * s->frame_duration_tab_size); | |
| 2557 } | |
| 2558 s->frame_duration_tab[s->frame_count] = s->frame_ticks; | |
| 2559 | |
| 2560 s->encoder->encode(s->enc_ctx, img); | |
| 2561 | |
| 2562 if (img_alpha) { | |
| 2563 s->encoder->encode(s->alpha_enc_ctx, img_alpha); | |
| 2564 image_free(img_alpha); | |
| 2565 } | |
| 2566 | |
| 2567 s->frame_count++; | |
| 2568 | |
| 2569 if (!p->animated) | |
| 2570 bpg_encoder_encode_trailer(s, write_func, opaque); | |
| 2571 | |
| 2572 return 0; | |
| 2573 } | |
| 2574 | |
| 2575 void bpg_encoder_close(BPGEncoderContext *s) | |
| 2576 { | |
| 2577 free(s->frame_duration_tab); | |
| 2578 bpg_md_free(s->first_md); | |
| 2579 free(s); | |
| 2580 } | |
| 2581 | |
| 2582 static int my_write_func(void *opaque, const uint8_t *buf, int buf_len) | |
| 2583 { | |
| 2584 FILE *f = opaque; | |
| 2585 return fwrite(buf, 1, buf_len, f); | |
| 2586 } | |
| 2587 | |
| 2588 static int get_filename_num(char *buf, int buf_size, const char *str, int n) | |
| 2589 { | |
| 2590 const char *p, *r; | |
| 2591 char *q; | |
| 2592 int l, c; | |
| 2593 | |
| 2594 q = buf; | |
| 2595 p = str; | |
| 2596 for(;;) { | |
| 2597 c = *p++; | |
| 2598 if (c == '\0') | |
| 2599 break; | |
| 2600 if (c == '%') { | |
| 2601 r = p - 1; | |
| 2602 l = 0; | |
| 2603 for(;;) { | |
| 2604 c = *p; | |
| 2605 if (c < '0' || c > '9') | |
| 2606 break; | |
| 2607 l = l * 10 + (c - '0'); | |
| 2608 p++; | |
| 2609 } | |
| 2610 c = *p++; | |
| 2611 if (c == '%') { | |
| 2612 goto add_char; | |
| 2613 } else if (c != 'd') { | |
| 2614 return -1; | |
| 2615 } | |
| 2616 snprintf(q, buf + buf_size - q, "%0*u", l, n); | |
| 2617 q += strlen(q); | |
| 2618 | |
| 2619 } else { | |
| 2620 add_char: | |
| 2621 if ((q - buf) < buf_size - 1) | |
| 2622 *q++ = c; | |
| 2623 } | |
| 2624 } | |
| 2625 *q = '\0'; | |
| 2626 return 0; | |
| 2627 } | |
| 2628 | |
| 2629 void help(int is_full) | |
| 2630 { | |
| 2631 char hevc_encoders[128]; | |
| 2632 int i; | |
| 2633 | |
| 2634 hevc_encoders[0] = '\0'; | |
| 2635 for(i = 0; i < HEVC_ENCODER_COUNT; i++) { | |
| 2636 if (i != 0) | |
| 2637 strcat(hevc_encoders, " "); | |
| 2638 strcat(hevc_encoders, hevc_encoder_name[i]); | |
| 2639 } | |
| 2640 | |
| 2641 printf("BPG Image Encoder version " CONFIG_BPG_VERSION "\n" | |
| 2642 "usage: bpgenc [options] infile.[jpg|png]\n" | |
| 2643 "\n" | |
| 2644 "Main options:\n" | |
| 2645 "-h show the full help (including the advanced options)\n" | |
| 2646 "-o outfile set output filename (default = %s)\n" | |
| 2647 "-q qp set quantizer parameter (smaller gives better quality,\n" | |
| 2648 " range: 0-51, default = %d)\n" | |
| 2649 "-f cfmt set the preferred chroma format (420, 422, 444,\n" | |
| 2650 " default=420)\n" | |
| 2651 "-c color_space set the preferred color space (ycbcr, rgb, ycgco,\n" | |
| 2652 " ycbcr_bt709, ycbcr_bt2020, default=ycbcr)\n" | |
| 2653 "-b bit_depth set the bit depth (8 to %d, default = %d)\n" | |
| 2654 "-lossless enable lossless mode\n" | |
| 2655 "-e encoder select the HEVC encoder (%s, default = %s)\n" | |
| 2656 "-m level select the compression level (1=fast, 9=slow, default = %d)\n" | |
| 2657 "\n" | |
| 2658 "Animation options:\n" | |
| 2659 "-a generate animations from a sequence of images. Use %%d or\n" | |
| 2660 " %%Nd (N = number of digits) in the filename to specify the\n" | |
| 2661 " image index, starting from 0 or 1.\n" | |
| 2662 "-fps N set the frame rate (default = 25)\n" | |
| 2663 "-loop N set the number of times the animation is played. 0 means\n" | |
| 2664 " infinite (default = 0)\n" | |
| 2665 "-delayfile file text file containing one number per image giving the\n" | |
| 2666 " display delay per image in centiseconds.\n" | |
| 2667 , DEFAULT_OUTFILENAME, DEFAULT_QP, BIT_DEPTH_MAX, DEFAULT_BIT_DEPTH, | |
| 2668 hevc_encoders, hevc_encoder_name[0], DEFAULT_COMPRESS_LEVEL); | |
| 2669 | |
| 2670 if (is_full) { | |
| 2671 printf("\nAdvanced options:\n" | |
| 2672 "-alphaq set quantizer parameter for the alpha channel (default = same as -q value)\n" | |
| 2673 "-premul store the color with premultiplied alpha\n" | |
| 2674 "-limitedrange encode the color data with the limited range of video\n" | |
| 2675 "-hash include MD5 hash in HEVC bitstream\n" | |
| 2676 "-keepmetadata keep the metadata (from JPEG: EXIF, ICC profile, XMP, from PNG: ICC profile)\n" | |
| 2677 "-v show debug messages\n" | |
| 2678 ); | |
| 2679 } | |
| 2680 | |
| 2681 exit(1); | |
| 2682 } | |
| 2683 | |
| 2684 struct option long_opts[] = { | |
| 2685 { "hash", no_argument }, | |
| 2686 { "keepmetadata", no_argument }, | |
| 2687 { "alphaq", required_argument }, | |
| 2688 { "lossless", no_argument }, | |
| 2689 { "limitedrange", no_argument }, | |
| 2690 { "premul", no_argument }, | |
| 2691 { "loop", required_argument }, | |
| 2692 { "fps", required_argument }, | |
| 2693 { "delayfile", required_argument }, | |
| 2694 { NULL }, | |
| 2695 }; | |
| 2696 | |
| 2697 int main(int argc, char **argv) | |
| 2698 { | |
| 2699 const char *infilename, *outfilename, *frame_delay_file; | |
| 2700 Image *img; | |
| 2701 FILE *f; | |
| 2702 int c, option_index; | |
| 2703 int keep_metadata; | |
| 2704 int bit_depth, i, limited_range, premultiplied_alpha; | |
| 2705 BPGColorSpaceEnum color_space; | |
| 2706 BPGMetaData *md; | |
| 2707 BPGEncoderContext *enc_ctx; | |
| 2708 BPGEncoderParameters *p; | |
| 2709 | |
| 2710 p = bpg_encoder_param_alloc(); | |
| 2711 | |
| 2712 outfilename = DEFAULT_OUTFILENAME; | |
| 2713 color_space = BPG_CS_YCbCr; | |
| 2714 keep_metadata = 0; | |
| 2715 bit_depth = DEFAULT_BIT_DEPTH; | |
| 2716 limited_range = 0; | |
| 2717 premultiplied_alpha = 0; | |
| 2718 frame_delay_file = NULL; | |
| 2719 | |
| 2720 for(;;) { | |
| 2721 c = getopt_long_only(argc, argv, "q:o:hf:c:vm:b:e:a", long_opts, &option_index); | |
| 2722 if (c == -1) | |
| 2723 break; | |
| 2724 switch(c) { | |
| 2725 case 0: | |
| 2726 switch(option_index) { | |
| 2727 case 0: | |
| 2728 p->sei_decoded_picture_hash = 1; | |
| 2729 break; | |
| 2730 case 1: | |
| 2731 keep_metadata = 1; | |
| 2732 break; | |
| 2733 case 2: | |
| 2734 p->alpha_qp = atoi(optarg); | |
| 2735 if (p->alpha_qp < 0 || p->alpha_qp > 51) { | |
| 2736 fprintf(stderr, "alpha_qp must be between 0 and 51\n"); | |
| 2737 exit(1); | |
| 2738 } | |
| 2739 break; | |
| 2740 case 3: | |
| 2741 p->lossless = 1; | |
| 2742 color_space = BPG_CS_RGB; | |
| 2743 p->preferred_chroma_format = BPG_FORMAT_444; | |
| 2744 bit_depth = 8; | |
| 2745 limited_range = 0; | |
| 2746 break; | |
| 2747 case 4: | |
| 2748 limited_range = 1; | |
| 2749 break; | |
| 2750 case 5: | |
| 2751 premultiplied_alpha = 1; | |
| 2752 break; | |
| 2753 case 6: | |
| 2754 p->loop_count = strtoul(optarg, NULL, 0); | |
| 2755 break; | |
| 2756 case 7: | |
| 2757 p->frame_delay_num = 1; | |
| 2758 p->frame_delay_den = strtoul(optarg, NULL, 0); | |
| 2759 if (p->frame_delay_den == 0) { | |
| 2760 fprintf(stderr, "invalid frame rate\n"); | |
| 2761 exit(1); | |
| 2762 } | |
| 2763 break; | |
| 2764 case 8: | |
| 2765 frame_delay_file = optarg; | |
| 2766 break; | |
| 2767 default: | |
| 2768 goto show_help; | |
| 2769 } | |
| 2770 break; | |
| 2771 case 'h': | |
| 2772 show_help: | |
| 2773 help(1); | |
| 2774 break; | |
| 2775 case 'q': | |
| 2776 p->qp = atoi(optarg); | |
| 2777 if (p->qp < 0 || p->qp > 51) { | |
| 2778 fprintf(stderr, "qp must be between 0 and 51\n"); | |
| 2779 exit(1); | |
| 2780 } | |
| 2781 break; | |
| 2782 case 'o': | |
| 2783 outfilename = optarg; | |
| 2784 break; | |
| 2785 case 'f': | |
| 2786 if (!strcmp(optarg, "420")) { | |
| 2787 p->preferred_chroma_format = BPG_FORMAT_420; | |
| 2788 } else if (!strcmp(optarg, "422")) { | |
| 2789 p->preferred_chroma_format = BPG_FORMAT_422; | |
| 2790 } else if (!strcmp(optarg, "444")) { | |
| 2791 p->preferred_chroma_format = BPG_FORMAT_444; | |
| 2792 } else if (!strcmp(optarg, "422_video")) { | |
| 2793 p->preferred_chroma_format = BPG_FORMAT_422_VIDEO; | |
| 2794 } else if (!strcmp(optarg, "420_video")) { | |
| 2795 p->preferred_chroma_format = BPG_FORMAT_420_VIDEO; | |
| 2796 } else { | |
| 2797 fprintf(stderr, "Invalid chroma format\n"); | |
| 2798 exit(1); | |
| 2799 } | |
| 2800 break; | |
| 2801 case 'c': | |
| 2802 if (!strcmp(optarg, "ycbcr")) { | |
| 2803 color_space = BPG_CS_YCbCr; | |
| 2804 } else if (!strcmp(optarg, "rgb")) { | |
| 2805 color_space = BPG_CS_RGB; | |
| 2806 p->preferred_chroma_format = BPG_FORMAT_444; | |
| 2807 } else if (!strcmp(optarg, "ycgco")) { | |
| 2808 color_space = BPG_CS_YCgCo; | |
| 2809 } else if (!strcmp(optarg, "ycbcr_bt709")) { | |
| 2810 color_space = BPG_CS_YCbCr_BT709; | |
| 2811 } else if (!strcmp(optarg, "ycbcr_bt2020")) { | |
| 2812 color_space = BPG_CS_YCbCr_BT2020; | |
| 2813 } else { | |
| 2814 fprintf(stderr, "Invalid color space format\n"); | |
| 2815 exit(1); | |
| 2816 } | |
| 2817 break; | |
| 2818 case 'm': | |
| 2819 p->compress_level = atoi(optarg); | |
| 2820 if (p->compress_level < 1) | |
| 2821 p->compress_level = 1; | |
| 2822 else if (p->compress_level > 9) | |
| 2823 p->compress_level = 9; | |
| 2824 break; | |
| 2825 case 'b': | |
| 2826 bit_depth = atoi(optarg); | |
| 2827 if (bit_depth < 8 || bit_depth > BIT_DEPTH_MAX) { | |
| 2828 fprintf(stderr, "Invalid bit depth (range: 8 to %d)\n", | |
| 2829 BIT_DEPTH_MAX); | |
| 2830 exit(1); | |
| 2831 } | |
| 2832 break; | |
| 2833 case 'v': | |
| 2834 p->verbose++; | |
| 2835 break; | |
| 2836 case 'e': | |
| 2837 for(i = 0; i < HEVC_ENCODER_COUNT; i++) { | |
| 2838 if (!strcmp(optarg, hevc_encoder_name[i])) | |
| 2839 break; | |
| 2840 } | |
| 2841 if (i == HEVC_ENCODER_COUNT) { | |
| 2842 fprintf(stderr, "Unsupported encoder. Available ones are:"); | |
| 2843 for(i = 0; i < HEVC_ENCODER_COUNT; i++) { | |
| 2844 fprintf(stderr, " %s", hevc_encoder_name[i]); | |
| 2845 } | |
| 2846 fprintf(stderr, "\n"); | |
| 2847 exit(1); | |
| 2848 } | |
| 2849 p->encoder_type = i; | |
| 2850 break; | |
| 2851 case 'a': | |
| 2852 p->animated = 1; | |
| 2853 break; | |
| 2854 default: | |
| 2855 exit(1); | |
| 2856 } | |
| 2857 } | |
| 2858 | |
| 2859 if (optind >= argc) | |
| 2860 help(0); | |
| 2861 infilename = argv[optind]; | |
| 2862 | |
| 2863 f = fopen(outfilename, "wb"); | |
| 2864 if (!f) { | |
| 2865 perror(outfilename); | |
| 2866 exit(1); | |
| 2867 } | |
| 2868 | |
| 2869 enc_ctx = bpg_encoder_open(p); | |
| 2870 if (!enc_ctx) { | |
| 2871 fprintf(stderr, "Could not open BPG encoder\n"); | |
| 2872 exit(1); | |
| 2873 } | |
| 2874 | |
| 2875 if (p->animated) { | |
| 2876 int frame_num, first_frame, frame_ticks; | |
| 2877 char filename[1024]; | |
| 2878 FILE *f1; | |
| 2879 | |
| 2880 if (frame_delay_file) { | |
| 2881 f1 = fopen(frame_delay_file, "r"); | |
| 2882 if (!f1) { | |
| 2883 fprintf(stderr, "Could not open '%s'\n", frame_delay_file); | |
| 2884 exit(1); | |
| 2885 } | |
| 2886 } else { | |
| 2887 f1 = NULL; | |
| 2888 } | |
| 2889 | |
| 2890 first_frame = 1; | |
| 2891 for(frame_num = 0; ; frame_num++) { | |
| 2892 if (get_filename_num(filename, sizeof(filename), infilename, frame_num) < 0) { | |
| 2893 fprintf(stderr, "Invalid filename syntax: '%s'\n", infilename); | |
| 2894 exit(1); | |
| 2895 } | |
| 2896 img = load_image(&md, filename, color_space, bit_depth, limited_range, | |
| 2897 premultiplied_alpha); | |
| 2898 if (!img) { | |
| 2899 if (frame_num == 0) | |
| 2900 continue; /* accept to start at 0 or 1 */ | |
| 2901 if (first_frame) { | |
| 2902 fprintf(stderr, "Could not read '%s'\n", filename); | |
| 2903 exit(1); | |
| 2904 } else { | |
| 2905 break; | |
| 2906 } | |
| 2907 } | |
| 2908 frame_ticks = 1; | |
| 2909 if (f1) { | |
| 2910 float fdelay; | |
| 2911 if (fscanf(f1, "%f", &fdelay) == 1) { | |
| 2912 frame_ticks = lrint(fdelay * p->frame_delay_den / (p->frame_delay_num * 100)); | |
| 2913 if (frame_ticks < 1) | |
| 2914 frame_ticks = 1; | |
| 2915 } | |
| 2916 } | |
| 2917 | |
| 2918 if (p->verbose) | |
| 2919 printf("Encoding '%s' ticks=%d\n", filename, frame_ticks); | |
| 2920 | |
| 2921 if (keep_metadata && first_frame) { | |
| 2922 bpg_encoder_set_extension_data(enc_ctx, md); | |
| 2923 } else { | |
| 2924 bpg_md_free(md); | |
| 2925 } | |
| 2926 bpg_encoder_set_frame_duration(enc_ctx, frame_ticks); | |
| 2927 bpg_encoder_encode(enc_ctx, img, my_write_func, f); | |
| 2928 image_free(img); | |
| 2929 | |
| 2930 first_frame = 0; | |
| 2931 } | |
| 2932 if (f1) | |
| 2933 fclose(f1); | |
| 2934 /* end of stream */ | |
| 2935 bpg_encoder_encode(enc_ctx, NULL, my_write_func, f); | |
| 2936 } else { | |
| 2937 img = load_image(&md, infilename, color_space, bit_depth, limited_range, | |
| 2938 premultiplied_alpha); | |
| 2939 if (!img) { | |
| 2940 fprintf(stderr, "Could not read '%s'\n", infilename); | |
| 2941 exit(1); | |
| 2942 } | |
| 2943 | |
| 2944 if (!keep_metadata && md) { | |
| 2945 bpg_md_free(md); | |
| 2946 md = NULL; | |
| 2947 } | |
| 2948 | |
| 2949 bpg_encoder_set_extension_data(enc_ctx, md); | |
| 2950 | |
| 2951 bpg_encoder_encode(enc_ctx, img, my_write_func, f); | |
| 2952 image_free(img); | |
| 2953 } | |
| 2954 | |
| 2955 fclose(f); | |
| 2956 | |
| 2957 bpg_encoder_close(enc_ctx); | |
| 2958 | |
| 2959 bpg_encoder_param_free(p); | |
| 2960 | |
| 2961 return 0; | |
| 2962 } |