#include "ssc.h"
#include "config.h"
//#include "DJ_SpeedPiV.h"
#include "SeamlessBufferManagement.h"
#include "ssc_macro.h"
// SBM_GAME_MODE구간과 SBM_NORMAL_MODE구간을 겹치게 한다.


/*
#define SBM_NORMAL_MODE_LOW 7    // 140ms
#define SBM_NORMAL_MODE_BASE 15  // 300ms
#define SBM_NORMAL_MODE_HIGH 20  // 400ms

#define SBM_GAME_MODE_LOW  2   // 40ms
#define SBM_GAME_MODE_BASE 5   // 100ms  
#define SBM_GAME_MODE_HIGH 8   // 160ms
*/







#ifdef ENABLE_VSP
//extern float set_vsp_speed;
extern int set_vsp_speed;
#endif


short prev_mode_info;
short sbm_current_state;  // 0 : 정상 속도, 1: 느림에서 기준점으로 오는중, 2: 빠름에서 기준점으로 오는중. 
                    
#define GAME_MODE_TARGET_BUFFER_LEVEL 5
#define NORMAL_MODE_TARGET_BUFFER_LEVEL 15

#ifdef ENABLE_VSP
int ssc_SBM_speed_setPar(int speed)
{

	if(speed<55000 || speed>75000)
	{
		return -10;
	}



	if(set_vsp_speed != speed)
	{
		SBM_SetPar(speed);
		set_vsp_speed = speed;
	}

	return 1;
}


int ssc_SBM_speed_getPar()
{
	return set_vsp_speed;
}


int ssc_SBM_getstatus()
{
	return sbm_current_state;
}

#endif



#if 0
void set_sub_apply(int current_buffer_level,short th_a, short th_b)
{
	if(current_buffer_level<th_a)
	{
		// 느리게 play
		ssc_SBM_speed_setPar( SBM_SLOW_SPEED );
		sbm_current_state = 1;
	}
	else if(current_buffer_level>th_b)
	{
		// 빠르게 play
		ssc_SBM_speed_setPar( SBM_FAST_SPEED );
		sbm_current_state = 2;
	}
	else
	{
		// 정속으로 play
		ssc_SBM_speed_setPar( SBM_NORMAL_SPEED );
		sbm_current_state = 0;
	}
}



int ssc_set_SBM_apply(int current_buffer_level, short mode_info)   // mode_info : Normal_mode : 0,  Game_mode : 1
{

	if(mode_info != prev_mode_info)
	{
		sbm_current_state = 0;  // mode가 바뀌면 state는 일단 초창기의 정속 속도 개념으로 돌아옴.
	}


	if(sbm_current_state == 0)   // 이전에 정속으로 Play 했을경우
	{
		if(mode_info == 0)
		{
	    	set_sub_apply(current_buffer_level,SBM_NORMAL_MODE_LOW,SBM_NORMAL_MODE_HIGH);
		}
		else if(mode_info == 1)
		{
			set_sub_apply(current_buffer_level,SBM_GAME_MODE_LOW,SBM_GAME_MODE_HIGH);
		}
		else
		{
			return -1;
		}

	}
	else if(sbm_current_state == 1) 
	{
		if(mode_info == 0)
		{
			set_sub_apply(current_buffer_level,SBM_NORMAL_MODE_BASE,SBM_NORMAL_MODE_HIGH);
		}
		else if(mode_info == 1)
		{
			set_sub_apply(current_buffer_level,SBM_GAME_MODE_BASE,SBM_GAME_MODE_HIGH);
		}
		else
		{
			return -2;
		}
	}
	else if(sbm_current_state == 2)
	{
		if(mode_info == 0)
		{
	 	    set_sub_apply(current_buffer_level,SBM_NORMAL_MODE_LOW,SBM_NORMAL_MODE_BASE);
		}
		else if(mode_info == 1)
		{
		    set_sub_apply(current_buffer_level,SBM_GAME_MODE_LOW,SBM_GAME_MODE_BASE);
		}
		else
		{
			return -3;
		}
	}

	prev_mode_info = mode_info;

	
	return 1;
}
#endif


// short sbm_current_state;  // 0 : 정상 속도, 1: 느림에서 기준점으로 오는중, 2: 빠름에서 기준점으로 오는중. 


