/*
  * Copyright (C) 2004-2010 Michael Niedermayer <michaelni@gmx.at>
  * Copyright (C) 2008 David Conrad
  *
  * This file is part of FFmpeg.
  *
  * FFmpeg is free software; you can redistribute it and/or
  * modify it under the terms of the GNU Lesser General Public
  * License as published by the Free Software Foundation; either
  * version 2.1 of the License, or (at your option) any later version.
  *
  * FFmpeg is distributed in the hope that it will be useful,
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  * Lesser General Public License for more details.
  *
  * You should have received a copy of the GNU Lesser General Public
  * License along with FFmpeg; if not, write to the Free Software
  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  */
 
 #include "libavutil/attributes.h"
 #include "libavutil/avassert.h"
 #include "libavutil/common.h"
 #include "dsputil.h"
 #include "dirac_dwt.h"
 #include "libavcodec/x86/dirac_dwt.h"
 
 
 static inline int mirror(int v, int m)
 {
     while ((unsigned)v > (unsigned)m) {
         v = -v;
         if (v < 0)
             v += 2 * m;
     }
     return v;
 }
 
 static void vertical_compose53iL0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
                                   int width)
 {
     int i;
 
     for (i = 0; i < width; i++)
         b1[i] -= (b0[i] + b2[i] + 2) >> 2;
 }
 
 
 static av_always_inline
 void interleave(IDWTELEM *dst, IDWTELEM *src0, IDWTELEM *src1, int w2, int add, int shift)
 {
     int i;
     for (i = 0; i < w2; i++) {
         dst[2*i  ] = (src0[i] + add) >> shift;
         dst[2*i+1] = (src1[i] + add) >> shift;
     }
 }
 
 static void horizontal_compose_dirac53i(IDWTELEM *b, IDWTELEM *temp, int w)
 {
     const int w2 = w >> 1;
     int x;
 
     temp[0] = COMPOSE_53iL0(b[w2], b[0], b[w2]);
     for (x = 1; x < w2; x++) {
         temp[x     ] = COMPOSE_53iL0     (b[x+w2-1], b[x     ], b[x+w2]);
         temp[x+w2-1] = COMPOSE_DIRAC53iH0(temp[x-1], b[x+w2-1], temp[x]);
     }
     temp[w-1] = COMPOSE_DIRAC53iH0(temp[w2-1], b[w-1], temp[w2-1]);
 
     interleave(b, temp, temp+w2, w2, 1, 1);
 }
 
 static void horizontal_compose_dd97i(IDWTELEM *b, IDWTELEM *tmp, int w)
 {
     const int w2 = w >> 1;
     int x;
 
     tmp[0] = COMPOSE_53iL0(b[w2], b[0], b[w2]);
     for (x = 1; x < w2; x++)
         tmp[x] = COMPOSE_53iL0(b[x+w2-1], b[x], b[x+w2]);
 
     // extend the edges
     tmp[-1]   = tmp[0];
     tmp[w2+1] = tmp[w2] = tmp[w2-1];
 
     for (x = 0; x < w2; x++) {
         b[2*x  ] = (tmp[x] + 1)>>1;
         b[2*x+1] = (COMPOSE_DD97iH0(tmp[x-1], tmp[x], b[x+w2], tmp[x+1], tmp[x+2]) + 1)>>1;
     }
 }
 
 static void horizontal_compose_dd137i(IDWTELEM *b, IDWTELEM *tmp, int w)
 {
     const int w2 = w >> 1;
     int x;
 
     tmp[0] = COMPOSE_DD137iL0(b[w2], b[w2], b[0], b[w2  ], b[w2+1]);
     tmp[1] = COMPOSE_DD137iL0(b[w2], b[w2], b[1], b[w2+1], b[w2+2]);
     for (x = 2; x < w2-1; x++)
         tmp[x] = COMPOSE_DD137iL0(b[x+w2-2], b[x+w2-1], b[x], b[x+w2], b[x+w2+1]);
     tmp[w2-1] = COMPOSE_DD137iL0(b[w-3], b[w-2], b[w2-1], b[w-1], b[w-1]);
 
     // extend the edges
     tmp[-1]   = tmp[0];
     tmp[w2+1] = tmp[w2] = tmp[w2-1];
 
     for (x = 0; x < w2; x++) {
         b[2*x  ] = (tmp[x] + 1)>>1;
         b[2*x+1] = (COMPOSE_DD97iH0(tmp[x-1], tmp[x], b[x+w2], tmp[x+1], tmp[x+2]) + 1)>>1;
     }
 }
 
 static av_always_inline
 void horizontal_compose_haari(IDWTELEM *b, IDWTELEM *temp, int w, int shift)
 {
     const int w2 = w >> 1;
     int x;
 
     for (x = 0; x < w2; x++) {
         temp[x   ] = COMPOSE_HAARiL0(b[x   ], b[x+w2]);
         temp[x+w2] = COMPOSE_HAARiH0(b[x+w2], temp[x]);
     }
 
     interleave(b, temp, temp+w2, w2, shift, shift);
 }
 
 static void horizontal_compose_haar0i(IDWTELEM *b, IDWTELEM *temp, int w)
 {
     horizontal_compose_haari(b, temp, w, 0);
 }
 
 static void horizontal_compose_haar1i(IDWTELEM *b, IDWTELEM *temp, int w)
 {
     horizontal_compose_haari(b, temp, w, 1);
 }
 
 static void horizontal_compose_fidelityi(IDWTELEM *b, IDWTELEM *tmp, int w)
 {
     const int w2 = w >> 1;
     int i, x;
     IDWTELEM v[8];
 
     for (x = 0; x < w2; x++) {
         for (i = 0; i < 8; i++)
             v[i] = b[av_clip(x-3+i, 0, w2-1)];
         tmp[x] = COMPOSE_FIDELITYiH0(v[0], v[1], v[2], v[3], b[x+w2], v[4], v[5], v[6], v[7]);
     }
 
     for (x = 0; x < w2; x++) {
         for (i = 0; i < 8; i++)
             v[i] = tmp[av_clip(x-4+i, 0, w2-1)];
         tmp[x+w2] = COMPOSE_FIDELITYiL0(v[0], v[1], v[2], v[3], b[x], v[4], v[5], v[6], v[7]);
     }
 
     interleave(b, tmp+w2, tmp, w2, 0, 0);
 }
 
 static void horizontal_compose_daub97i(IDWTELEM *b, IDWTELEM *temp, int w)
 {
     const int w2 = w >> 1;
     int x, b0, b1, b2;
 
     temp[0] = COMPOSE_DAUB97iL1(b[w2], b[0], b[w2]);
     for (x = 1; x < w2; x++) {
         temp[x     ] = COMPOSE_DAUB97iL1(b[x+w2-1], b[x     ], b[x+w2]);
         temp[x+w2-1] = COMPOSE_DAUB97iH1(temp[x-1], b[x+w2-1], temp[x]);
     }
     temp[w-1] = COMPOSE_DAUB97iH1(temp[w2-1], b[w-1], temp[w2-1]);
 
     // second stage combined with interleave and shift
     b0 = b2 = COMPOSE_DAUB97iL0(temp[w2], temp[0], temp[w2]);
     b[0] = (b0 + 1) >> 1;
     for (x = 1; x < w2; x++) {
         b2 = COMPOSE_DAUB97iL0(temp[x+w2-1], temp[x     ], temp[x+w2]);
         b1 = COMPOSE_DAUB97iH0(          b0, temp[x+w2-1], b2        );
         b[2*x-1] = (b1 + 1) >> 1;
         b[2*x  ] = (b2 + 1) >> 1;
         b0 = b2;
     }
     b[w-1] = (COMPOSE_DAUB97iH0(b2, temp[w-1], b2) + 1) >> 1;
 }
 
 static void vertical_compose_dirac53iH0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2, int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         b1[i] = COMPOSE_DIRAC53iH0(b0[i], b1[i], b2[i]);
     }
 }
 
 static void vertical_compose_dd97iH0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
                                   IDWTELEM *b3, IDWTELEM *b4, int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         b2[i] = COMPOSE_DD97iH0(b0[i], b1[i], b2[i], b3[i], b4[i]);
     }
 }
 
 static void vertical_compose_dd137iL0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
                                       IDWTELEM *b3, IDWTELEM *b4, int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         b2[i] = COMPOSE_DD137iL0(b0[i], b1[i], b2[i], b3[i], b4[i]);
     }
 }
 
 static void vertical_compose_haar(IDWTELEM *b0, IDWTELEM *b1, int width)
 {
     int i;
 
     for (i = 0; i < width; i++) {
         b0[i] = COMPOSE_HAARiL0(b0[i], b1[i]);
         b1[i] = COMPOSE_HAARiH0(b1[i], b0[i]);
     }
 }
 
 static void vertical_compose_fidelityiH0(IDWTELEM *dst, IDWTELEM *b[8], int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         dst[i] = COMPOSE_FIDELITYiH0(b[0][i], b[1][i], b[2][i], b[3][i], dst[i], b[4][i], b[5][i], b[6][i], b[7][i]);
     }
 }
 
 static void vertical_compose_fidelityiL0(IDWTELEM *dst, IDWTELEM *b[8], int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         dst[i] = COMPOSE_FIDELITYiL0(b[0][i], b[1][i], b[2][i], b[3][i], dst[i], b[4][i], b[5][i], b[6][i], b[7][i]);
     }
 }
 
 static void vertical_compose_daub97iH0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2, int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         b1[i] = COMPOSE_DAUB97iH0(b0[i], b1[i], b2[i]);
     }
 }
 
 static void vertical_compose_daub97iH1(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2, int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         b1[i] = COMPOSE_DAUB97iH1(b0[i], b1[i], b2[i]);
     }
 }
 
 static void vertical_compose_daub97iL0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2, int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         b1[i] = COMPOSE_DAUB97iL0(b0[i], b1[i], b2[i]);
     }
 }
 
 static void vertical_compose_daub97iL1(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2, int width)
 {
     int i;
 
     for(i=0; i<width; i++){
         b1[i] = COMPOSE_DAUB97iL1(b0[i], b1[i], b2[i]);
     }
 }
 
 
 static void spatial_compose_dd97i_dy(DWTContext *d, int level, int width, int height, int stride)
 {
     vertical_compose_3tap vertical_compose_l0 = (void*)d->vertical_compose_l0;
     vertical_compose_5tap vertical_compose_h0 = (void*)d->vertical_compose_h0;
     DWTCompose *cs = d->cs + level;
 
     int i, y = cs->y;
     IDWTELEM *b[8];
     for (i = 0; i < 6; i++)
         b[i] = cs->b[i];
     b[6] = d->buffer + av_clip(y+5, 0, height-2)*stride;
     b[7] = d->buffer + av_clip(y+6, 1, height-1)*stride;
 
         if(y+5<(unsigned)height) vertical_compose_l0(      b[5], b[6], b[7],       width);
         if(y+1<(unsigned)height) vertical_compose_h0(b[0], b[2], b[3], b[4], b[6], width);
 
         if(y-1<(unsigned)height) d->horizontal_compose(b[0], d->temp, width);
         if(y+0<(unsigned)height) d->horizontal_compose(b[1], d->temp, width);
 
     for (i = 0; i < 6; i++)
         cs->b[i] = b[i+2];
     cs->y += 2;
 }
 
 static void spatial_compose_dirac53i_dy(DWTContext *d, int level, int width, int height, int stride)
 {
     vertical_compose_3tap vertical_compose_l0 = (void*)d->vertical_compose_l0;
     vertical_compose_3tap vertical_compose_h0 = (void*)d->vertical_compose_h0;
     DWTCompose *cs = d->cs + level;
 
     int y= cs->y;
     IDWTELEM *b[4] = { cs->b[0], cs->b[1] };
     b[2] = d->buffer + mirror(y+1, height-1)*stride;
     b[3] = d->buffer + mirror(y+2, height-1)*stride;
 
         if(y+1<(unsigned)height) vertical_compose_l0(b[1], b[2], b[3], width);
         if(y+0<(unsigned)height) vertical_compose_h0(b[0], b[1], b[2], width);
 
         if(y-1<(unsigned)height) d->horizontal_compose(b[0], d->temp, width);
         if(y+0<(unsigned)height) d->horizontal_compose(b[1], d->temp, width);
 
     cs->b[0] = b[2];
     cs->b[1] = b[3];
     cs->y += 2;
 }
 
 
 static void spatial_compose_dd137i_dy(DWTContext *d, int level, int width, int height, int stride)
 {
     vertical_compose_5tap vertical_compose_l0 = (void*)d->vertical_compose_l0;
     vertical_compose_5tap vertical_compose_h0 = (void*)d->vertical_compose_h0;
     DWTCompose *cs = d->cs + level;
 
     int i, y = cs->y;
     IDWTELEM *b[10];
     for (i = 0; i < 8; i++)
         b[i] = cs->b[i];
     b[8] = d->buffer + av_clip(y+7, 0, height-2)*stride;
     b[9] = d->buffer + av_clip(y+8, 1, height-1)*stride;
 
         if(y+5<(unsigned)height) vertical_compose_l0(b[3], b[5], b[6], b[7], b[9], width);
         if(y+1<(unsigned)height) vertical_compose_h0(b[0], b[2], b[3], b[4], b[6], width);
 
         if(y-1<(unsigned)height) d->horizontal_compose(b[0], d->temp, width);
         if(y+0<(unsigned)height) d->horizontal_compose(b[1], d->temp, width);
 
     for (i = 0; i < 8; i++)
         cs->b[i] = b[i+2];
     cs->y += 2;
 }
 
 // haar makes the assumption that height is even (always true for dirac)
 static void spatial_compose_haari_dy(DWTContext *d, int level, int width, int height, int stride)
 {
     vertical_compose_2tap vertical_compose = (void*)d->vertical_compose;
     int y = d->cs[level].y;
     IDWTELEM *b0 = d->buffer + (y-1)*stride;
     IDWTELEM *b1 = d->buffer + (y  )*stride;
 
     vertical_compose(b0, b1, width);
     d->horizontal_compose(b0, d->temp, width);
     d->horizontal_compose(b1, d->temp, width);
 
     d->cs[level].y += 2;
 }
 
 // Don't do sliced idwt for fidelity; the 9 tap filter makes it a bit annoying
 // Fortunately, this filter isn't used in practice.
 static void spatial_compose_fidelity(DWTContext *d, int level, int width, int height, int stride)
 {
     vertical_compose_9tap vertical_compose_l0 = (void*)d->vertical_compose_l0;
     vertical_compose_9tap vertical_compose_h0 = (void*)d->vertical_compose_h0;
     int i, y;
     IDWTELEM *b[8];
 
     for (y = 1; y < height; y += 2) {
         for (i = 0; i < 8; i++)
             b[i] = d->buffer + av_clip((y-7 + 2*i), 0, height-2)*stride;
         vertical_compose_h0(d->buffer + y*stride, b, width);
     }
 
     for (y = 0; y < height; y += 2) {
         for (i = 0; i < 8; i++)
             b[i] = d->buffer + av_clip((y-7 + 2*i), 1, height-1)*stride;
         vertical_compose_l0(d->buffer + y*stride, b, width);
     }
 
     for (y = 0; y < height; y++)
         d->horizontal_compose(d->buffer + y*stride, d->temp, width);
 
     d->cs[level].y = height+1;
 }
 
 static void spatial_compose_daub97i_dy(DWTContext *d, int level, int width, int height, int stride)
 {
     vertical_compose_3tap vertical_compose_l0 = (void*)d->vertical_compose_l0;
     vertical_compose_3tap vertical_compose_h0 = (void*)d->vertical_compose_h0;
     vertical_compose_3tap vertical_compose_l1 = (void*)d->vertical_compose_l1;
     vertical_compose_3tap vertical_compose_h1 = (void*)d->vertical_compose_h1;
     DWTCompose *cs = d->cs + level;
 
     int i, y = cs->y;
     IDWTELEM *b[6];
     for (i = 0; i < 4; i++)
         b[i] = cs->b[i];
     b[4] = d->buffer + mirror(y+3, height-1)*stride;
     b[5] = d->buffer + mirror(y+4, height-1)*stride;
 
         if(y+3<(unsigned)height) vertical_compose_l1(b[3], b[4], b[5], width);
         if(y+2<(unsigned)height) vertical_compose_h1(b[2], b[3], b[4], width);
         if(y+1<(unsigned)height) vertical_compose_l0(b[1], b[2], b[3], width);
         if(y+0<(unsigned)height) vertical_compose_h0(b[0], b[1], b[2], width);
 
         if(y-1<(unsigned)height) d->horizontal_compose(b[0], d->temp, width);
         if(y+0<(unsigned)height) d->horizontal_compose(b[1], d->temp, width);
 
     for (i = 0; i < 4; i++)
         cs->b[i] = b[i+2];
     cs->y += 2;
 }
 
 
 static void spatial_compose97i_init2(DWTCompose *cs, IDWTELEM *buffer, int height, int stride)
 {
     cs->b[0] = buffer + mirror(-3-1, height-1)*stride;
     cs->b[1] = buffer + mirror(-3  , height-1)*stride;
     cs->b[2] = buffer + mirror(-3+1, height-1)*stride;
     cs->b[3] = buffer + mirror(-3+2, height-1)*stride;
     cs->y = -3;
 }
 
 static void spatial_compose53i_init2(DWTCompose *cs, IDWTELEM *buffer, int height, int stride)
 {
     cs->b[0] = buffer + mirror(-1-1, height-1)*stride;
     cs->b[1] = buffer + mirror(-1  , height-1)*stride;
     cs->y = -1;
 }
 
 static void spatial_compose_dd97i_init(DWTCompose *cs, IDWTELEM *buffer, int height, int stride)
 {
     cs->b[0] = buffer + av_clip(-5-1, 0, height-2)*stride;
     cs->b[1] = buffer + av_clip(-5  , 1, height-1)*stride;
     cs->b[2] = buffer + av_clip(-5+1, 0, height-2)*stride;
     cs->b[3] = buffer + av_clip(-5+2, 1, height-1)*stride;
     cs->b[4] = buffer + av_clip(-5+3, 0, height-2)*stride;
     cs->b[5] = buffer + av_clip(-5+4, 1, height-1)*stride;
     cs->y = -5;
 }
 
 static void spatial_compose_dd137i_init(DWTCompose *cs, IDWTELEM *buffer, int height, int stride)
 {
     cs->b[0] = buffer + av_clip(-5-1, 0, height-2)*stride;
     cs->b[1] = buffer + av_clip(-5  , 1, height-1)*stride;
     cs->b[2] = buffer + av_clip(-5+1, 0, height-2)*stride;
     cs->b[3] = buffer + av_clip(-5+2, 1, height-1)*stride;
     cs->b[4] = buffer + av_clip(-5+3, 0, height-2)*stride;
     cs->b[5] = buffer + av_clip(-5+4, 1, height-1)*stride;
     cs->b[6] = buffer + av_clip(-5+5, 0, height-2)*stride;
     cs->b[7] = buffer + av_clip(-5+6, 1, height-1)*stride;
     cs->y = -5;
 }
 
 int ff_spatial_idwt_init2(DWTContext *d, IDWTELEM *buffer, int width, int height,
                           int stride, enum dwt_type type, int decomposition_count,
                           IDWTELEM *temp)
 {
     int level;
 
     d->buffer = buffer;
     d->width = width;
     d->height = height;
     d->stride = stride;
     d->decomposition_count = decomposition_count;
     d->temp = temp + 8;
 
     for(level=decomposition_count-1; level>=0; level--){
         int hl = height >> level;
         int stride_l = stride << level;
 
         switch(type){
         case DWT_DIRAC_DD9_7:
             spatial_compose_dd97i_init(d->cs+level, buffer, hl, stride_l);
             break;
         case DWT_DIRAC_LEGALL5_3:
             spatial_compose53i_init2(d->cs+level, buffer, hl, stride_l);
             break;
         case DWT_DIRAC_DD13_7:
             spatial_compose_dd137i_init(d->cs+level, buffer, hl, stride_l);
             break;
         case DWT_DIRAC_HAAR0:
         case DWT_DIRAC_HAAR1:
             d->cs[level].y = 1;
             break;
         case DWT_DIRAC_DAUB9_7:
             spatial_compose97i_init2(d->cs+level, buffer, hl, stride_l);
             break;
         default:
             d->cs[level].y = 0;
             break;
         }
     }
 
     switch (type) {
     case DWT_DIRAC_DD9_7:
         d->spatial_compose = spatial_compose_dd97i_dy;
         d->vertical_compose_l0 = (void*)vertical_compose53iL0;
         d->vertical_compose_h0 = (void*)vertical_compose_dd97iH0;
         d->horizontal_compose = horizontal_compose_dd97i;
         d->support = 7;
         break;
     case DWT_DIRAC_LEGALL5_3:
         d->spatial_compose = spatial_compose_dirac53i_dy;
         d->vertical_compose_l0 = (void*)vertical_compose53iL0;
         d->vertical_compose_h0 = (void*)vertical_compose_dirac53iH0;
         d->horizontal_compose = horizontal_compose_dirac53i;
         d->support = 3;
         break;
     case DWT_DIRAC_DD13_7:
         d->spatial_compose = spatial_compose_dd137i_dy;
         d->vertical_compose_l0 = (void*)vertical_compose_dd137iL0;
         d->vertical_compose_h0 = (void*)vertical_compose_dd97iH0;
         d->horizontal_compose = horizontal_compose_dd137i;
         d->support = 7;
         break;
     case DWT_DIRAC_HAAR0:
     case DWT_DIRAC_HAAR1:
         d->spatial_compose = spatial_compose_haari_dy;
         d->vertical_compose = (void*)vertical_compose_haar;
         if (type == DWT_DIRAC_HAAR0)
             d->horizontal_compose = horizontal_compose_haar0i;
         else
             d->horizontal_compose = horizontal_compose_haar1i;
         d->support = 1;
         break;
     case DWT_DIRAC_FIDELITY:
         d->spatial_compose = spatial_compose_fidelity;
         d->vertical_compose_l0 = (void*)vertical_compose_fidelityiL0;
         d->vertical_compose_h0 = (void*)vertical_compose_fidelityiH0;
         d->horizontal_compose = horizontal_compose_fidelityi;

         d->support = 0; // not really used

         break;
     case DWT_DIRAC_DAUB9_7:
         d->spatial_compose = spatial_compose_daub97i_dy;
         d->vertical_compose_l0 = (void*)vertical_compose_daub97iL0;
         d->vertical_compose_h0 = (void*)vertical_compose_daub97iH0;
         d->vertical_compose_l1 = (void*)vertical_compose_daub97iL1;
         d->vertical_compose_h1 = (void*)vertical_compose_daub97iH1;
         d->horizontal_compose = horizontal_compose_daub97i;
         d->support = 5;
         break;
     default:
         av_log(NULL, AV_LOG_ERROR, "Unknown wavelet type %d\n", type);
         return -1;
     }
 
     if (HAVE_MMX) ff_spatial_idwt_init_mmx(d, type);
 
     return 0;
 }
 
 void ff_spatial_idwt_slice2(DWTContext *d, int y)
 {
     int level, support = d->support;
 
     for (level = d->decomposition_count-1; level >= 0; level--) {
         int wl = d->width  >> level;
         int hl = d->height >> level;
         int stride_l = d->stride << level;
 
         while (d->cs[level].y <= FFMIN((y>>level)+support, hl))
             d->spatial_compose(d, level, wl, hl, stride_l);
     }
 }