/*
 *  This file is part of RawTherapee.
 *
 *  RawTherapee is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 * 
 *  RawTherapee 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 General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with RawTherapee.  If not, see <http://www.gnu.org/licenses/>.
 *
 *  © 2010 Emil Martinec <ejmartin@uchicago.edu>
 *    
 */

#include <cstddef>
#include <cmath>
#include "curves.h"
#include "labimage.h"
#include "color.h"
#include "mytime.h"
#include "improcfun.h"
#include "rawimagesource.h"
#include "array2D.h"
#include "rt_math.h"
#include "opthelper.h"
#ifdef _OPENMP
#include <omp.h>
#endif
#define CLIPI(a) ((a)>0 ?((a)<32768 ?(a):32768):0)

#define RANGEFN(i) ((1000.0f / (i + 1000.0f)))
#define CLIPC(a) ((a)>-32000?((a)<32000?(a):32000):-32000)
#define DIRWT(i1,j1,i,j) ( domker[(i1-i)/scale+halfwin][(j1-j)/scale+halfwin] * RANGEFN(fabsf((data_fine[i1][j1]-data_fine[i][j]))) )

namespace rtengine {
	
	static const int maxlevel = 6;
	static const float noise = 2000;
	
	//sequence of scales
	static const int scales[6] = {1,2,4,8,16,32};
	extern const Settings* settings;
	