//#define SBM_APPLY_SLOW_NUM 100    // Game Mode에서 Normal Mode갈때 slow해야 하는 기준 frame 갯수.
//#define SBM_APPLY_FAST_NUM 105    // Normal Mode에서 Game Mode갈때 fast해야 하는 기준 frame 갯수.


//short sbm_start_idx;   // 배감속 재생의 시작지점. sbm_current_state가 1 혹은 2일때만 유효.
//short sbm_end_idx;    // 배감속 재생의 끝지점. sbm_current_state가 1 혹은 2일때만 유효.
//short sbm_carry_idx;   //  sbm_current_state가 1 혹은 2일때만 유효.


//short sbm_internal_count;   // 배감속 재생 frame count.   sbm_current_state가 1 혹은 2일때만 유효.
//short SBM_effect_num;   // offset에 의해, SBM을 몇번 돌려야 할지 계산.

int sbm_internal_count;   // 배감속 재생 frame count.   sbm_current_state가 1 혹은 2일때만 유효.
int SBM_effect_num;   // offset에 의해, SBM을 몇번 돌려야 할지 계산.
int SBM_normal_num;


// mode_info : Normal_mode : 0,  Game_mode : 1,  
// current_idx : packet index(0~255),   Null-packet이 온 경우(PLC상황)에서는 음수로 표현하자.


#if 0
void ssc_set_SBM_apply_modi_subfunction(short current_idx, int speed)
{
	if(sbm_end_idx>sbm_start_idx)
	{
		if(current_idx>=sbm_end_idx || current_idx<sbm_start_idx)
		{
			sbm_current_state = 0;
			ssc_SBM_speed_setPar( SBM_NORMAL_SPEED );
		}
		else
		{
			ssc_SBM_speed_setPar(speed);
		}
	}
	else
	{
		if(current_idx>=sbm_end_idx && current_idx<sbm_start_idx)
		{
			sbm_current_state = 0;
			ssc_SBM_speed_setPar( SBM_NORMAL_SPEED );
		}
		else
		{
			ssc_SBM_speed_setPar(speed);
		}

	}

	sbm_internal_count++;	
}


short SBM_overflow_flag;
short mode_change_point;    // the index when mode is changed.


int ssc_set_SBM_apply_modi(int minimum_buffer_level, short mode_info, short current_idx, short ref_time_stamp)   
{

//	short sbm__end_idx;
	if(current_idx<0 || current_idx>255)
	{
		return 2;  // Packet이 Null로 와서 의미가 없는 경우, 현 상태를 그냥 유지. 그리고 정상이므로, 양수로 return.
	}

	if(mode_info != prev_mode_info)
	{
	
		SBM_overflow_flag = 0;

		if(current_idx>ref_time_stamp)
		{
			SBM_overflow_flag = 1;
		}

		if(mode_info == 1)  // Normal Mode --> Game Mode, 즉 'Fast Play' 시작.
		{
			short sbm_fast_num = (minimum_buffer_level - GAME_MODE_TARGET_BUFFER_LEVEL);
			sbm_fast_num = MAX16((sbm_fast_num*10),0);
			sbm_fast_num = MIN16(sbm_fast_num,255);

			sbm_current_state = 4;    //4

			mode_change_point = current_idx;
			sbm_start_idx = ref_time_stamp;

			sbm_end_idx = ref_time_stamp + sbm_fast_num;
			sbm_end_idx = (sbm_end_idx & 255);

			sbm_internal_count = 0;
		}
		else if(mode_info == 0) // Game Mode --> Normal Mode, 즉 Buffer를 채우기 위해 'slow speed'를 해달라는것.
		{
			short sbm_slow_num = (NORMAL_MODE_TARGET_BUFFER_LEVEL - minimum_buffer_level);
			sbm_slow_num = MAX16((sbm_slow_num*10),0);
			sbm_slow_num = MIN16(sbm_slow_num,255);

			sbm_current_state = 3;   //3

			mode_change_point = current_idx;
			sbm_start_idx = ref_time_stamp;
			sbm_end_idx = ref_time_stamp + sbm_slow_num;
			sbm_end_idx = (sbm_end_idx & 255);
			
			sbm_internal_count = 0;
		}
		else
		{
			return -1;
		}
	}
/////////////////////////////////////////////////////
	prev_mode_info = mode_info;


	                                               // sbm_current_state == 4 :  Normal Mode --> Game Mode,   sbm_current_state == 3 :  Game Mode --> Normal Mode,
	if(sbm_current_state == 4 || sbm_current_state == 3)   //  Normal-->Game 모드 신호는 받았지만, 아직 PE_SE_Communication_Time이 지나지 않은 상태.
	{
		if(SBM_overflow_flag == 0)
		{
			if(current_idx>=sbm_start_idx || current_idx<mode_change_point)
			{
				sbm_current_state = sbm_current_state-2;
			}
		}
		else if(SBM_overflow_flag == 1)
		{
			if(current_idx>=sbm_start_idx && current_idx<mode_change_point)
			{
				sbm_current_state = sbm_current_state-2;   
			}
		}
	}

	




/////////////////////////////////////////////////////////
	if(sbm_current_state == 0 || sbm_current_state == 3 || sbm_current_state == 4)
	{
		ssc_SBM_speed_setPar( SBM_NORMAL_SPEED );
	}
	else if(sbm_current_state == 1)
	{
		ssc_set_SBM_apply_modi_subfunction(current_idx,SBM_SLOW_SPEED);
	}
	else if(sbm_current_state == 2)
	{
		ssc_set_SBM_apply_modi_subfunction(current_idx,SBM_FAST_SPEED);
	}
	else
	{
		return -2;
	}

	return 1;
}

