123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721 |
- #define JPEG_INTERNALS
- #include "jinclude.h"
- #include "jpeglib.h"
- #include "jdct.h"
- #include "jsimddct.h"
- typedef void (*forward_DCT_method_ptr) (DCTELEM *data);
- typedef void (*float_DCT_method_ptr) (FAST_FLOAT *data);
- typedef void (*convsamp_method_ptr) (JSAMPARRAY sample_data,
- JDIMENSION start_col,
- DCTELEM *workspace);
- typedef void (*float_convsamp_method_ptr) (JSAMPARRAY sample_data,
- JDIMENSION start_col,
- FAST_FLOAT *workspace);
- typedef void (*quantize_method_ptr) (JCOEFPTR coef_block, DCTELEM *divisors,
- DCTELEM *workspace);
- typedef void (*float_quantize_method_ptr) (JCOEFPTR coef_block,
- FAST_FLOAT *divisors,
- FAST_FLOAT *workspace);
- METHODDEF(void) quantize(JCOEFPTR, DCTELEM *, DCTELEM *);
- typedef struct {
- struct jpeg_forward_dct pub;
-
- forward_DCT_method_ptr dct;
- convsamp_method_ptr convsamp;
- quantize_method_ptr quantize;
-
- DCTELEM *divisors[NUM_QUANT_TBLS];
-
- DCTELEM *workspace;
- #ifdef DCT_FLOAT_SUPPORTED
-
- float_DCT_method_ptr float_dct;
- float_convsamp_method_ptr float_convsamp;
- float_quantize_method_ptr float_quantize;
- FAST_FLOAT *float_divisors[NUM_QUANT_TBLS];
- FAST_FLOAT *float_workspace;
- #endif
- } my_fdct_controller;
- typedef my_fdct_controller *my_fdct_ptr;
- #if BITS_IN_JSAMPLE == 8
- LOCAL(int)
- flss(UINT16 val)
- {
- int bit;
- bit = 16;
- if (!val)
- return 0;
- if (!(val & 0xff00)) {
- bit -= 8;
- val <<= 8;
- }
- if (!(val & 0xf000)) {
- bit -= 4;
- val <<= 4;
- }
- if (!(val & 0xc000)) {
- bit -= 2;
- val <<= 2;
- }
- if (!(val & 0x8000)) {
- bit -= 1;
- val <<= 1;
- }
- return bit;
- }
- LOCAL(int)
- compute_reciprocal(UINT16 divisor, DCTELEM *dtbl)
- {
- UDCTELEM2 fq, fr;
- UDCTELEM c;
- int b, r;
- if (divisor == 1) {
-
- dtbl[DCTSIZE2 * 0] = (DCTELEM)1;
- dtbl[DCTSIZE2 * 1] = (DCTELEM)0;
- dtbl[DCTSIZE2 * 2] = (DCTELEM)1;
- dtbl[DCTSIZE2 * 3] = -(DCTELEM)(sizeof(DCTELEM) * 8);
- return 0;
- }
- b = flss(divisor) - 1;
- r = sizeof(DCTELEM) * 8 + b;
- fq = ((UDCTELEM2)1 << r) / divisor;
- fr = ((UDCTELEM2)1 << r) % divisor;
- c = divisor / 2;
- if (fr == 0) {
-
- fq >>= 1;
- r--;
- } else if (fr <= (divisor / 2U)) {
- c++;
- } else {
- fq++;
- }
- dtbl[DCTSIZE2 * 0] = (DCTELEM)fq;
- dtbl[DCTSIZE2 * 1] = (DCTELEM)c;
- #ifdef WITH_SIMD
- dtbl[DCTSIZE2 * 2] = (DCTELEM)(1 << (sizeof(DCTELEM) * 8 * 2 - r));
- #else
- dtbl[DCTSIZE2 * 2] = 1;
- #endif
- dtbl[DCTSIZE2 * 3] = (DCTELEM)r - sizeof(DCTELEM) * 8;
- if (r <= 16) return 0;
- else return 1;
- }
- #endif
- METHODDEF(void)
- start_pass_fdctmgr(j_compress_ptr cinfo)
- {
- my_fdct_ptr fdct = (my_fdct_ptr)cinfo->fdct;
- int ci, qtblno, i;
- jpeg_component_info *compptr;
- JQUANT_TBL *qtbl;
- DCTELEM *dtbl;
- for (ci = 0, compptr = cinfo->comp_info; ci < cinfo->num_components;
- ci++, compptr++) {
- qtblno = compptr->quant_tbl_no;
-
- if (qtblno < 0 || qtblno >= NUM_QUANT_TBLS ||
- cinfo->quant_tbl_ptrs[qtblno] == NULL)
- ERREXIT1(cinfo, JERR_NO_QUANT_TABLE, qtblno);
- qtbl = cinfo->quant_tbl_ptrs[qtblno];
-
-
- switch (cinfo->dct_method) {
- #ifdef DCT_ISLOW_SUPPORTED
- case JDCT_ISLOW:
-
- if (fdct->divisors[qtblno] == NULL) {
- fdct->divisors[qtblno] = (DCTELEM *)
- (*cinfo->mem->alloc_small) ((j_common_ptr)cinfo, JPOOL_IMAGE,
- (DCTSIZE2 * 4) * sizeof(DCTELEM));
- }
- dtbl = fdct->divisors[qtblno];
- for (i = 0; i < DCTSIZE2; i++) {
- #if BITS_IN_JSAMPLE == 8
- if (!compute_reciprocal(qtbl->quantval[i] << 3, &dtbl[i]) &&
- fdct->quantize == jsimd_quantize)
- fdct->quantize = quantize;
- #else
- dtbl[i] = ((DCTELEM)qtbl->quantval[i]) << 3;
- #endif
- }
- break;
- #endif
- #ifdef DCT_IFAST_SUPPORTED
- case JDCT_IFAST:
- {
-
- #define CONST_BITS 14
- static const INT16 aanscales[DCTSIZE2] = {
-
- 16384, 22725, 21407, 19266, 16384, 12873, 8867, 4520,
- 22725, 31521, 29692, 26722, 22725, 17855, 12299, 6270,
- 21407, 29692, 27969, 25172, 21407, 16819, 11585, 5906,
- 19266, 26722, 25172, 22654, 19266, 15137, 10426, 5315,
- 16384, 22725, 21407, 19266, 16384, 12873, 8867, 4520,
- 12873, 17855, 16819, 15137, 12873, 10114, 6967, 3552,
- 8867, 12299, 11585, 10426, 8867, 6967, 4799, 2446,
- 4520, 6270, 5906, 5315, 4520, 3552, 2446, 1247
- };
- SHIFT_TEMPS
- if (fdct->divisors[qtblno] == NULL) {
- fdct->divisors[qtblno] = (DCTELEM *)
- (*cinfo->mem->alloc_small) ((j_common_ptr)cinfo, JPOOL_IMAGE,
- (DCTSIZE2 * 4) * sizeof(DCTELEM));
- }
- dtbl = fdct->divisors[qtblno];
- for (i = 0; i < DCTSIZE2; i++) {
- #if BITS_IN_JSAMPLE == 8
- if (!compute_reciprocal(
- DESCALE(MULTIPLY16V16((JLONG)qtbl->quantval[i],
- (JLONG)aanscales[i]),
- CONST_BITS - 3), &dtbl[i]) &&
- fdct->quantize == jsimd_quantize)
- fdct->quantize = quantize;
- #else
- dtbl[i] = (DCTELEM)
- DESCALE(MULTIPLY16V16((JLONG)qtbl->quantval[i],
- (JLONG)aanscales[i]),
- CONST_BITS - 3);
- #endif
- }
- }
- break;
- #endif
- #ifdef DCT_FLOAT_SUPPORTED
- case JDCT_FLOAT:
- {
-
- FAST_FLOAT *fdtbl;
- int row, col;
- static const double aanscalefactor[DCTSIZE] = {
- 1.0, 1.387039845, 1.306562965, 1.175875602,
- 1.0, 0.785694958, 0.541196100, 0.275899379
- };
- if (fdct->float_divisors[qtblno] == NULL) {
- fdct->float_divisors[qtblno] = (FAST_FLOAT *)
- (*cinfo->mem->alloc_small) ((j_common_ptr)cinfo, JPOOL_IMAGE,
- DCTSIZE2 * sizeof(FAST_FLOAT));
- }
- fdtbl = fdct->float_divisors[qtblno];
- i = 0;
- for (row = 0; row < DCTSIZE; row++) {
- for (col = 0; col < DCTSIZE; col++) {
- fdtbl[i] = (FAST_FLOAT)
- (1.0 / (((double)qtbl->quantval[i] *
- aanscalefactor[row] * aanscalefactor[col] * 8.0)));
- i++;
- }
- }
- }
- break;
- #endif
- default:
- ERREXIT(cinfo, JERR_NOT_COMPILED);
- break;
- }
- }
- }
- METHODDEF(void)
- convsamp(JSAMPARRAY sample_data, JDIMENSION start_col, DCTELEM *workspace)
- {
- register DCTELEM *workspaceptr;
- register JSAMPROW elemptr;
- register int elemr;
- workspaceptr = workspace;
- for (elemr = 0; elemr < DCTSIZE; elemr++) {
- elemptr = sample_data[elemr] + start_col;
- #if DCTSIZE == 8
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- #else
- {
- register int elemc;
- for (elemc = DCTSIZE; elemc > 0; elemc--)
- *workspaceptr++ = GETJSAMPLE(*elemptr++) - CENTERJSAMPLE;
- }
- #endif
- }
- }
- METHODDEF(void)
- quantize(JCOEFPTR coef_block, DCTELEM *divisors, DCTELEM *workspace)
- {
- int i;
- DCTELEM temp;
- JCOEFPTR output_ptr = coef_block;
- #if BITS_IN_JSAMPLE == 8
- UDCTELEM recip, corr;
- int shift;
- UDCTELEM2 product;
- for (i = 0; i < DCTSIZE2; i++) {
- temp = workspace[i];
- recip = divisors[i + DCTSIZE2 * 0];
- corr = divisors[i + DCTSIZE2 * 1];
- shift = divisors[i + DCTSIZE2 * 3];
- if (temp < 0) {
- temp = -temp;
- product = (UDCTELEM2)(temp + corr) * recip;
- product >>= shift + sizeof(DCTELEM) * 8;
- temp = (DCTELEM)product;
- temp = -temp;
- } else {
- product = (UDCTELEM2)(temp + corr) * recip;
- product >>= shift + sizeof(DCTELEM) * 8;
- temp = (DCTELEM)product;
- }
- output_ptr[i] = (JCOEF)temp;
- }
- #else
- register DCTELEM qval;
- for (i = 0; i < DCTSIZE2; i++) {
- qval = divisors[i];
- temp = workspace[i];
-
- #ifdef FAST_DIVIDE
- #define DIVIDE_BY(a, b) a /= b
- #else
- #define DIVIDE_BY(a, b) if (a >= b) a /= b; else a = 0
- #endif
- if (temp < 0) {
- temp = -temp;
- temp += qval >> 1;
- DIVIDE_BY(temp, qval);
- temp = -temp;
- } else {
- temp += qval >> 1;
- DIVIDE_BY(temp, qval);
- }
- output_ptr[i] = (JCOEF)temp;
- }
- #endif
- }
- METHODDEF(void)
- forward_DCT(j_compress_ptr cinfo, jpeg_component_info *compptr,
- JSAMPARRAY sample_data, JBLOCKROW coef_blocks,
- JDIMENSION start_row, JDIMENSION start_col, JDIMENSION num_blocks)
- {
-
- my_fdct_ptr fdct = (my_fdct_ptr)cinfo->fdct;
- DCTELEM *divisors = fdct->divisors[compptr->quant_tbl_no];
- DCTELEM *workspace;
- JDIMENSION bi;
-
- forward_DCT_method_ptr do_dct = fdct->dct;
- convsamp_method_ptr do_convsamp = fdct->convsamp;
- quantize_method_ptr do_quantize = fdct->quantize;
- workspace = fdct->workspace;
- sample_data += start_row;
- for (bi = 0; bi < num_blocks; bi++, start_col += DCTSIZE) {
-
- (*do_convsamp) (sample_data, start_col, workspace);
-
- (*do_dct) (workspace);
-
- (*do_quantize) (coef_blocks[bi], divisors, workspace);
- }
- }
- #ifdef DCT_FLOAT_SUPPORTED
- METHODDEF(void)
- convsamp_float(JSAMPARRAY sample_data, JDIMENSION start_col,
- FAST_FLOAT *workspace)
- {
- register FAST_FLOAT *workspaceptr;
- register JSAMPROW elemptr;
- register int elemr;
- workspaceptr = workspace;
- for (elemr = 0; elemr < DCTSIZE; elemr++) {
- elemptr = sample_data[elemr] + start_col;
- #if DCTSIZE == 8
- *workspaceptr++ = (FAST_FLOAT)(GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- *workspaceptr++ = (FAST_FLOAT)(GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- *workspaceptr++ = (FAST_FLOAT)(GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- *workspaceptr++ = (FAST_FLOAT)(GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- *workspaceptr++ = (FAST_FLOAT)(GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- *workspaceptr++ = (FAST_FLOAT)(GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- *workspaceptr++ = (FAST_FLOAT)(GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- *workspaceptr++ = (FAST_FLOAT)(GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- #else
- {
- register int elemc;
- for (elemc = DCTSIZE; elemc > 0; elemc--)
- *workspaceptr++ = (FAST_FLOAT)
- (GETJSAMPLE(*elemptr++) - CENTERJSAMPLE);
- }
- #endif
- }
- }
- METHODDEF(void)
- quantize_float(JCOEFPTR coef_block, FAST_FLOAT *divisors,
- FAST_FLOAT *workspace)
- {
- register FAST_FLOAT temp;
- register int i;
- register JCOEFPTR output_ptr = coef_block;
- for (i = 0; i < DCTSIZE2; i++) {
-
- temp = workspace[i] * divisors[i];
-
- output_ptr[i] = (JCOEF)((int)(temp + (FAST_FLOAT)16384.5) - 16384);
- }
- }
- METHODDEF(void)
- forward_DCT_float(j_compress_ptr cinfo, jpeg_component_info *compptr,
- JSAMPARRAY sample_data, JBLOCKROW coef_blocks,
- JDIMENSION start_row, JDIMENSION start_col,
- JDIMENSION num_blocks)
- {
-
- my_fdct_ptr fdct = (my_fdct_ptr)cinfo->fdct;
- FAST_FLOAT *divisors = fdct->float_divisors[compptr->quant_tbl_no];
- FAST_FLOAT *workspace;
- JDIMENSION bi;
-
- float_DCT_method_ptr do_dct = fdct->float_dct;
- float_convsamp_method_ptr do_convsamp = fdct->float_convsamp;
- float_quantize_method_ptr do_quantize = fdct->float_quantize;
- workspace = fdct->float_workspace;
- sample_data += start_row;
- for (bi = 0; bi < num_blocks; bi++, start_col += DCTSIZE) {
-
- (*do_convsamp) (sample_data, start_col, workspace);
-
- (*do_dct) (workspace);
-
- (*do_quantize) (coef_blocks[bi], divisors, workspace);
- }
- }
- #endif
- GLOBAL(void)
- jinit_forward_dct(j_compress_ptr cinfo)
- {
- my_fdct_ptr fdct;
- int i;
- fdct = (my_fdct_ptr)
- (*cinfo->mem->alloc_small) ((j_common_ptr)cinfo, JPOOL_IMAGE,
- sizeof(my_fdct_controller));
- cinfo->fdct = (struct jpeg_forward_dct *)fdct;
- fdct->pub.start_pass = start_pass_fdctmgr;
-
- switch (cinfo->dct_method) {
- #ifdef DCT_ISLOW_SUPPORTED
- case JDCT_ISLOW:
- fdct->pub.forward_DCT = forward_DCT;
- if (jsimd_can_fdct_islow())
- fdct->dct = jsimd_fdct_islow;
- else
- fdct->dct = jpeg_fdct_islow;
- break;
- #endif
- #ifdef DCT_IFAST_SUPPORTED
- case JDCT_IFAST:
- fdct->pub.forward_DCT = forward_DCT;
- if (jsimd_can_fdct_ifast())
- fdct->dct = jsimd_fdct_ifast;
- else
- fdct->dct = jpeg_fdct_ifast;
- break;
- #endif
- #ifdef DCT_FLOAT_SUPPORTED
- case JDCT_FLOAT:
- fdct->pub.forward_DCT = forward_DCT_float;
- if (jsimd_can_fdct_float())
- fdct->float_dct = jsimd_fdct_float;
- else
- fdct->float_dct = jpeg_fdct_float;
- break;
- #endif
- default:
- ERREXIT(cinfo, JERR_NOT_COMPILED);
- break;
- }
-
- switch (cinfo->dct_method) {
- #ifdef DCT_ISLOW_SUPPORTED
- case JDCT_ISLOW:
- #endif
- #ifdef DCT_IFAST_SUPPORTED
- case JDCT_IFAST:
- #endif
- #if defined(DCT_ISLOW_SUPPORTED) || defined(DCT_IFAST_SUPPORTED)
- if (jsimd_can_convsamp())
- fdct->convsamp = jsimd_convsamp;
- else
- fdct->convsamp = convsamp;
- if (jsimd_can_quantize())
- fdct->quantize = jsimd_quantize;
- else
- fdct->quantize = quantize;
- break;
- #endif
- #ifdef DCT_FLOAT_SUPPORTED
- case JDCT_FLOAT:
- if (jsimd_can_convsamp_float())
- fdct->float_convsamp = jsimd_convsamp_float;
- else
- fdct->float_convsamp = convsamp_float;
- if (jsimd_can_quantize_float())
- fdct->float_quantize = jsimd_quantize_float;
- else
- fdct->float_quantize = quantize_float;
- break;
- #endif
- default:
- ERREXIT(cinfo, JERR_NOT_COMPILED);
- break;
- }
-
- #ifdef DCT_FLOAT_SUPPORTED
- if (cinfo->dct_method == JDCT_FLOAT)
- fdct->float_workspace = (FAST_FLOAT *)
- (*cinfo->mem->alloc_small) ((j_common_ptr)cinfo, JPOOL_IMAGE,
- sizeof(FAST_FLOAT) * DCTSIZE2);
- else
- #endif
- fdct->workspace = (DCTELEM *)
- (*cinfo->mem->alloc_small) ((j_common_ptr)cinfo, JPOOL_IMAGE,
- sizeof(DCTELEM) * DCTSIZE2);
-
- for (i = 0; i < NUM_QUANT_TBLS; i++) {
- fdct->divisors[i] = NULL;
- #ifdef DCT_FLOAT_SUPPORTED
- fdct->float_divisors[i] = NULL;
- #endif
- }
- }
|