	//sequence of scales
	
	
SSEFUNCTION void ImProcFunctions :: dirpyr_equalizer(float ** src, float ** dst, int srcwidth, int srcheight, float ** l_a, float ** l_b, float ** dest_a, float ** dest_b,const double * mult, const double dirpyrThreshold, const double skinprot, const bool gamutlab, float b_l, float t_l, float t_r, float b_r, int choice, int scaleprev)
	{
		int lastlevel=maxlevel;
		if(settings->verbose) printf("Dirpyr scaleprev=%i\n",scaleprev);
		float atten123=(float) settings->level123_cbdl;
		if(atten123 > 50.f) atten123=50.f;
		if(atten123 < 0.f) atten123=0.f;
		float atten0=(float) settings->level0_cbdl;
		if(atten0 > 40.f) atten123=40.f;
		if(atten0 < 0.f) atten0=0.f;
		
		if((t_r-t_l)<0.55f)
			t_l = t_r + 0.55f;//avoid too small range

		
		while (lastlevel>0 && fabs(mult[lastlevel-1]-1)<0.001) {
			lastlevel--;
			//printf("last level to process %d \n",lastlevel);
		}
		if (lastlevel==0) return;
		
		int level;
		float multi[6]={1.f,1.f,1.f,1.f,1.f,1.f};
		float scalefl[6];
	
		for(int lv=0;lv<6;lv++) {
			scalefl[lv]= ((float) scales[lv])/(float) scaleprev;
			if(lv>=1) {if(scalefl[lv] < 1.f) multi[lv] = (atten123*((float) mult[lv] -1.f)/100.f)+1.f; else  multi[lv]=(float) mult[lv];}//modulate action if zoom < 100%
			else  {if(scalefl[lv] < 1.f) multi[lv] = (atten0*((float) mult[lv] -1.f)/100.f)+1.f; else  multi[lv]=(float) mult[lv];}//modulate action if zoom < 100%
			
			}
		if(settings->verbose) printf("CbDL mult0=%f  1=%f 2=%f 3=%f 4=%f 5=%f\n",multi[0],multi[1],multi[2],multi[3],multi[4],multi[5]);
		
		multi_array2D<float,maxlevel> dirpyrlo (srcwidth, srcheight);

		level = 0;
		
		//int thresh = 100 * mult[5];
		int scale = (int)(scales[level])/scaleprev;
		if(scale < 1) scale=1;

				
		dirpyr_channel(src, dirpyrlo[0], srcwidth, srcheight, 0, scale);
		
		level = 1;
		
		while(level < lastlevel)
		{
			
			scale = (int)(scales[level])/scaleprev;
			if(scale < 1) scale=1;
			
			dirpyr_channel(dirpyrlo[level-1], dirpyrlo[level], srcwidth, srcheight, level, scale);
			
			level ++;
		}
		
		float **tmpHue,**tmpChr;
		if(skinprot != 0.f) {
			// precalculate hue and chroma, use SSE, if available
			// by precalculating these values we can greatly reduce the number of calculations in idirpyr_eq_channel()
			// but we need two additional buffers for this preprocessing
			tmpHue = new float*[srcheight];
			for (int i=0; i<srcheight; i++) {
				tmpHue[i] = new float[srcwidth];
			}
#ifdef __SSE2__
#pragma omp parallel for
			for(int i=0;i<srcheight;i++) {
				int j;
				for(j=0;j<srcwidth-3;j+=4) {
					_mm_storeu_ps(&tmpHue[i][j],xatan2f(LVFU(l_b[i][j]),LVFU(l_a[i][j])));
				}
				for(;j<srcwidth;j++) {
					tmpHue[i][j] = xatan2f(l_b[i][j],l_a[i][j]);
				}
			}
#else
#pragma omp parallel for
			for(int i=0;i<srcheight;i++) {
				for(int j=0;j<srcwidth;j++) {
					tmpHue[i][j] = xatan2f(l_b[i][j],l_a[i][j]);
				}
			}
#endif
			tmpChr = new float*[srcheight];
			for (int i=0; i<srcheight; i++) {
				tmpChr[i] = new float[srcwidth];
			}
			
#ifdef __SSE2__
#pragma omp parallel
{
			__m128 div = _mm_set1_ps(327.68f);
#pragma omp for
			for(int i=0;i<srcheight;i++) {
				int j;
				for(j=0;j<srcwidth-3;j+=4) {
					_mm_storeu_ps(&tmpChr[i][j], _mm_sqrt_ps(SQRV(LVFU(l_b[i][j]))+SQRV(LVFU(l_a[i][j])))/div);
				}
				for(;j<srcwidth;j++) {
					tmpChr[i][j] = sqrtf(SQR((l_b[i][j]))+SQR((l_a[i][j])))/327.68f;
				}
			}
}
#else
#pragma omp parallel for
			for(int i=0;i<srcheight;i++) {
				for(int j=0;j<srcwidth;j++) {
					tmpChr[i][j] = sqrtf(SQR((l_b[i][j]))+SQR((l_a[i][j])))/327.68f;
				}
			}
#endif
		}

		// with the current implementation of idirpyr_eq_channel we can safely use the buffer from last level as buffer, saves some memory
		float ** buffer = dirpyrlo[lastlevel-1];
		
		for(int level = lastlevel - 1; level > 0; level--)
		{
			idirpyr_eq_channel(dirpyrlo[level], dirpyrlo[level-1], buffer, srcwidth, srcheight, level, multi, dirpyrThreshold, tmpHue, tmpChr, skinprot, gamutlab, b_l,t_l,t_r,b_r, choice );
		}

		scale = scales[0];
		
		idirpyr_eq_channel(dirpyrlo[0], dst, buffer, srcwidth, srcheight, 0, multi, dirpyrThreshold, tmpHue, tmpChr, skinprot, gamutlab, b_l,t_l,t_r,b_r, choice );

		if(skinprot != 0.f) {
			for (int i=0; i<srcheight; i++)
				delete [] tmpChr[i];
			delete [] tmpChr;
			for (int i=0; i<srcheight; i++)
				delete [] tmpHue[i];
			delete [] tmpHue;
		}

		//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
#pragma omp parallel for
		for (int i=0; i<srcheight; i++) 
			for (int j=0; j<srcwidth; j++) {
				dst[i][j] = CLIP(buffer[i][j]);  // TODO: Really a clip necessary?
			}

	}


	
	void ImProcFunctions :: dirpyr_equalizercam (CieImage *ncie, float ** src, float ** dst, int srcwidth, int srcheight, float ** h_p, float ** C_p, const double * mult, const double dirpyrThreshold, const double skinprot, bool execdir,  const bool gamutlab, float b_l, float t_l, float t_r, float b_r, int choice, int scaleprev)
	{
		int lastlevel=maxlevel;
		if(settings->verbose) printf("CAM dirpyr scaleprev=%i\n",scaleprev);
		float atten123=(float) settings->level123_cbdl;
		if(atten123 > 50.f) atten123=50.f;
		if(atten123 < 0.f) atten123=0.f;
//		printf("atten=%f\n",atten);	
		float atten0=(float) settings->level0_cbdl;
		if(atten0 > 40.f) atten123=40.f;
		if(atten0 < 0.f) atten0=0.f;

		if((t_r-t_l)<0.55f)
			t_l = t_r + 0.55f;//avoid too small range

		while (fabs(mult[lastlevel-1]-1)<0.001 && lastlevel>0) {
			lastlevel--;
			//printf("last level to process %d \n",lastlevel);
		}
		if (lastlevel==0) return;
		
		int level;
		
		float multi[6]={1.f,1.f,1.f,1.f,1.f,1.f};
		float scalefl[6];
	
		for(int lv=0;lv<6;lv++) {
			scalefl[lv]= ((float) scales[lv])/(float) scaleprev;
		//	if(scalefl[lv] < 1.f) multi[lv] = 1.f; else  multi[lv]=(float) mult[lv];
			if (lv>=1) {if(scalefl[lv] < 1.f) multi[lv] = (atten123*((float) mult[lv] -1.f)/100.f)+1.f; else  multi[lv]=(float) mult[lv];}
			else {if(scalefl[lv] < 1.f) multi[lv] = (atten0*((float) mult[lv] -1.f)/100.f)+1.f; else  multi[lv]=(float) mult[lv];}

			
			}
		if(settings->verbose) printf("CAM CbDL mult0=%f  1=%f 2=%f 3=%f 4=%f 5=%f\n",multi[0],multi[1],multi[2],multi[3],multi[4],multi[5]);
		
		
		
		
		multi_array2D<float,maxlevel> dirpyrlo (srcwidth, srcheight);

		level = 0;
		
		int scale = (int)(scales[level])/scaleprev;
		if(scale < 1) scale=1;

		dirpyr_channel(src, dirpyrlo[0], srcwidth, srcheight, 0, scale);
		
		level = 1;
		
		while(level < lastlevel)
		{
			scale = (int)(scales[level])/scaleprev;
			if(scale < 1) scale=1;

			dirpyr_channel(dirpyrlo[level-1], dirpyrlo[level], srcwidth, srcheight, level, scale);
			
			level ++;
		}
		
		
		// with the current implementation of idirpyr_eq_channel we can safely use the buffer from last level as buffer, saves some memory
		float ** buffer = dirpyrlo[lastlevel-1];
		
		for(int level = lastlevel - 1; level > 0; level--)
		{
			idirpyr_eq_channelcam(dirpyrlo[level], dirpyrlo[level-1], buffer, srcwidth, srcheight, level, multi, dirpyrThreshold , h_p, C_p, skinprot, b_l,t_l,t_r);
		}
		
		
		scale = scales[0];
		
		idirpyr_eq_channelcam(dirpyrlo[0], dst, buffer, srcwidth, srcheight, 0, multi, dirpyrThreshold,  h_p, C_p, skinprot, b_l,t_l,t_r);
		
		
		//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
		if(execdir){
#ifdef _OPENMP
#pragma omp parallel for schedule(dynamic,16)
#endif
			for (int i=0; i<srcheight; i++) 
				for (int j=0; j<srcwidth; j++) {
					if(ncie->J_p[i][j] > 8.f && ncie->J_p[i][j] < 92.f)
						dst[i][j] = CLIP( buffer[i][j] );  // TODO: Really a clip necessary?
					else
						dst[i][j]=src[i][j];
				}
		}
		else
			for (int i=0; i<srcheight; i++) 
				for (int j=0; j<srcwidth; j++) {
					dst[i][j] = CLIP( buffer[i][j] );  // TODO: Really a clip necessary?
				}
		//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
	}


SSEFUNCTION void ImProcFunctions::dirpyr_channel(float ** data_fine, float ** data_coarse, int width, int height, int level, int scale)
{
		//scale is spacing of directional averaging weights
		//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
		// calculate weights, compute directionally weighted average
		
	if(level > 1) {
		//generate domain kernel 
		int domker[5][5] = {{1,1,1,1,1},{1,2,2,2,1},{1,2,2,2,1},{1,2,2,2,1},{1,1,1,1,1}};
	//	int domker[5][5] = {{1,1,1,1,1},{1,1,1,1,1},{1,1,1,1,1},{1,1,1,1,1},{1,1,1,1,1}};
		static const int halfwin=2;
		const int scalewin = halfwin*scale;
#ifdef _OPENMP
#pragma omp parallel
#endif
{
#ifdef __SSE2__
	__m128 thousandv = _mm_set1_ps( 1000.0f );
	__m128 dirwtv, valv, normv, dftemp1v, dftemp2v;
//	multiplied each value of domkerv by 1000 to avoid multiplication by 1000 inside the loop
	float domkerv[5][5][4] __attribute__ ((aligned (16))) = {{{1000,1000,1000,1000},{1000,1000,1000,1000},{1000,1000,1000,1000},{1000,1000,1000,1000},{1000,1000,1000,1000}},{{1000,1000,1000,1000},{2000,2000,2000,2000},{2000,2000,2000,2000},{2000,2000,2000,2000},{1000,1000,1000,1000}},{{1000,1000,1000,1000},{2000,2000,2000,2000},{2000,2000,2000,2000},{2000,2000,2000,2000},{1000,1000,1000,1000}},{{1000,1000,1000,1000},{2000,2000,2000,2000},{2000,2000,2000,2000},{2000,2000,2000,2000},{1000,1000,1000,1000}},{{1000,1000,1000,1000},{1000,1000,1000,1000},{1000,1000,1000,1000},{1000,1000,1000,1000},{1000,1000,1000,1000}}};
#endif // __SSE2__

	int j;
#ifdef _OPENMP
#pragma omp for //schedule (dynamic,8)
#endif
		for(int i = 0; i < height; i++) {
			float dirwt;
			for(j = 0; j < scalewin; j++) {
				float val=0.f;
				float norm=0.f;
				
				
				for(int inbr=max(0,i-scalewin); inbr<=min(height-1,i+scalewin); inbr+=scale) {
					for (int jnbr=max(0,j-scalewin); jnbr<=j+scalewin; jnbr+=scale) {
					    //printf("i=%d ",(inbr-i)/scale+halfwin);
						dirwt = DIRWT(inbr, jnbr, i, j);
						val += dirwt*data_fine[inbr][jnbr];
						norm += dirwt;
					}
				}
				data_coarse[i][j]=val/norm;//low pass filter
			}
#ifdef __SSE2__
			for(; j < width-scalewin-3; j+=4)
			{
				valv = _mm_setzero_ps();
				normv = _mm_setzero_ps();
				dftemp1v = LVFU(data_fine[i][j]);
				for(int inbr=MAX(0,i-scalewin); inbr<=MIN(height-1,i+scalewin); inbr+=scale) {
					int indexihlp = (inbr-i)/scale+halfwin;
					for (int jnbr=j-scalewin, indexjhlp = 0; jnbr<=j+scalewin; jnbr+=scale,indexjhlp++) {
						dftemp2v = LVFU(data_fine[inbr][jnbr]);
						dirwtv = _mm_load_ps((float*)&domkerv[indexihlp][indexjhlp]) / (vabsf(dftemp1v-dftemp2v) + thousandv);
						valv += dirwtv*dftemp2v;
						normv += dirwtv;
					}
				}
				_mm_storeu_ps( &data_coarse[i][j],valv/normv);//low pass filter
			}
			for(; j < width-scalewin; j++)
			{
				float val=0.f;
				float norm=0.f;
				
				for(int inbr=max(0,i-scalewin); inbr<=min(height-1,i+scalewin); inbr+=scale) {
					for (int jnbr=j-scalewin; jnbr<=j+scalewin; jnbr+=scale) {
						dirwt = DIRWT(inbr, jnbr, i, j);
						val += dirwt*data_fine[inbr][jnbr];
						norm += dirwt;
					}
				}
				data_coarse[i][j]=val/norm;//low pass filter
			}
#else

			for(; j < width-scalewin; j++)
			{
				float val=0.f;
				float norm=0.f;
				
				for(int inbr=max(0,i-scalewin); inbr<=min(height-1,i+scalewin); inbr+=scale) {
					for (int jnbr=j-scalewin; jnbr<=j+scalewin; jnbr+=scale) {
						dirwt = DIRWT(inbr, jnbr, i, j);
						val += dirwt*data_fine[inbr][jnbr];
						norm += dirwt;
					}
				}
				data_coarse[i][j]=val/norm;//low pass filter
			}
#endif
			for(; j < width; j++)
			{
				float val=0.f;
				float norm=0.f;
				
				for(int inbr=max(0,i-scalewin); inbr<=min(height-1,i+scalewin); inbr+=scale) {
					for (int jnbr=j-scalewin; jnbr<=min(width-1,j+scalewin); jnbr+=scale) {
						dirwt = DIRWT(inbr, jnbr, i, j);
						val += dirwt*data_fine[inbr][jnbr];
						norm += dirwt;
					}
				}
				data_coarse[i][j]=val/norm;//low pass filter
			}
		}
}
	} else {	// level <=1 means that all values of domker would be 1.0f, so no need for multiplication
//		const int scalewin = scale;
#ifdef _OPENMP
#pragma omp parallel
#endif
{
#ifdef __SSE2__
	__m128 thousandv = _mm_set1_ps( 1000.0f );
	__m128 dirwtv, valv, normv, dftemp1v, dftemp2v;
#endif // __SSE2__
	int j;
#ifdef _OPENMP
#pragma omp for schedule(dynamic,16)
#endif
		for(int i = 0; i < height; i++) {
			float dirwt;
			for(j = 0; j < scale; j++)
			{
				float val=0.f;
				float norm=0.f;
				
				for(int inbr=max(0,i-scale); inbr<=min(height-1,i+scale); inbr+=scale) {
					for (int jnbr=max(0,j-scale); jnbr<=j+scale; jnbr+=scale) {
						dirwt = RANGEFN(fabsf(data_fine[inbr][jnbr]-data_fine[i][j]));
						val += dirwt*data_fine[inbr][jnbr];
						norm += dirwt;
					}
				}
				data_coarse[i][j]=val/norm;//low pass filter
			}
#ifdef __SSE2__
			for(; j < width-scale-3; j+=4)
			{
				valv = _mm_setzero_ps();
				normv = _mm_setzero_ps();
				dftemp1v = LVFU(data_fine[i][j]);
				for(int inbr=MAX(0,i-scale); inbr<=MIN(height-1,i+scale); inbr+=scale) {
					for (int jnbr=j-scale; jnbr<=j+scale; jnbr+=scale) {
						dftemp2v = LVFU(data_fine[inbr][jnbr]);
						dirwtv = thousandv / (vabsf(dftemp2v-dftemp1v) + thousandv);
						valv += dirwtv*dftemp2v;
						normv += dirwtv;
					}
				}
				_mm_storeu_ps( &data_coarse[i][j], valv/normv);//low pass filter
			}

			for(; j < width-scale; j++)
			{
				float val=0.f;
				float norm=0.f;
				
				for(int inbr=max(0,i-scale); inbr<=min(height-1,i+scale); inbr+=scale) {
					for (int jnbr=j-scale; jnbr<=j+scale; jnbr+=scale) {
						dirwt = RANGEFN(fabsf(data_fine[inbr][jnbr]-data_fine[i][j]));
						val += dirwt*data_fine[inbr][jnbr];
						norm += dirwt;
					}
				}
				data_coarse[i][j]=val/norm;//low pass filter
			}
#else

			for(; j < width-scale; j++)
			{
				float val=0.f;
				float norm=0.f;
				
				for(int inbr=max(0,i-scale); inbr<=min(height-1,i+scale); inbr+=scale) {
					for (int jnbr=j-scale; jnbr<=j+scale; jnbr+=scale) {
						dirwt = RANGEFN(fabsf(data_fine[inbr][jnbr]-data_fine[i][j]));
						val += dirwt*data_fine[inbr][jnbr];
						norm += dirwt;
					}
				}
				data_coarse[i][j]=val/norm;//low pass filter
			}
#endif
			for(; j < width; j++)
			{
				float val=0.f;
				float norm=0.f;
				
				for(int inbr=max(0,i-scale); inbr<=min(height-1,i+scale); inbr+=scale) {
					for (int jnbr=j-scale; jnbr<=min(width-1,j+scale); jnbr+=scale) {
						dirwt = RANGEFN(fabsf(data_fine[inbr][jnbr]-data_fine[i][j]));
						val += dirwt*data_fine[inbr][jnbr];
						norm += dirwt;
					}
				}
				data_coarse[i][j]=val/norm;//low pass filter
			}
		}
}
	}
}
	