#endif








// apply_direction
// 0 : Normal speed (정상속도)  
// + : 빠른 speed (빠른 속도)
// - : 느린 speed (느린 속도)


int SBM_FAST_SPEED;
int SBM_SLOW_SPEED;

int ssc_set_SBMspeed_test(int low_speed, int high_speed,int normal_num)
{

	SBM_FAST_SPEED = high_speed;
	SBM_SLOW_SPEED = low_speed;

	SBM_normal_num = normal_num;

	return 1;
}

#if 0
int ssc_sbm_interface(short apply_direction, short offsets)
{

	if(apply_direction>0)   // sbm_current_state
	{
//		if(sbm_current_state == 0 || sbm_current_state == 1 || sbm_current_state == 2)   // 추후에 case 별로 분화하자. 합쳐진건 기본Format
		if(sbm_current_state == 0)
		{	
			sbm_current_state = 2;  // Normal --> Fast
			SBM_effect_num = MAX16(( (offsets*100)/ (((SBM_FAST_SPEED - SBM_NORMAL_SPEED)*100+32768)>>16) ),0);   // (SBM_FAST_SPEED - SBM_NORMAL_SPEED)
	//		SBM_effect_num = MIN16(SBM_effect_num,255);
			SBM_effect_num = MIN16(SBM_effect_num,1500);
		}
////////////////////////////////////////////////////////
//		sbm_debug_param[3] = 1;
///////////////////////////////////////////////////////////
	}
	else if(apply_direction<0)
	{
//		if(sbm_current_state == 0 || sbm_current_state == 1 || sbm_current_state == 2)   // 추후에 case 별로 분화하자. 합쳐진건 기본Format
		if(sbm_current_state == 0)
		{
			sbm_current_state = 1;  // Normal --> slow
			SBM_effect_num = MAX16(( (offsets*100)/(((SBM_NORMAL_SPEED - SBM_SLOW_SPEED)*100+32768)>>16) ),0);   // (SBM_FAST_SPEED - SBM_NORMAL_SPEED)
	//		SBM_effect_num = MIN16(SBM_effect_num,255);
			SBM_effect_num = MIN16(SBM_effect_num,1500);
		}
////////////////////////////////////////////////////////
//		sbm_debug_param[3] = -1;
///////////////////////////////////////////////////////////
	}



//	prev_mode_info = apply_direction;

	if(sbm_current_state == 0)
	{
		ssc_SBM_speed_setPar( SBM_NORMAL_SPEED );
		SBM_effect_num = 0;
		sbm_internal_count = 0;

	//	sbm_debug_param[0] = 0;

	}
	else if(sbm_current_state == 1)  // slow
	{		
		sbm_internal_count++;
		ssc_SBM_speed_setPar( SBM_SLOW_SPEED ); 
		if(sbm_internal_count>=SBM_effect_num)
		{
			sbm_current_state = 0;
		}

	//	sbm_debug_param[0] = 1;

	}
	else if(sbm_current_state == 2)  // fast
	{
		sbm_internal_count++;
		ssc_SBM_speed_setPar( SBM_FAST_SPEED );
		if(sbm_internal_count>=SBM_effect_num)
		{
			sbm_current_state = 0;
		}
////////////////////////////////////////////////
	//	sbm_debug_param[0] = 2;
////////////////////////////////////////////////
	}
	else
	{
		return -2;
////////////////////////////////////////////////
	//	sbm_debug_param[0] = -2;
////////////////////////////////////////////////
	}


	//sbm_debug_param[1] = SBM_effect_num;
//	sbm_debug_param[2] = sbm_internal_count;


	return 1;

}
#else

