yading@10: /*
yading@10:  * Discrete wavelet transform
yading@10:  * Copyright (c) 2007 Kamil Nowosad
yading@10:  *
yading@10:  * This file is part of FFmpeg.
yading@10:  *
yading@10:  * FFmpeg is free software; you can redistribute it and/or
yading@10:  * modify it under the terms of the GNU Lesser General Public
yading@10:  * License as published by the Free Software Foundation; either
yading@10:  * version 2.1 of the License, or (at your option) any later version.
yading@10:  *
yading@10:  * FFmpeg is distributed in the hope that it will be useful,
yading@10:  * but WITHOUT ANY WARRANTY; without even the implied warranty of
yading@10:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
yading@10:  * Lesser General Public License for more details.
yading@10:  *
yading@10:  * You should have received a copy of the GNU Lesser General Public
yading@10:  * License along with FFmpeg; if not, write to the Free Software
yading@10:  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
yading@10:  */
yading@10: 
yading@10: /**
yading@10:  * Discrete wavelet transform
yading@10:  * @file
yading@10:  * @author Kamil Nowosad
yading@10:  */
yading@10: 
yading@10: #include "j2k_dwt.h"
yading@10: 
yading@10: static const float scale97[] = {1.625786, 1.230174};
yading@10: 
yading@10: static inline void extend53(int *p, int i0, int i1)
yading@10: {
yading@10:     p[i0 - 1] = p[i0 + 1];
yading@10:     p[i1    ] = p[i1 - 2];
yading@10:     p[i0 - 2] = p[i0 + 2];
yading@10:     p[i1 + 1] = p[i1 - 3];
yading@10: }
yading@10: 
yading@10: static inline void extend97(float *p, int i0, int i1)
yading@10: {
yading@10:     int i;
yading@10: 
yading@10:     for (i = 1; i <= 4; i++){
yading@10:         p[i0 - i] = p[i0 + i];
yading@10:         p[i1 + i - 1] = p[i1 - i - 1];
yading@10:     }
yading@10: }
yading@10: 
yading@10: static void sd_1d53(int *p, int i0, int i1)
yading@10: {
yading@10:     int i;
yading@10: 
yading@10:     if (i1 == i0 + 1)
yading@10:         return;
yading@10: 
yading@10:     extend53(p, i0, i1);
yading@10: 
yading@10:     for (i = (i0+1)/2 - 1; i < (i1+1)/2; i++)
yading@10:         p[2*i+1] -= (p[2*i] + p[2*i+2]) >> 1;
yading@10:     for (i = (i0+1)/2; i < (i1+1)/2; i++)
yading@10:         p[2*i] += (p[2*i-1] + p[2*i+1] + 2) >> 2;
yading@10: }
yading@10: 
yading@10: static void dwt_encode53(DWTContext *s, int *t)
yading@10: {
yading@10:     int lev,
yading@10:         w = s->linelen[s->ndeclevels-1][0];
yading@10:     int *line = s->linebuf;
yading@10:     line += 3;
yading@10: 
yading@10:     for (lev = s->ndeclevels-1; lev >= 0; lev--){
yading@10:         int lh = s->linelen[lev][0],
yading@10:             lv = s->linelen[lev][1],
yading@10:             mh = s->mod[lev][0],
yading@10:             mv = s->mod[lev][1],
yading@10:             lp;
yading@10:         int *l;
yading@10: 
yading@10:         // HOR_SD
yading@10:         l = line + mh;
yading@10:         for (lp = 0; lp < lv; lp++){
yading@10:             int i, j = 0;
yading@10: 
yading@10:             for (i = 0; i < lh; i++)
yading@10:                 l[i] = t[w*lp + i];
yading@10: 
yading@10:             sd_1d53(line, mh, mh + lh);
yading@10: 
yading@10:             // copy back and deinterleave
yading@10:             for (i =   mh; i < lh; i+=2, j++)
yading@10:                 t[w*lp + j] = l[i];
yading@10:             for (i = 1-mh; i < lh; i+=2, j++)
yading@10:                 t[w*lp + j] = l[i];
yading@10:         }
yading@10: 
yading@10:         // VER_SD
yading@10:         l = line + mv;
yading@10:         for (lp = 0; lp < lh; lp++) {
yading@10:             int i, j = 0;
yading@10: 
yading@10:             for (i = 0; i < lv; i++)
yading@10:                 l[i] = t[w*i + lp];
yading@10: 
yading@10:             sd_1d53(line, mv, mv + lv);
yading@10: 
yading@10:             // copy back and deinterleave
yading@10:             for (i =   mv; i < lv; i+=2, j++)
yading@10:                 t[w*j + lp] = l[i];
yading@10:             for (i = 1-mv; i < lv; i+=2, j++)
yading@10:                 t[w*j + lp] = l[i];
yading@10:         }
yading@10:     }
yading@10: }
yading@10: 
yading@10: static void sd_1d97(float *p, int i0, int i1)
yading@10: {
yading@10:     int i;
yading@10: 
yading@10:     if (i1 == i0 + 1)
yading@10:         return;
yading@10: 
yading@10:     extend97(p, i0, i1);
yading@10:     i0++; i1++;
yading@10: 
yading@10:     for (i = i0/2 - 2; i < i1/2 + 1; i++)
yading@10:         p[2*i+1] -= 1.586134 * (p[2*i] + p[2*i+2]);
yading@10:     for (i = i0/2 - 1; i < i1/2 + 1; i++)
yading@10:         p[2*i] -= 0.052980 * (p[2*i-1] + p[2*i+1]);
yading@10:     for (i = i0/2 - 1; i < i1/2; i++)
yading@10:         p[2*i+1] += 0.882911 * (p[2*i] + p[2*i+2]);
yading@10:     for (i = i0/2; i < i1/2; i++)
yading@10:         p[2*i] += 0.443506 * (p[2*i-1] + p[2*i+1]);
yading@10: }
yading@10: 
yading@10: static void dwt_encode97(DWTContext *s, int *t)
yading@10: {
yading@10:     int lev,
yading@10:         w = s->linelen[s->ndeclevels-1][0];
yading@10:     float *line = s->linebuf;
yading@10:     line += 5;
yading@10: 
yading@10:     for (lev = s->ndeclevels-1; lev >= 0; lev--){
yading@10:         int lh = s->linelen[lev][0],
yading@10:             lv = s->linelen[lev][1],
yading@10:             mh = s->mod[lev][0],
yading@10:             mv = s->mod[lev][1],
yading@10:             lp;
yading@10:         float *l;
yading@10: 
yading@10:         // HOR_SD
yading@10:         l = line + mh;
yading@10:         for (lp = 0; lp < lv; lp++){
yading@10:             int i, j = 0;
yading@10: 
yading@10:             for (i = 0; i < lh; i++)
yading@10:                 l[i] = t[w*lp + i];
yading@10: 
yading@10:             sd_1d97(line, mh, mh + lh);
yading@10: 
yading@10:             // copy back and deinterleave
yading@10:             for (i =   mh; i < lh; i+=2, j++)
yading@10:                 t[w*lp + j] = scale97[mh] * l[i] / 2;
yading@10:             for (i = 1-mh; i < lh; i+=2, j++)
yading@10:                 t[w*lp + j] = scale97[mh] * l[i] / 2;
yading@10:         }
yading@10: 
yading@10:         // VER_SD
yading@10:         l = line + mv;
yading@10:         for (lp = 0; lp < lh; lp++) {
yading@10:             int i, j = 0;
yading@10: 
yading@10:             for (i = 0; i < lv; i++)
yading@10:                 l[i] = t[w*i + lp];
yading@10: 
yading@10:             sd_1d97(line, mv, mv + lv);
yading@10: 
yading@10:             // copy back and deinterleave
yading@10:             for (i =   mv; i < lv; i+=2, j++)
yading@10:                 t[w*j + lp] = scale97[mv] * l[i] / 2;
yading@10:             for (i = 1-mv; i < lv; i+=2, j++)
yading@10:                 t[w*j + lp] = scale97[mv] * l[i] / 2;
yading@10:         }
yading@10:     }
yading@10: }
yading@10: 
yading@10: static void sr_1d53(int *p, int i0, int i1)
yading@10: {
yading@10:     int i;
yading@10: 
yading@10:     if (i1 == i0 + 1)
yading@10:         return;
yading@10: 
yading@10:     extend53(p, i0, i1);
yading@10: 
yading@10:     for (i = i0/2; i < i1/2 + 1; i++)
yading@10:         p[2*i] -= (p[2*i-1] + p[2*i+1] + 2) >> 2;
yading@10:     for (i = i0/2; i < i1/2; i++)
yading@10:         p[2*i+1] += (p[2*i] + p[2*i+2]) >> 1;
yading@10: }
yading@10: 
yading@10: static void dwt_decode53(DWTContext *s, int *t)
yading@10: {
yading@10:     int lev,
yading@10:         w = s->linelen[s->ndeclevels-1][0];
yading@10:     int *line = s->linebuf;
yading@10:     line += 3;
yading@10: 
yading@10:     for (lev = 0; lev < s->ndeclevels; lev++){
yading@10:         int lh = s->linelen[lev][0],
yading@10:             lv = s->linelen[lev][1],
yading@10:             mh = s->mod[lev][0],
yading@10:             mv = s->mod[lev][1],
yading@10:             lp;
yading@10:         int *l;
yading@10: 
yading@10:         // HOR_SD
yading@10:         l = line + mh;
yading@10:         for (lp = 0; lp < lv; lp++){
yading@10:             int i, j = 0;
yading@10:             // copy with interleaving
yading@10:             for (i =   mh; i < lh; i+=2, j++)
yading@10:                 l[i] = t[w*lp + j];
yading@10:             for (i = 1-mh; i < lh; i+=2, j++)
yading@10:                 l[i] = t[w*lp + j];
yading@10: 
yading@10:             sr_1d53(line, mh, mh + lh);
yading@10: 
yading@10:             for (i = 0; i < lh; i++)
yading@10:                 t[w*lp + i] = l[i];
yading@10:         }
yading@10: 
yading@10:         // VER_SD
yading@10:         l = line + mv;
yading@10:         for (lp = 0; lp < lh; lp++){
yading@10:             int i, j = 0;
yading@10:             // copy with interleaving
yading@10:             for (i =   mv; i < lv; i+=2, j++)
yading@10:                 l[i] = t[w*j + lp];
yading@10:             for (i = 1-mv; i < lv; i+=2, j++)
yading@10:                 l[i] = t[w*j + lp];
yading@10: 
yading@10:             sr_1d53(line, mv, mv + lv);
yading@10: 
yading@10:             for (i = 0; i < lv; i++)
yading@10:                 t[w*i + lp] = l[i];
yading@10:         }
yading@10:     }
yading@10: }
yading@10: 
yading@10: static void sr_1d97(float *p, int i0, int i1)
yading@10: {
yading@10:     int i;
yading@10: 
yading@10:     if (i1 == i0 + 1)
yading@10:         return;
yading@10: 
yading@10:     extend97(p, i0, i1);
yading@10: 
yading@10:     for (i = i0/2 - 1; i < i1/2 + 2; i++)
yading@10:         p[2*i] -= 0.443506 * (p[2*i-1] + p[2*i+1]);
yading@10:     for (i = i0/2 - 1; i < i1/2 + 1; i++)
yading@10:         p[2*i+1] -= 0.882911 * (p[2*i] + p[2*i+2]);
yading@10:     for (i = i0/2; i < i1/2 + 1; i++)
yading@10:         p[2*i] += 0.052980 * (p[2*i-1] + p[2*i+1]);
yading@10:     for (i = i0/2; i < i1/2; i++)
yading@10:         p[2*i+1] += 1.586134 * (p[2*i] + p[2*i+2]);
yading@10: }
yading@10: 
yading@10: static void dwt_decode97(DWTContext *s, int *t)
yading@10: {
yading@10:     int lev,
yading@10:         w = s->linelen[s->ndeclevels-1][0];
yading@10:     float *line = s->linebuf;
yading@10:     line += 5;
yading@10: 
yading@10:     for (lev = 0; lev < s->ndeclevels; lev++){
yading@10:         int lh = s->linelen[lev][0],
yading@10:             lv = s->linelen[lev][1],
yading@10:             mh = s->mod[lev][0],
yading@10:             mv = s->mod[lev][1],
yading@10:             lp;
yading@10:         float *l;
yading@10: 
yading@10:         // HOR_SD
yading@10:         l = line + mh;
yading@10:         for (lp = 0; lp < lv; lp++){
yading@10:             int i, j = 0;
yading@10:             // copy with interleaving
yading@10:             for (i =   mh; i < lh; i+=2, j++)
yading@10:                 l[i] = scale97[1-mh] * t[w*lp + j];
yading@10:             for (i = 1-mh; i < lh; i+=2, j++)
yading@10:                 l[i] = scale97[1-mh] * t[w*lp + j];
yading@10: 
yading@10:             sr_1d97(line, mh, mh + lh);
yading@10: 
yading@10:             for (i = 0; i < lh; i++)
yading@10:                 t[w*lp + i] = l[i];
yading@10:         }
yading@10: 
yading@10:         // VER_SD
yading@10:         l = line + mv;
yading@10:         for (lp = 0; lp < lh; lp++){
yading@10:             int i, j = 0;
yading@10:             // copy with interleaving
yading@10:             for (i =   mv; i < lv; i+=2, j++)
yading@10:                 l[i] = scale97[1-mv] * t[w*j + lp];
yading@10:             for (i = 1-mv; i < lv; i+=2, j++)
yading@10:                 l[i] = scale97[1-mv] * t[w*j + lp];
yading@10: 
yading@10:             sr_1d97(line, mv, mv + lv);
yading@10: 
yading@10:             for (i = 0; i < lv; i++)
yading@10:                 t[w*i + lp] = l[i];
yading@10:         }
yading@10:     }
yading@10: }
yading@10: 
yading@10: int ff_j2k_dwt_init(DWTContext *s, uint16_t border[2][2], int decomp_levels, int type)
yading@10: {
yading@10:     int i, j, lev = decomp_levels, maxlen,
yading@10:         b[2][2];
yading@10: 
yading@10:     if ((unsigned)decomp_levels >= FF_DWT_MAX_DECLVLS)
yading@10:         return AVERROR_INVALIDDATA;
yading@10:     s->ndeclevels = decomp_levels;
yading@10:     s->type = type;
yading@10: 
yading@10:     for (i = 0; i < 2; i++)
yading@10:         for(j = 0; j < 2; j++)
yading@10:             b[i][j] = border[i][j];
yading@10: 
yading@10:     maxlen = FFMAX(b[0][1] - b[0][0],
yading@10:                    b[1][1] - b[1][0]);
yading@10: 
yading@10:     while(--lev >= 0){
yading@10:         for (i = 0; i < 2; i++){
yading@10:             s->linelen[lev][i] = b[i][1] - b[i][0];
yading@10:             s->mod[lev][i] = b[i][0] & 1;
yading@10:             for (j = 0; j < 2; j++)
yading@10:                 b[i][j] = (b[i][j] + 1) >> 1;
yading@10:         }
yading@10:     }
yading@10:     if (type == FF_DWT97)
yading@10:         s->linebuf = av_malloc((maxlen + 12) * sizeof(float));
yading@10:     else if (type == FF_DWT53)
yading@10:         s->linebuf = av_malloc((maxlen + 6) * sizeof(int));
yading@10:     else
yading@10:         return -1;
yading@10: 
yading@10:     if (!s->linebuf)
yading@10:         return AVERROR(ENOMEM);
yading@10: 
yading@10:     return 0;
yading@10: }
yading@10: 
yading@10: int ff_j2k_dwt_encode(DWTContext *s, int *t)
yading@10: {
yading@10:     switch(s->type){
yading@10:         case FF_DWT97:
yading@10:             dwt_encode97(s, t); break;
yading@10:         case FF_DWT53:
yading@10:             dwt_encode53(s, t); break;
yading@10:         default:
yading@10:             return -1;
yading@10:     }
yading@10:     return 0;
yading@10: }
yading@10: 
yading@10: int ff_j2k_dwt_decode(DWTContext *s, int *t)
yading@10: {
yading@10:     switch(s->type){
yading@10:         case FF_DWT97:
yading@10:             dwt_decode97(s, t); break;
yading@10:         case FF_DWT53:
yading@10:             dwt_decode53(s, t); break;
yading@10:         default:
yading@10:             return -1;
yading@10:     }
yading@10:     return 0;
yading@10: }
yading@10: 
yading@10: void ff_j2k_dwt_destroy(DWTContext *s)
yading@10: {
yading@10:     av_freep(&s->linebuf);
yading@10: }