	//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
	
	void ImProcFunctions::idirpyr_eq_channel(float ** data_coarse, float ** data_fine, float ** buffer, int width, int height, int level, float mult[5], const double dirpyrThreshold, float ** hue, float ** chrom, const double skinprot, const bool gamutlab, float b_l, float t_l, float t_r, float b_r , int choice)
	{
	const float skinprotneg = -skinprot;
	const float factorHard = (1.f - skinprotneg/100.f);

	float offs;
	if(skinprot==0.f)
		offs = 0.f;
	else
		offs = -1.f;
		float multbis[6];
		
		multbis[level]=mult[level];//multbis to reduce artifacts for high values mult
		if(level==4 && mult[level]> 1.f) multbis[level]=1.f+0.65f*(mult[level]-1.f);
		if(level==5 && mult[level]> 1.f) multbis[level]=1.f+0.45f*(mult[level]-1.f);
	
	LUTf irangefn (0x20000);
	{
		const float noisehi = 1.33f*noise*dirpyrThreshold/expf(level*log(3.0)), noiselo = 0.66f*noise*dirpyrThreshold/expf(level*log(3.0));
		//printf("level=%i multlev=%f noisehi=%f noiselo=%f skinprot=%f\n",level,mult[level], noisehi, noiselo, skinprot);
		
		for (int i=0; i<0x20000; i++) {
			if (abs(i-0x10000)>noisehi || multbis[level]<1.0) {
				irangefn[i] = multbis[level] + offs;
			} else {
				if (abs(i-0x10000)<noiselo) {
					irangefn[i] = 1.f + offs ;
				} else {
					irangefn[i] = 1.f + offs + (multbis[level]-1.f) * (noisehi-abs(i-0x10000))/(noisehi-noiselo+0.01f) ;
				}
			}
		}
	}

	if(skinprot==0.f)
#ifdef _OPENMP
#pragma omp parallel for schedule(dynamic,16)
#endif
		for(int i = 0; i < height; i++) {
			for(int j = 0; j < width; j++) {
				float hipass = (data_fine[i][j]-data_coarse[i][j]);
				buffer[i][j] += irangefn[hipass+0x10000] * hipass;
			}
		}
	else if(skinprot > 0.f)
#ifdef _OPENMP
#pragma omp parallel for schedule(dynamic,16)
#endif
		for(int i = 0; i < height; i++) {
			for(int j = 0; j < width; j++) {
				float scale=1.f;
				float hipass = (data_fine[i][j]-data_coarse[i][j]);
				// These values are precalculated now
				float modhue = hue[i][j];
				float modchro = chrom[i][j];
				Color::SkinSatCbdl ((data_fine[i][j])/327.68f, modhue, modchro, skinprot, scale, true, b_l, t_l, t_r);	
				buffer[i][j] += (1.f +(irangefn[hipass+0x10000])*scale) * hipass ;
			}
		}
	else
#ifdef _OPENMP
#pragma omp parallel for schedule(dynamic,16)
#endif
		for(int i = 0; i < height; i++) {
			for(int j = 0; j < width; j++) {
				float scale=1.f;
				float hipass = (data_fine[i][j]-data_coarse[i][j]);
				// These values are precalculated now
				float modhue = hue[i][j];
				float modchro = chrom[i][j];
				Color::SkinSatCbdl ((data_fine[i][j])/327.68f, modhue, modchro, skinprotneg, scale, false, b_l, t_l, t_r);	
				float correct = irangefn[hipass+0x10000];
				if (scale == 1.f) {//image hard
					buffer[i][j] += (1.f +(correct)* (factorHard)) * hipass ;
				}
				else {//image soft with scale < 1 ==> skin
					buffer[i][j] += (1.f +(correct)) * hipass ;	
				}		
			}
		}
	}
		
	
	void ImProcFunctions::idirpyr_eq_channelcam(float ** data_coarse, float ** data_fine, float ** buffer, int width, int height, int level, float mult[5], const double dirpyrThreshold, float ** l_a_h, float ** l_b_c, const double skinprot, float b_l, float t_l, float t_r)
	{

	const float skinprotneg = -skinprot;
	const float factorHard = (1.f - skinprotneg/100.f);

	float offs;
	if(skinprot==0.f)
		offs = 0.f;
	else
		offs = -1.f;
		float multbis[6];
		
		multbis[level]=mult[level];//multbis to reduce artifacts for high values mult
		if(level==4 && mult[level]> 1.f) multbis[level]=1.f+0.65f*(mult[level]-1.f);
		if(level==5 && mult[level]> 1.f) multbis[level]=1.f+0.45f*(mult[level]-1.f);
	
	LUTf irangefn (0x20000);
	{
		const float noisehi = 1.33f*noise*dirpyrThreshold/expf(level*log(3.0)), noiselo = 0.66f*noise*dirpyrThreshold/expf(level*log(3.0));
		//printf("level=%i multlev=%f noisehi=%f noiselo=%f skinprot=%f\n",level,mult[level], noisehi, noiselo, skinprot);
		for (int i=0; i<0x20000; i++) {
			if (abs(i-0x10000)>noisehi || multbis[level]<1.0) {
				irangefn[i] = multbis[level] + offs;
			} else {
				if (abs(i-0x10000)<noiselo) {
					irangefn[i] = 1.f + offs ;
				} else {
					irangefn[i] = 1.f + offs + (multbis[level]-1.f) * (noisehi-abs(i-0x10000))/(noisehi-noiselo+0.01f) ;
				}
			}
		}
	}
	if(skinprot == 0.f)
#ifdef _OPENMP
#pragma omp parallel for schedule(dynamic,16)
#endif
		for(int i = 0; i < height; i++) {
			for(int j = 0; j < width; j++) {
				float hipass = (data_fine[i][j]-data_coarse[i][j]);
				buffer[i][j] += irangefn[hipass+0x10000] * hipass ;
			}
		}
	else if(skinprot > 0.f)
#ifdef _OPENMP
#pragma omp parallel for schedule(dynamic,16)
#endif
		for(int i = 0; i < height; i++) {
			for(int j = 0; j < width; j++) {
				float hipass = (data_fine[i][j]-data_coarse[i][j]);
				float scale=1.f;
				Color::SkinSatCbdlCam ((data_fine[i][j])/327.68f, l_a_h[i][j] ,l_b_c[i][j], skinprot, scale, true, b_l, t_l, t_r);	
				buffer[i][j] += (1.f +(irangefn[hipass+0x10000])*scale) * hipass ;
			}
		}
	else
#ifdef _OPENMP
#pragma omp parallel for schedule(dynamic,16)
#endif
		for(int i = 0; i < height; i++) {
			for(int j = 0; j < width; j++) {
				float hipass = (data_fine[i][j]-data_coarse[i][j]);
				float scale=1.f;
				float correct;
				correct=irangefn[hipass+0x10000];
				Color::SkinSatCbdlCam ((data_fine[i][j])/327.68f, l_a_h[i][j],l_b_c[i][j] , skinprotneg, scale, false, b_l, t_l, t_r);	
				if (scale == 1.f) {//image hard
					buffer[i][j] += (1.f +(correct)* factorHard) * hipass ;
					
				}
				else {//image soft
					buffer[i][j] += (1.f +(correct)) * hipass ;	
				}		
			}
		}
			//	if(gamutlab) {
			//	  ImProcFunctions::badpixcam (buffer[i][j], 6.0, 10, 2);//for bad pixels
			//	}	
						
		/*		if(gamutlab) {//disabled 
				float Lprov1=(buffer[i][j])/327.68f;
				float R,G,B;
#ifdef _DEBUG
					bool neg=false;
					bool more_rgb=false;
					//gamut control : Lab values are in gamut
					Color::gamutLchonly(modhue,Lprov1,modchro, R, G, B, wip, highlight, 0.15f, 0.96f, neg, more_rgb);
#else
					//gamut control : Lab values are in gamut
					Color::gamutLchonly(modhue,Lprov1,modchro, R, G, B, wip, highlight, 0.15f, 0.96f);
#endif			
		//		Color::gamutLchonly(modhue,Lprov1,modchro, R, G, B, wip, highlight, 0.15f, 0.96f);//gamut control in Lab mode ..not in CIECAM
					buffer[i][j]=Lprov1*327.68f;
					float2 sincosval = xsincosf(modhue);
					l_a_h[i][j]=327.68f*modchro*sincosval.y;
					l_b_c[i][j]=327.68f*modchro*sincosval.x;
				}	
				*/
	}
		
			//	float hipass = (data_fine[i][j]-data_coarse[i][j]);
			//	buffer[i][j] += irangefn[hipass+0x10000] * hipass ;
	
#undef DIRWT_L
#undef DIRWT_AB
	
#undef NRWT_L	
#undef NRWT_AB	
	
}