362 lines
4.9 KiB
C
362 lines
4.9 KiB
C
|
|
#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,
|
||
|
|
0xD2,0x10,
|
||
|
|
0x22,0x55,
|
||
|
|
0x5A,0x56,
|
||
|
|
0x5B,0x40,
|
||
|
|
0x5C,0x4A,
|
||
|
|
0x22,0x57,
|
||
|
|
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,
|
||
|
|
0x21,0xF8,
|
||
|
|
0x22,0x57,
|
||
|
|
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,
|
||
|
|
0x93,0x48,
|
||
|
|
0x94,0x00,
|
||
|
|
0x95,0x05,
|
||
|
|
0x96,0xE8,
|
||
|
|
0x97,0x40,
|
||
|
|
0x98,0xF0,
|
||
|
|
0xB1,0x38,
|
||
|
|
0xB2,0x38,
|
||
|
|
0xBD,0x38,
|
||
|
|
0xBE,0x36,
|
||
|
|
0xD0,0xC9,
|
||
|
|
0xD1,0x10,
|
||
|
|
0xD3,0x80,
|
||
|
|
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,
|
||
|
|
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,
|
||
|
|
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,
|
||
|
|
0xF0,0x02,
|
||
|
|
0xF1,0x01,
|
||
|
|
0xF2,0x01,
|
||
|
|
0xF3,0x30,
|
||
|
|
0xF9,0x9F,
|
||
|
|
0xFA,0x78,
|
||
|
|
0xFE,0x01,
|
||
|
|
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,
|
||
|
|
0xD2,0x90,
|
||
|
|
0xFE,0x00,
|
||
|
|
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,0x40,
|
||
|
|
0xB2,0x40,
|
||
|
|
0xB3,0x40,
|
||
|
|
0xB6,0xE0,
|
||
|
|
0xD0,0xCB,
|
||
|
|
0xD3,0x48,
|
||
|
|
0xF2,0x02,
|
||
|
|
0xF7,0x12,
|
||
|
|
0xF8,0x0A,
|
||
|
|
0xFE,0x01,
|
||
|
|
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,
|
||
|
|
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
|
||
|
|
|