/*
#define SBM_FAST_SPEED 67380   // 840        // 67350 ~67400  : 
#define SBM_SLOW_SPEED 63730   // 888        //  63700  ~ 63750
*/
/*
#define SBM_FAST_SPEED 66100   // 856   66080 ~ 66140
#define SBM_SLOW_SPEED 64920   // 872    64880  64920
*/

/////////////////////////  5.54%  /////////////////////////
//#define SBM_FAST_SPEED 69350    // 816   69310 69390
//#define SBM_SLOW_SPEED 62070    // 912     62020  62070
/////////////////////////////////////////////////////


#define SBM_EFFECT_NUM_Offset 0
int calc_SBM_effect_num(short apply_direction, short offsets)
{
	int SBM_effect_num = 0;

	if(apply_direction>0)
	{
		if(SBM_FAST_SPEED>=66700 && SBM_FAST_SPEED<=66760)                     
		{
			SBM_effect_num = (54*offsets);    // 1.87% case   //   (16*54)/44100  =  
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;   // 5는 game mode 오고, 5 frame후에 실제 frame 줄어들음
		}
		else if(SBM_FAST_SPEED>=67350 && SBM_FAST_SPEED<=67400)
		{
			SBM_effect_num = (36*offsets);    // 2.76% case   //  (24*36)/44100  =  
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_FAST_SPEED>=69310 && SBM_FAST_SPEED<=69390)
		{
			SBM_effect_num = (18*offsets);    // 5.52%    //   (48*18)/44100  =  0.196
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_FAST_SPEED>=66080 && SBM_FAST_SPEED<=66140)
		{
			SBM_effect_num = (108*offsets);    // 0.92% case
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_FAST_SPEED>=67980 && SBM_FAST_SPEED<=68050)   ////67980  ~ 68050   -32 sample
		{
			SBM_effect_num = (27*offsets);    // 3.68% case
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_FAST_SPEED>=68640 && SBM_FAST_SPEED<=68710)   ////68640     68710   -40 sample
		{
			SBM_effect_num = ((43*offsets)>>1);    // 4.6% case
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else
		{
			SBM_effect_num = MAX16(( (offsets*100)/ (((SBM_FAST_SPEED - SBM_NORMAL_SPEED)*100+32768)>>16) ),0);   // (SBM_FAST_SPEED - SBM_NORMAL_SPEED)
			SBM_effect_num = MIN16(SBM_effect_num,1500);
		}
	}
	else if(apply_direction<0)
	{
		if(SBM_SLOW_SPEED>=64280 && SBM_SLOW_SPEED<=64340)   // //64280 ~ 64340
		{
			SBM_effect_num = (54*offsets);    // 1.87% case
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_SLOW_SPEED>=63700 && SBM_SLOW_SPEED<=63750)   // ////  63700  ~ 63750
		{
			SBM_effect_num = (36*offsets);    // 2.76% case
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_SLOW_SPEED>=62020 && SBM_SLOW_SPEED<=62070)   // ////  63700  ~ 63750
		{
			SBM_effect_num = (18*offsets);    // 5.52%
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_SLOW_SPEED>=64880 && SBM_SLOW_SPEED<=64920)
		{
			SBM_effect_num = (108*offsets);    // 0.92% case
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_SLOW_SPEED>=63140 && SBM_SLOW_SPEED<=63190)   //  //  63140 63190
		{
			SBM_effect_num = (27*offsets);    // 3.68% case
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else if(SBM_SLOW_SPEED>=62570 && SBM_SLOW_SPEED<=62630)   //  //  62570     62630  +40 sample
		{
			SBM_effect_num = ((43*offsets)>>1);    // 4.6% case
			SBM_effect_num = SBM_effect_num + SBM_EFFECT_NUM_Offset;
		}
		else
		{
			SBM_effect_num = MAX16(( (offsets*100)/(((SBM_NORMAL_SPEED - SBM_SLOW_SPEED)*100+32768)>>16) ),0);   // (SBM_FAST_SPEED - SBM_NORMAL_SPEED)
			SBM_effect_num = MIN16(SBM_effect_num,1500);
		}
	}


	return SBM_effect_num;
}


int ssc_sbm_interface(short apply_direction, short offsets)
{


#ifdef ENABLE_VSP
	if(apply_direction>0)   // sbm_current_state  // 빠르게 재생 요청.
	{
		if(sbm_current_state == 0)
		{	
			sbm_current_state = 2;  // Normal --> Fast	
			SBM_effect_num = calc_SBM_effect_num(apply_direction,offsets);
			sbm_internal_count = 0;
		}
		else if(sbm_current_state == 1 || sbm_current_state == 4)  // Slow 재생하고 있는데 빠른 재생 요청.....
		{
			sbm_current_state = 3;

			SBM_effect_num = calc_SBM_effect_num(apply_direction,offsets);
			SBM_effect_num = SBM_effect_num + SBM_normal_num;
			sbm_internal_count = 0;
		}
	}
	else if(apply_direction<0)    // 느리게 재생 요청.
	{
		//		if(sbm_current_state == 0 || sbm_current_state == 1 || sbm_current_state == 2)   // 추후에 case 별로 분화하자. 합쳐진건 기본Format
		//  64280 ~ 64340
		if(sbm_current_state == 0)
		{
			sbm_current_state = 1;  // Normal --> slow
			SBM_effect_num = calc_SBM_effect_num(apply_direction,offsets);
			sbm_internal_count = 0;
		}
		else if(sbm_current_state == 2 || sbm_current_state == 3)
		{
			sbm_current_state = 4;

			SBM_effect_num = calc_SBM_effect_num(apply_direction,offsets);
			SBM_effect_num = SBM_effect_num + SBM_normal_num;
			sbm_internal_count = 0;
		}
	}

	//	prev_mode_info = apply_direction;
	if(sbm_current_state == 0)
	{
		ssc_SBM_speed_setPar( SBM_NORMAL_SPEED );
		SBM_effect_num = 0;
		sbm_internal_count = 0;
		//	sbm_debug_param[0] = 0;
	}
	else if(sbm_current_state == 1)  // slow
	{		
		sbm_internal_count++;
		ssc_SBM_speed_setPar( SBM_SLOW_SPEED ); 
		if(sbm_internal_count>=SBM_effect_num)
		{
			sbm_current_state = 0;
		}
	}
	else if(sbm_current_state == 2)  // fast
	{
		sbm_internal_count++;
		ssc_SBM_speed_setPar( SBM_FAST_SPEED );
		if(sbm_internal_count>=SBM_effect_num)
		{
			sbm_current_state = 0;
		}
		////////////////////////////////////////////////
		//	sbm_debug_param[0] = 2;
		////////////////////////////////////////////////
	}
	else if(sbm_current_state == 3)  // fast
	{
		sbm_internal_count++;

		if(sbm_internal_count<SBM_normal_num)
		{
			ssc_SBM_speed_setPar( SBM_NORMAL_SPEED );
		}
		else if(sbm_internal_count<SBM_effect_num)
		{
			ssc_SBM_speed_setPar( SBM_FAST_SPEED );
		}
		else if(sbm_internal_count>=SBM_effect_num)
		{
			sbm_current_state = 0;
		}
	}
	else if(sbm_current_state == 4)  // fast
	{
		sbm_internal_count++;

		if(sbm_internal_count<SBM_normal_num)
		{
			ssc_SBM_speed_setPar( SBM_NORMAL_SPEED );
		}
		else if(sbm_internal_count<SBM_effect_num)
		{
			ssc_SBM_speed_setPar( SBM_SLOW_SPEED );
		}
		else if(sbm_internal_count>=SBM_effect_num)
		{
			sbm_current_state = 0;
		}

	}
	else
	{
		return -2;
		////////////////////////////////////////////////
		//	sbm_debug_param[0] = -2;
		////////////////////////////////////////////////
	}
#endif
	//sbm_debug_param[1] = SBM_effect_num;
	//	sbm_debug_param[2] = sbm_internal_count;
	return sbm_current_state;

}

#endif