/*
 * Copyright (C) 2011 The Android Open Source Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

/* $Id: db_utilities.cpp,v 1.4 2011/06/17 14:03:31 mbansal Exp $ */

#include "db_utilities.h"
#include <string.h>
#include <stdio.h>

float** db_SetupImageReferences_f(float *im,int w,int h)
{
    int i;
    float **img;
    assert(im);
    img=new float* [h];
    for(i=0;i<h;i++)
    {
        img[i]=im+w*i;
    }
    return(img);
}

unsigned char** db_SetupImageReferences_u(unsigned char *im,int w,int h)
{
    int i;
    unsigned char **img;

    assert(im);

    img=new unsigned char* [h];
    for(i=0;i<h;i++)
    {
        img[i]=im+w*i;
    }
    return(img);
}
float** db_AllocImage_f(int w,int h,int over_allocation)
{
    float **img,*im;

    im=new float [w*h+over_allocation];
    img=db_SetupImageReferences_f(im,w,h);

    return(img);
}

unsigned char** db_AllocImage_u(int w,int h,int over_allocation)
{
    unsigned char **img,*im;

    im=new unsigned char [w*h+over_allocation];
    img=db_SetupImageReferences_u(im,w,h);

    return(img);
}

void db_FreeImage_f(float **img,int h)
{
    delete [] (img[0]);
    delete [] img;
}

void db_FreeImage_u(unsigned char **img,int h)
{
    delete [] (img[0]);
    delete [] img;
}

// ----------------------------------------------------------------------------------------------------------- ;
//
// copy image (source to destination)
// ---> must be a 2D image array with the same image size
// ---> the size of the input and output images must be same
//
// ------------------------------------------------------------------------------------------------------------ ;
void db_CopyImage_u(unsigned char **d,const unsigned char * const *s, int w, int h, int over_allocation)
{
    int i;

    for (i=0;i<h;i++)
    {
        memcpy(d[i],s[i],w*sizeof(unsigned char));
    }

    memcpy(&d[h],&d[h],over_allocation);

}

inline void db_WarpImageLutFast_u(const unsigned char * const * src, unsigned char ** dst, int w, int h,
                                  const float * const * lut_x, const float * const * lut_y)
{
    assert(src && dst);
    int xd=0, yd=0;

    for ( int i = 0; i < w; ++i )
        for ( int j = 0; j < h; ++j )
        {
            //xd = static_cast<unsigned int>(lut_x[j][i]);
            //yd = static_cast<unsigned int>(lut_y[j][i]);
            xd = (unsigned int)(lut_x[j][i]);
            yd = (unsigned int)(lut_y[j][i]);
            if ( xd >= w || yd >= h ||
                 xd < 0 || yd < 0)
                dst[j][i] = 0;
            else
                dst[j][i] = src[yd][xd];
        }
}

inline void db_WarpImageLutBilinear_u(const unsigned char * const * src, unsigned char ** dst, int w, int h,
                                      const float * const * lut_x,const float * const* lut_y)
{
    assert(src && dst);
    double xd=0.0, yd=0.0;

    for ( int i = 0; i < w; ++i )
        for ( int j = 0; j < h; ++j )
        {
            xd = static_cast<double>(lut_x[j][i]);
            yd = static_cast<double>(lut_y[j][i]);
            if ( xd > w   || yd > h ||
                 xd < 0.0 || yd < 0.0)
                dst[j][i] = 0;
            else
                dst[j][i] = db_BilinearInterpolation(yd, xd, src);
        }
}


void db_WarpImageLut_u(const unsigned char * const * src, unsigned char ** dst, int w, int h,
                       const float * const * lut_x,const float * const * lut_y, int type)
{
    switch (type)
    {
    case DB_WARP_FAST:
        db_WarpImageLutFast_u(src,dst,w,h,lut_x,lut_y);
        break;
    case DB_WARP_BILINEAR:
        db_WarpImageLutBilinear_u(src,dst,w,h,lut_x,lut_y);
        break;
    default:
        break;
    }
}


void db_PrintDoubleVector(double *a,long size)
{
    printf("[ ");
    for(long i=0;i<size;i++) printf("%lf ",a[i]);
    printf("]");
}

void db_PrintDoubleMatrix(double *a,long rows,long cols)
{
    printf("[\n");
    for(long i=0;i<rows;i++)
    {
        for(long j=0;j<cols;j++) printf("%lf ",a[i*cols+j]);
        printf("\n");
    }
    printf("]");
}