#include "sys_config.h"
#include "typesdef.h"
#include "lib/video/dvp/cmos_sensor/csi.h"
#include "tx_platform.h"
#include "list.h"
#include "dev.h"
#include "hal/i2c.h"


#if DEV_SENSOR_GC0308


SENSOR_INIT_SECTION static const unsigned char GC0308InitTable[CMOS_INIT_LEN]=
{
// 	0xFE,0x80,
// 	0xFE,0x00, //page 0
// 	0xD2,0x10, //dis AEC
// 	0x22,0x55, //dis AWB
// 	0x5A,0x56,
// 	0x5B,0x40,
// 	0x5C,0x4A,
// 	// 0x22,0x57, //en AWB
// 	0x01,0xCE,
// 	0x02,0x70,
// 	0x0F,0x00,
// 	0xE2,0x00,
// 	0xE3,0x96,
// 	0xE4,0x02,
// 	0xE5,0x58,
// 	0xE6,0x02,
// 	0xE7,0x58,
// 	0xE8,0x02,
// 	0xE9,0x58,
// 	0xEA,0x0C,
// 	0xEB,0xBE,
// 	0xEC,0x20,
// 	0x05,0x00,
// 	0x06,0x00,
// 	0x07,0x00,
// 	0x08,0x00,
// 	0x09,0x01,
// 	0x0A,0xE8,
// 	0x0B,0x02,
// 	0x0C,0x88,
// 	0x0D,0x02,
// 	0x0E,0x02,
// 	0x10,0x22,
// 	0x11,0xFD,
// 	0x12,0x2A,    
// 	0x13,0x00,
// 	0x14,0x10,
// 	0x15,0x0A,
// 	0x16,0x05,
// 	0x17,0x01,
// 	0x18,0x44,
// 	0x19,0x44,
// 	0x1A,0x1E,
// 	0x1B,0x00,
// 	0x1C,0xC1,
// 	0x1D,0x08,
// 	0x1E,0x60,
// 	0x1F,0x16,
// 	0x20,0xFF, //en rgb_gamma¡¢CC
// 	// 0x20,0x9f, //dis rgb_gamma¡¢CC
// 	0x21,0xF8, //dis y_gamma            
// 	// 0x21,0xFA, //en y_gamma             
// 	0x22,0x57, //en AWB
// 	0x24,0xA2,
// 	0x25,0x0F,    
// 	0x26,0x03,
// 	0x2F,0x01,     
// 	0x30,0xf7,
// 	0x31,0x50,
// 	0x32,0x00,     
// 	0x39,0x04,
// 	0x3A,0x18,
// 	0x3B,0x20,
// 	0x3C,0x00,
// 	0x3D,0x00,
// 	0x3E,0x00,
// 	0x3F,0x00,
// 	0x50,0x10,
// 	0x53,0x82,
// 	0x54,0x80,
// 	0x55,0x80,
// 	0x56,0x82,
// 	0x57,0x80,
// 	0x58,0x80,
// 	0x59,0x80,
// 	0x8B,0x40,
// 	0x8C,0x40,
// 	0x8D,0x40,
// 	0x8E,0x2E,
// 	0x8F,0x2E,
// 	0x90,0x2E,
// 	0x91,0x3C,
// 	0x92,0x50,
// 	0x5D,0x12,
// 	0x5E,0x1A,
// 	0x5F,0x24,
// 	0x60,0x07,
// 	0x61,0x15,
// 	0x62,0x08,
// 	0x64,0x03,
// 	0x66,0xE8,
// 	0x67,0x86,
// 	0x68,0xA2,
// 	0x69,0x18,
// 	0x6A,0x0F,
// 	0x6B,0x00,
// 	0x6C,0x5F,
// 	0x6D,0x8F,
// 	0x6E,0x55,
// 	0x6F,0x38,
// 	0x70,0x15,
// 	0x71,0x33,
// 	0x72,0xDC,
// 	0x73,0x80,
// 	0x74,0x02,
// 	0x75,0x3F,
// 	0x76,0x02,
// 	0x77,0x36,
// 	0x78,0x88,
// 	0x79,0x81,
// 	0x7A,0x81,
// 	0x7B,0x22,
// 	0x7C,0xFF,
//   /****CCM****/
// 	0x93,0x48,
// 	0x94,0x00,
// 	0x95,0x05,
// 	0x96,0xE8,
// 	0x97,0x40,
// 	0x98,0xF0,    
//   /****CCM****/
// 	0xB1,0x30, //Cb?saturation
// 	0xB2,0x30, //Cr?saturation
// 	0xBD,0x38,
// 	0xBE,0x36,
// 	0xD0,0xC9,
// 	0xD1,0x10,
// 	0xD3,0x40, //Target Y
// 	0xD5,0xF2,
// 	0xD6,0x16,
// 	0xDB,0x92,
// 	0xDC,0xA5,
// 	0xDF,0x23,
// 	0xD9,0x00,
// 	0xDA,0x00,
// 	0xE0,0x09,
// 	0xEC,0x20,
// 	0xED,0x04,
// 	0xEE,0xA0,
// 	0xEF,0x40,
// 	0x80,0x03,
// 	0x80,0x03,
// /**rgb gamma table**/
// 	0x9F,0x0B, 
// 	0xA0,0x16,
// 	0xA1,0x29,
// 	0xA2,0x3C,
// 	0xA3,0x4F,
// 	0xA4,0x5F,
// 	0xA5,0x6F,
// 	0xA6,0x8A,
// 	0xA7,0x9F,
// 	0xA8,0xB4,
// 	0xA9,0xC6,
// 	0xAA,0xD3,
// 	0xAB,0xDD,
// 	0xAC,0xE5,
// 	0xAD,0xF1,
// 	0xAE,0xFA,
// 	0xAF,0xFF,
// /**rgb gamma table**/
// /***y gamma table***/	
// 	0xC0,0x00,
// 	0xC1,0x35,
// 	0xC2,0x49,
// 	0xC3,0x64,
// 	0xC4,0x78,      
// 	0xC5,0x88,
// 	0xC6,0x97,
// 	0xC7,0xa4,
// 	0xC8,0xbb,
// 	0xC9,0xce,
// 	0xCA,0xe0,
// 	0xCB,0xf0,     
// 	0xCC,0xFF,
// /***y gamma table***/	
// 	0xF0,0x02,
// 	0xF1,0x01,
// 	0xF2,0x01,
// 	0xF3,0x30,
// 	0xF9,0x9F,
// 	0xFA,0x78,
// 	0xFE,0x01, //page 1
// 	0x00,0xF5,
// 	0x02,0x1A,
// 	0x0A,0xA0,
// 	0x0B,0x60,
// 	0x0C,0x08,
// 	0x0E,0x4C,
// 	0x0F,0x39,
// 	0x11,0x3F,
// 	0x12,0x72,
// 	0x13,0x13,
// 	0x14,0x42,
// 	0x15,0x43,
// 	0x16,0xC2,
// 	0x17,0xA8,
// 	0x18,0x18,
// 	0x19,0x40,
// 	0x1A,0xD0,
// 	0x1B,0xF5,
// 	0x70,0x40,
// 	0x71,0x58,
// 	0x72,0x30,
// 	0x73,0x48,
// 	0x74,0x20,
// 	0x75,0x60,
// 	0x77,0x20,
// 	0x78,0x32,
// 	0x30,0x03,
// 	0x31,0x40,
// 	0x32,0xE0,
// 	0x33,0xE0,
// 	0x34,0xE0,
// 	0x35,0xB0,
// 	0x36,0xC0,
// 	0x37,0xC0,
// 	0x38,0x04,
// 	0x39,0x09,
// 	0x3A,0x12,
// 	0x3B,0x1C,
// 	0x3C,0x28,
// 	0x3D,0x31,
// 	0x3E,0x44,
// 	0x3F,0x57,
// 	0x40,0x6C,
// 	0x41,0x81,
// 	0x42,0x94,
// 	0x43,0xA7,
// 	0x44,0xB8,
// 	0x45,0xD6,
// 	0x46,0xEE,
// 	0x47,0x0D,
// 	0xFE,0x00, //page 0
// 	0xD2,0x90, //en AEC
// 	0xFE,0x00, //page 0
// 	0x10,0x26,
// 	0x11,0x0D,
// 	0x1A,0x2A,
// 	0x1C,0x49,    
// 	0x1D,0x9A,
// 	0x1E,0x61,
// 	0x3A,0x20,
// 	0x50,0x14,
// 	0x53,0x80,
// 	0x56,0x80,
// 	0x8B,0x20,
// 	0x8C,0x20,
// 	0x8D,0x20,
// 	0x8E,0x14,
// 	0x8F,0x10,
// 	0x90,0x14,
// 	0x94,0x02,
// 	0x95,0x07,
// 	0x96,0xE0,
// 	0xB1,0x38, //Cb?saturation
// 	0xB2,0x38, //Cr?saturation
// 	0xB3,0x40, //Luma_contrast
// 	0xB6,0xE0,
// 	0xD0,0xCB,
// 	0xD3,0x45, //Target Y              
// 	0xF2,0x02,
// 	0xF7,0x12,
// 	0xF8,0x0A,
// 	0xFE,0x01, //page 1
// 	0x02,0x20,     
// 	0x04,0x10,
// 	0x05,0x08,
// 	0x06,0x20,
// 	0x08,0x0A,
// 	0x0E,0x44,
// 	0x0F,0x32,
// 	0x10,0x41,
// 	0x11,0x37,
// 	0x12,0x22,
// 	0x13,0x19,
// 	0x14,0x44,
// 	0x15,0x44,
// 	0x19,0x50,     
// 	0x1A,0xD8,
// 	0x32,0x10,
// 	0x35,0x00,
// 	0x36,0x80,
// 	0x37,0x00,
// 	0xFE,0x00, //page 0
// 	0x14,0x10,    

	0xFE,0x80,
	0xFE,0x00, //page 0
	0xD2,0x10, //dis AEC
	0x22,0x35, //dis AWB
	0x5A,0x50,
	0x5B,0x40,
	0x5C,0x4A,
	// 0x22,0x37, //en AWB
	0x01,0xDD,
	0x02,0x18,
	0x0F,0x00,
	0x03,0x01,
	0x04,0x2C,	
	0xE3,0x61,
	0xE4,0x01,
	0xE5,0xE5,
	0xE6,0x01,
	0xE7,0xE5,
	0xE8,0x01,
	0xE9,0xE5,
	0xEA,0x01,
	0xEB,0xE5,
	0x05,0x00,
	0x06,0x00,
	0x07,0x00,
	0x08,0x00,
	0x09,0x01,
	0x0A,0xE8,
	0x0B,0x02,
	0x0C,0x88,
	0x0D,0x02,
	0x0E,0x02,
	0x10,0x22,
	0x11,0xFD,
	0x12,0x2A,
	0x13,0x00,
	0x14,0x10,
	0x15,0x0A,
	0x16,0x05,
	0x17,0x01,
	0x18,0x44,
	0x19,0x44,
	0x1A,0x1E,
	0x1B,0x00,
	0x1C,0xC1,
	0x1D,0x08,
	0x1E,0x60,
	0x1F,0x16,
	0x20,0xFF, //en rgb_gamma¡¢CC
	0x21,0xF8, //dis y_gamma
	0x22,0x57, //en AWB
	// 0x22,0x55, //dis AWB     
	0x23,0x00,
	0x24,0xA2,
	0x25,0x0F,
	0x26,0x03,
	0x2F,0x01,
	0x30,0xF7,
	0x31,0x50,
	0x32,0x00,
	0x39,0x04,
	0x3A,0x18,
	0x3B,0x20,
	0x3C,0x00,
	0x3D,0x00,
	0x3E,0x00,
	0x3F,0x00,
	0x50,0x10,
	0x53,0x82,
	0x54,0x80,
	0x55,0x80,
	0x56,0x82,
	0x8B,0x40,
	0x8C,0x40,
	0x8D,0x40,
	0x8E,0x2E,
	0x8F,0x2E,
	0x90,0x2E,
	0x91,0x3C,
	0x92,0x50,
	0x5D,0x12,
	0x5E,0x1A,
	0x5F,0x24,
	0x60,0x07,
	0x61,0x15,
	0x62,0x08,
	0x64,0x03,
	0x66,0xE8,
	0x67,0x86,
	0x68,0xA2,
	0x69,0x18,
	0x6A,0x0F,
	0x6B,0x00,
	0x6C,0x5F,
	0x6D,0x8F,
	0x6E,0x65,
	0x6F,0x48,
	0x70,0x15,
	0x71,0x33,
	0x72,0xDC,
	0x73,0x80,
	0x74,0x02,
	0x75,0x3F,
	0x76,0x02,
	0x77,0x36,
	0x78,0x88,
	0x79,0x81,
	0x7A,0x81,
	0x7B,0x22,
	0x7C,0xFF,
  /****CCM****/
	0x93,0x48,
	0x94,0x00,
	0x95,0x05,
	0x96,0xE8,
	0x97,0x40,
	0x98,0xF0,
  /****CCM****/
	0xBD,0x38,
	0xBE,0x36,
	0xD0,0xC9,
	0xD1,0x10,
	0xD3,0x50, //Target Y
	0xD5,0xF2,
	0xD6,0x16,
	0xDB,0x92,
	0xDC,0xA5,
	0xDF,0x23,
	0xD9,0x00,
	0xDA,0x00,
	0xE0,0x09,
	0xED,0x04,
	0xEE,0xA0,
	0xEF,0x40,
	0x80,0x03,
	0x80,0x03,
/**rgb gamma table**/
	0x9F,0x15,
	0xA0,0x2A,
	0xA1,0x4A,
	0xA2,0x67,
	0xA3,0x79,
	0xA4,0x8C,
	0xA5,0x9A,
	0xA6,0xB3,
	0xA7,0xC5,
	0xA8,0xD5,
	0xA9,0xDF,
	0xAA,0xE8,
	0xAB,0xEE,
	0xAC,0xF3,
	0xAD,0xFA,
	0xAE,0xFD,
	0xAF,0xFF,
/**rgb gamma table**/
/***y gamma table***/	
	0xC0,0x00,
	0xC1,0x10,
	0xC2,0x1C,
	0xC3,0x30,
	0xC4,0x43,
	0xC5,0x54,
	0xC6,0x65,
	0xC7,0x75,
	0xC8,0x93,
	0xC9,0xB0,
	0xCA,0xCB,
	0xCB,0xE6,
	0xCC,0xFF,
/***y gamma table***/	
	0xF0,0x02,
	0xF1,0x01,
	0xF2,0x01,
	0xF3,0x30,
	0xF9,0x9F,
	0xFA,0x78,
	0xFE,0x01, //page 1
	0x00,0xF5,
	0x0A,0xA0,
	0x0B,0x60,
	0x0C,0x08,
	0x0E,0x4C,
	0x0F,0x39,
	0x11,0x3F,
	0x12,0x72,
	0x13,0x13,
	0x14,0x42,
	0x15,0x43,
	0x16,0xC2,
	0x17,0xA8,
	0x18,0x18,
	0x19,0x40,
	0x1A,0xD0,
	0x1B,0xF5,
	0x70,0x40,
	0x71,0x58,
	0x72,0x30,
	0x73,0x48,
	0x74,0x20,
	0x75,0x60,
	0x77,0x20,
	0x78,0x32,
	0x30,0x03,
	0x31,0x40,
	0x32,0xE0,
	0x33,0xE0,
	0x34,0xE0,
	0x35,0xB0,
	0x36,0xC0,
	0x37,0xC0,
	0x38,0x04,
	0x39,0x09,
	0x3A,0x12,
	0x3B,0x1C,
	0x3C,0x28,
	0x3D,0x31,
	0x3E,0x44,
	0x3F,0x57,
	0x40,0x6C,
	0x41,0x81,
	0x42,0x94,
	0x43,0xA7,
	0x44,0xB8,
	0x45,0xD6,
	0x46,0xEE,
	0x47,0x0D,
	0xFE,0x00, //page 0
	0xD2,0x90, //en AEC
	0xFE,0x00, //page 0
	0x10,0x26,
	0x11,0x0D,
	0x1A,0x2A,
	0x1C,0x49,
	0x1D,0x9A,
	0x1E,0x61,
	0x3A,0x20,
	0x50,0x14,
	0x53,0x80,
	0x56,0x80,
	0x94,0x02,
	0x95,0x07,
	0x96,0xE0,
	0xB0,0x40,
	0xB1,0x58,
	0xB2,0x58,
	0xB3,0x40,
	0xB5,0x00,
	0xB6,0xE0,
	0xD0,0xCB,
	0xD3,0x50,
	0xF2,0x02,
	0xF7,0x12,
	0xF8,0x0A,
	0x9C,0x00,
	0x9D,0x00,
	0x9E,0x03,
	0x59,0x84,
	0x57,0x80,      
	0x58,0x7B,
	0x59,0x78,
	0xFE,0x01, //page 1
	0x02,0x20,
	0x04,0x10,
	0x05,0x08,
	0x06,0x20,
	0x08,0x0A,
	0x0E,0x44,
	0x0F,0x32,
	0x10,0x41,
	0x11,0x37,
	0x12,0x22,
	0x13,0x39,      
	0x14,0x44,
	0x15,0x44,
	0x19,0x50,      
	0x1A,0xD8,
	0x1C,0x80, //AWB r_gain_limit     
	0x1D,0x80, //AWB g_gain_limit      
	0x1E,0x80, //AWB b_gain_limit 
	0x32,0x10,
	0x35,0x00,
	0x36,0x80,
	0x37,0x00,
	0xFE,0x00, //page 0
	0x01,0xDD,
	0x02,0x18,
	0x0F,0x00,
	0x03,0x01,
	0x04,0x2C,
	0xE2,0x00,
	0xE3,0x61,
	0xE4,0x01,
	0xE5,0xE5,
	0xE6,0x01,     
	0xE7,0xE5,
	0xE8,0x01,
	0xE9,0xE5,
	0xEA,0x01,
	0xEB,0xE5,
	0x14,0x10,
		-1,-1,
};     

extern struct i2c_device *iic_test;

static void GC0308_rotate(uint32 r)
{
	int8 buf[2];
	buf[0] = 0x14;		//0',180'
	buf[1] = 0x10|(r<<0);
	//Sensor_WriteRegister(SENSOR_IIC,buf,1,1);
	//i2c_sensor_write(iic_test,buf,1,1,0x42,0x43);
	i2c_write(iic_test,buf,1,&buf[1],1);
	

}



uint32 GC0308_hvblank(int8 dh,int8 dv)
{
#define HBLANK_BASE	0x6aUL
#define VBLANK_BASE	0x12UL
	uint32 i;
	int32 h = (int32)HBLANK_BASE + dh; if(h < 0) h = 0;
	int32 v = (int32)VBLANK_BASE + dv; if(v < 0) v = 0;
	const uint8 t[][2] = {
		{0x01,h & 0xff},//0x6a//0xde //HB[7:0]
		{0x02,v & 0xff},  //0x0c //VB[7:0]
		{0x0f,((v >> 8)<<4)|(h >> 8)} //{0x0f,0x00}, //VB/HB [11:8]
	};
	
	//for(i=0;i<3;i++)
		//Sensor_WriteRegister(SENSOR_IIC,(uint8 *)&t[i][0],1,1);
	for(i=0;i<3;i++)	
		//i2c_sensor_write(iic_test,(uint8 *)&t[i][0],1,1,0x42,0x43);
		i2c_write(iic_test,(int8 *)&t[i][0],1,(int8 *)&t[i][1],1);

	return (h<<16)|v;
}

SENSOR_OP_SECTION const _Sensor_Adpt_ gc0308_cmd= 
{
	.typ = 1, //YUV
	.pixelw = 640,
	.pixelh= 480,
	.hsyn = 1,
	.vsyn = 1,
	.rduline = 0,//
	.rawwide = 1,//10bit
	.colrarray = 2,//0:_RGRG_ 1:_GRGR_,2:_BGBG_,3:_GBGB_
	.init = (uint8 *)GC0308InitTable,
	.rotate_adapt = {0},
	//.hvb_adapt = {0x6a,0x12,0x6a,0x12},
	. mclk = 24000000,
	.p_fun_adapt = {GC0308_rotate,GC0308_hvblank,NULL},
	.p_xc7016_adapt = {NULL},	
};

const _Sensor_Ident_ gc0308_init=
{
	0x9b,0x42,0x43,0x01,0x01,0x00
};



#endif