2 #include "generic_sensor.h"
\r
4 * Driver Version Note
\r
5 *v0.0.1: this driver is compatible with generic_sensor
\r
7 * add sensor_focus_af_const_pause_usr_cb;
\r
9 static int version = KERNEL_VERSION(0,0,3);
\r
10 module_param(version, int, S_IRUGO);
\r
15 module_param(debug, int, S_IRUGO|S_IWUSR);
\r
17 #define dprintk(level, fmt, arg...) do { \
\r
18 if (debug >= level) \
\r
19 printk(KERN_WARNING fmt , ## arg); } while (0)
\r
21 /* Sensor Driver Configuration Begin */
\r
22 #define SENSOR_NAME RK29_CAM_SENSOR_GC0308
\r
23 #define SENSOR_V4L2_IDENT V4L2_IDENT_GC0308
\r
24 #define SENSOR_ID 0x9b
\r
25 #define SENSOR_BUS_PARAM (SOCAM_MASTER |\
\r
26 SOCAM_PCLK_SAMPLE_RISING|SOCAM_HSYNC_ACTIVE_HIGH| SOCAM_VSYNC_ACTIVE_LOW|\
\r
27 SOCAM_DATA_ACTIVE_HIGH | SOCAM_DATAWIDTH_8 |SOCAM_MCLK_24MHZ)
\r
28 #define SENSOR_PREVIEW_W 640
\r
29 #define SENSOR_PREVIEW_H 480
\r
30 #define SENSOR_PREVIEW_FPS 15000 // 15fps
\r
31 #define SENSOR_FULLRES_L_FPS 7500 // 7.5fps
\r
32 #define SENSOR_FULLRES_H_FPS 7500 // 7.5fps
\r
33 #define SENSOR_720P_FPS 0
\r
34 #define SENSOR_1080P_FPS 0
\r
36 #define SENSOR_REGISTER_LEN 1 // sensor register address bytes
\r
37 #define SENSOR_VALUE_LEN 1 // sensor register value bytes
\r
39 static unsigned int SensorConfiguration = (CFG_WhiteBalance|CFG_Effect|CFG_Scene);
\r
40 static unsigned int SensorChipID[] = {SENSOR_ID};
\r
41 /* Sensor Driver Configuration End */
\r
44 #define SENSOR_NAME_STRING(a) STR(CONS(SENSOR_NAME, a))
\r
45 #define SENSOR_NAME_VARFUN(a) CONS(SENSOR_NAME, a)
\r
47 #define SensorRegVal(a,b) CONS4(SensorReg,SENSOR_REGISTER_LEN,Val,SENSOR_VALUE_LEN)(a,b)
\r
48 #define sensor_write(client,reg,v) CONS4(sensor_write_reg,SENSOR_REGISTER_LEN,val,SENSOR_VALUE_LEN)(client,(reg),(v))
\r
49 #define sensor_read(client,reg,v) CONS4(sensor_read_reg,SENSOR_REGISTER_LEN,val,SENSOR_VALUE_LEN)(client,(reg),(v))
\r
50 #define sensor_write_array generic_sensor_write_array
\r
52 struct sensor_parameter
\r
54 unsigned int PreviewDummyPixels;
\r
55 unsigned int CaptureDummyPixels;
\r
56 unsigned int preview_exposure;
\r
57 unsigned short int preview_line_width;
\r
58 unsigned short int preview_gain;
\r
60 unsigned short int PreviewPclk;
\r
61 unsigned short int CapturePclk;
\r
65 struct specific_sensor{
\r
66 struct generic_sensor common_sensor;
\r
67 //define user data below
\r
68 struct sensor_parameter parameter;
\r
73 * The follow setting need been filled.
\r
76 * sensor_init_data : Sensor initial setting;
\r
77 * sensor_fullres_lowfps_data : Sensor full resolution setting with best auality, recommand for video;
\r
78 * sensor_preview_data : Sensor preview resolution setting, recommand it is vga or svga;
\r
79 * sensor_softreset_data : Sensor software reset register;
\r
80 * sensor_check_id_data : Sensir chip id register;
\r
83 * sensor_fullres_highfps_data: Sensor full resolution setting with high framerate, recommand for video;
\r
84 * sensor_720p: Sensor 720p setting, it is for video;
\r
85 * sensor_1080p: Sensor 1080p setting, it is for video;
\r
88 * The SensorEnd which is the setting end flag must be filled int the last of each setting;
\r
91 /* Sensor initial setting */
\r
92 static struct rk_sensor_reg sensor_init_data[] ={
\r
95 {0xfe , 0x00}, // set page0
\r
97 {0xd2 , 0x10}, // close AEC
\r
98 {0x22 , 0x55}, // close AWB
\r
106 {0x22 , 0x57}, // Open AWB
\r
113 {0xe2 , 0x00}, //anti-flicker step [11:8]
\r
114 {0xe3 , 0x64}, //anti-flicker step [7:0]
\r
116 {0xe4 , 0x02}, //exp level 1 16.67fps
\r
118 {0xe6 , 0x03}, //exp level 2 12.5fps
\r
120 {0xe8 , 0x04}, //exp level 3 8.33fps
\r
122 {0xea , 0x09}, //exp level 4 4.00fps
\r
141 {0x14 , 0x10}, //0x10
\r
142 //-------------H_V_Switch(4)---------------//
\r
145 2: // IMAGE_H_MIRROR
\r
148 3: // IMAGE_V_MIRROR
\r
151 4: // IMAGE_HV_MIRROR
\r
172 //output sync_mode
\r
173 {0x26 , 0x02}, //0x03 20101016 zhj
\r
273 /*GC0308_GAMMA_Select,
\r
274 1: //smallest gamma curve
\r
350 5: //largest gamma curve
\r
368 //-----------GAMMA Select End--------------//
\r
390 //---------------------------------------------------------------
\r
391 {0xfe , 0x01},// set page1
\r
443 {0xfe , 0x00}, // set page0
\r
445 //-----------Update the registers 2010/07/06-------------//
\r
446 //Registers of Page0
\r
447 {0xfe , 0x00}, // set page0
\r
449 {0x11 , 0x0d}, // fd,modified by mormo 2010/07/06
\r
450 {0x1a , 0x2a}, // 1e,modified by mormo 2010/07/06
\r
452 {0x1c , 0x49}, // c1,modified by mormo 2010/07/06
\r
453 {0x1d , 0x9a}, // 08,modified by mormo 2010/07/06
\r
454 {0x1e , 0x61}, // 60,modified by mormo 2010/07/06
\r
458 {0x50 , 0x14}, // 10,modified by mormo 2010/07/06
\r
462 {0x8b , 0x20}, //LSC
\r
473 {0xb1 , 0x40}, // YCPT
\r
478 {0xd0 , 0xcb}, // AECT c9,modifed by mormo 2010/07/06
\r
479 {0xd3 , 0x48}, // 80,modified by mormor 2010/07/06
\r
485 //Registers of Page1
\r
486 {0xfe , 0x01},// set page1
\r
510 //-----------Update the registers end---------//
\r
513 {0xfe , 0x00}, // set page0
\r
517 /* Senor full resolution setting: recommand for capture */
\r
518 static struct rk_sensor_reg sensor_fullres_lowfps_data[] ={
\r
523 /* Senor full resolution setting: recommand for video */
\r
524 static struct rk_sensor_reg sensor_fullres_highfps_data[] ={
\r
527 /* Preview resolution setting*/
\r
528 static struct rk_sensor_reg sensor_preview_data[] =
\r
534 static struct rk_sensor_reg sensor_720p[]={
\r
539 static struct rk_sensor_reg sensor_1080p[]={
\r
544 static struct rk_sensor_reg sensor_softreset_data[]={
\r
548 static struct rk_sensor_reg sensor_check_id_data[]={
\r
549 SensorRegVal(0x00,0),
\r
553 * The following setting must been filled, if the function is turn on by CONFIG_SENSOR_xxxx
\r
555 static struct rk_sensor_reg sensor_WhiteB_Auto[]=
\r
563 /* Cloudy Colour Temperature : 6500K - 8000K */
\r
564 static struct rk_sensor_reg sensor_WhiteB_Cloudy[]=
\r
566 {0x22, 0x55}, // Disable AWB
\r
572 /* ClearDay Colour Temperature : 5000K - 6500K */
\r
573 static struct rk_sensor_reg sensor_WhiteB_ClearDay[]=
\r
576 {0x22, 0x55}, // Disable AWB
\r
582 /* Office Colour Temperature : 3500K - 5000K */
\r
583 static struct rk_sensor_reg sensor_WhiteB_TungstenLamp1[]=
\r
586 {0x22, 0x55}, // Disable AWB
\r
593 /* Home Colour Temperature : 2500K - 3500K */
\r
594 static struct rk_sensor_reg sensor_WhiteB_TungstenLamp2[]=
\r
597 {0x22, 0x55}, // Disable AWB
\r
603 static struct rk_sensor_reg *sensor_WhiteBalanceSeqe[] = {sensor_WhiteB_Auto, sensor_WhiteB_TungstenLamp1,sensor_WhiteB_TungstenLamp2,
\r
604 sensor_WhiteB_ClearDay, sensor_WhiteB_Cloudy,NULL,
\r
607 static struct rk_sensor_reg sensor_Brightness0[]=
\r
614 static struct rk_sensor_reg sensor_Brightness1[]=
\r
622 static struct rk_sensor_reg sensor_Brightness2[]=
\r
630 static struct rk_sensor_reg sensor_Brightness3[]=
\r
638 static struct rk_sensor_reg sensor_Brightness4[]=
\r
646 static struct rk_sensor_reg sensor_Brightness5[]=
\r
653 static struct rk_sensor_reg *sensor_BrightnessSeqe[] = {sensor_Brightness0, sensor_Brightness1, sensor_Brightness2, sensor_Brightness3,
\r
654 sensor_Brightness4, sensor_Brightness5,NULL,
\r
657 static struct rk_sensor_reg sensor_Effect_Normal[] =
\r
672 static struct rk_sensor_reg sensor_Effect_WandB[] =
\r
686 static struct rk_sensor_reg sensor_Effect_Sepia[] =
\r
700 static struct rk_sensor_reg sensor_Effect_Negative[] =
\r
714 static struct rk_sensor_reg sensor_Effect_Bluish[] =
\r
729 static struct rk_sensor_reg sensor_Effect_Green[] =
\r
743 static struct rk_sensor_reg *sensor_EffectSeqe[] = {sensor_Effect_Normal, sensor_Effect_WandB, sensor_Effect_Negative,sensor_Effect_Sepia,
\r
744 sensor_Effect_Bluish, sensor_Effect_Green,NULL,
\r
747 static struct rk_sensor_reg sensor_Exposure0[]=
\r
754 static struct rk_sensor_reg sensor_Exposure1[]=
\r
760 static struct rk_sensor_reg sensor_Exposure2[]=
\r
766 static struct rk_sensor_reg sensor_Exposure3[]=
\r
772 static struct rk_sensor_reg sensor_Exposure4[]=
\r
778 static struct rk_sensor_reg sensor_Exposure5[]=
\r
785 static struct rk_sensor_reg sensor_Exposure6[]=
\r
791 static struct rk_sensor_reg *sensor_ExposureSeqe[] = {sensor_Exposure0, sensor_Exposure1, sensor_Exposure2, sensor_Exposure3,
\r
792 sensor_Exposure4, sensor_Exposure5,sensor_Exposure6,NULL,
\r
795 static struct rk_sensor_reg sensor_Saturation0[]=
\r
800 static struct rk_sensor_reg sensor_Saturation1[]=
\r
805 static struct rk_sensor_reg sensor_Saturation2[]=
\r
809 static struct rk_sensor_reg *sensor_SaturationSeqe[] = {sensor_Saturation0, sensor_Saturation1, sensor_Saturation2, NULL,};
\r
811 static struct rk_sensor_reg sensor_Contrast0[]=
\r
818 static struct rk_sensor_reg sensor_Contrast1[]=
\r
825 static struct rk_sensor_reg sensor_Contrast2[]=
\r
832 static struct rk_sensor_reg sensor_Contrast3[]=
\r
839 static struct rk_sensor_reg sensor_Contrast4[]=
\r
847 static struct rk_sensor_reg sensor_Contrast5[]=
\r
854 static struct rk_sensor_reg sensor_Contrast6[]=
\r
860 static struct rk_sensor_reg *sensor_ContrastSeqe[] = {sensor_Contrast0, sensor_Contrast1, sensor_Contrast2, sensor_Contrast3,
\r
861 sensor_Contrast4, sensor_Contrast5, sensor_Contrast6, NULL,
\r
863 static struct rk_sensor_reg sensor_SceneAuto[] =
\r
869 static struct rk_sensor_reg sensor_SceneNight[] =
\r
874 static struct rk_sensor_reg *sensor_SceneSeqe[] = {sensor_SceneAuto, sensor_SceneNight,NULL,};
\r
876 static struct rk_sensor_reg sensor_Zoom0[] =
\r
881 static struct rk_sensor_reg sensor_Zoom1[] =
\r
886 static struct rk_sensor_reg sensor_Zoom2[] =
\r
892 static struct rk_sensor_reg sensor_Zoom3[] =
\r
896 static struct rk_sensor_reg *sensor_ZoomSeqe[] = {sensor_Zoom0, sensor_Zoom1, sensor_Zoom2, sensor_Zoom3, NULL,};
\r
899 * User could be add v4l2_querymenu in sensor_controls by new_usr_v4l2menu
\r
901 static struct v4l2_querymenu sensor_menus[] =
\r
905 * User could be add v4l2_queryctrl in sensor_controls by new_user_v4l2ctrl
\r
907 static struct sensor_v4l2ctrl_usr_s sensor_controls[] =
\r
911 //MUST define the current used format as the first item
\r
912 static struct rk_sensor_datafmt sensor_colour_fmts[] = {
\r
913 {V4L2_MBUS_FMT_YUYV8_2X8, V4L2_COLORSPACE_JPEG}
\r
915 static struct soc_camera_ops sensor_ops;
\r
919 **********************************************************
\r
920 * Following is local code:
\r
922 * Please codeing your program here
\r
923 **********************************************************
\r
926 **********************************************************
\r
927 * Following is callback
\r
928 * If necessary, you could coding these callback
\r
929 **********************************************************
\r
932 * the function is called in open sensor
\r
934 static int sensor_activate_cb(struct i2c_client *client)
\r
940 * the function is called in close sensor
\r
942 static int sensor_deactivate_cb(struct i2c_client *client)
\r
948 * the function is called before sensor register setting in VIDIOC_S_FMT
\r
950 static int sensor_s_fmt_cb_th(struct i2c_client *client,struct v4l2_mbus_framefmt *mf, bool capture)
\r
956 * the function is called after sensor register setting finished in VIDIOC_S_FMT
\r
958 static int sensor_s_fmt_cb_bh (struct i2c_client *client,struct v4l2_mbus_framefmt *mf, bool capture)
\r
962 static int sensor_try_fmt_cb_th(struct i2c_client *client,struct v4l2_mbus_framefmt *mf)
\r
967 static int sensor_softrest_usr_cb(struct i2c_client *client,struct rk_sensor_reg *series)
\r
972 static int sensor_check_id_usr_cb(struct i2c_client *client,struct rk_sensor_reg *series)
\r
976 static int sensor_suspend(struct soc_camera_device *icd, pm_message_t pm_msg)
\r
978 //struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));
\r
980 if (pm_msg.event == PM_EVENT_SUSPEND) {
\r
981 SENSOR_DG("Suspend");
\r
984 SENSOR_TR("pm_msg.event(0x%x) != PM_EVENT_SUSPEND\n",pm_msg.event);
\r
990 static int sensor_resume(struct soc_camera_device *icd)
\r
993 SENSOR_DG("Resume");
\r
998 static int sensor_mirror_cb (struct i2c_client *client, int mirror)
\r
1003 SENSOR_DG("mirror: %d",mirror);
\r
1006 //{0xfe , 0x00}, // set page0
\r
1008 //{0x14 , 0x13}, //0x10
\r
1009 //-------------H_V_Switch(4)---------------//
\r
1012 2: // IMAGE_H_MIRROR
\r
1015 3: // IMAGE_V_MIRROR
\r
1018 4: // IMAGE_HV_MIRROR
\r
1020 sensor_write(client, 0xfe, 0);
\r
1021 err = sensor_read(client, 0x14, &val);
\r
1023 if((val & 0x1) == 0)
\r
1024 err = sensor_write(client, 0x14, (val |0x1));
\r
1026 err = sensor_write(client, 0x14, (val & 0xfe));
\r
1035 * the function is v4l2 control V4L2_CID_HFLIP callback
\r
1037 static int sensor_v4l2ctrl_mirror_cb(struct soc_camera_device *icd, struct sensor_v4l2ctrl_info_s *ctrl_info,
\r
1038 struct v4l2_ext_control *ext_ctrl)
\r
1040 struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));
\r
1042 if (sensor_mirror_cb(client,ext_ctrl->value) != 0)
\r
1043 SENSOR_TR("sensor_mirror failed, value:0x%x",ext_ctrl->value);
\r
1045 SENSOR_DG("sensor_mirror success, value:0x%x",ext_ctrl->value);
\r
1049 static int sensor_flip_cb(struct i2c_client *client, int flip)
\r
1054 SENSOR_DG("flip: %d",flip);
\r
1057 //{0xfe , 0x00}, // set page0
\r
1059 //{0x14 , 0x13}, //0x10
\r
1060 //-------------H_V_Switch(4)---------------//
\r
1063 2: // IMAGE_H_MIRROR
\r
1066 3: // IMAGE_V_MIRROR
\r
1069 4: // IMAGE_HV_MIRROR
\r
1071 sensor_write(client, 0xfe, 0);
\r
1072 err = sensor_read(client, 0x14, &val);
\r
1074 if((val & 0x2) == 0)
\r
1075 err = sensor_write(client, 0x14, (val |0x2));
\r
1077 err = sensor_write(client, 0x14, (val & 0xfc));
\r
1086 * the function is v4l2 control V4L2_CID_VFLIP callback
\r
1088 static int sensor_v4l2ctrl_flip_cb(struct soc_camera_device *icd, struct sensor_v4l2ctrl_info_s *ctrl_info,
\r
1089 struct v4l2_ext_control *ext_ctrl)
\r
1091 struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));
\r
1093 if (sensor_flip_cb(client,ext_ctrl->value) != 0)
\r
1094 SENSOR_TR("sensor_flip failed, value:0x%x",ext_ctrl->value);
\r
1096 SENSOR_DG("sensor_flip success, value:0x%x",ext_ctrl->value);
\r
1100 * the functions are focus callbacks
\r
1102 static int sensor_focus_init_usr_cb(struct i2c_client *client){
\r
1106 static int sensor_focus_af_single_usr_cb(struct i2c_client *client){
\r
1110 static int sensor_focus_af_near_usr_cb(struct i2c_client *client){
\r
1114 static int sensor_focus_af_far_usr_cb(struct i2c_client *client){
\r
1118 static int sensor_focus_af_specialpos_usr_cb(struct i2c_client *client,int pos){
\r
1122 static int sensor_focus_af_const_usr_cb(struct i2c_client *client){
\r
1125 static int sensor_focus_af_const_pause_usr_cb(struct i2c_client *client)
1129 static int sensor_focus_af_close_usr_cb(struct i2c_client *client){
\r
1133 static int sensor_focus_af_zoneupdate_usr_cb(struct i2c_client *client){
\r
1138 face defect call back
\r
1140 static int sensor_face_detect_usr_cb(struct i2c_client *client,int on){
\r
1145 * The function can been run in sensor_init_parametres which run in sensor_probe, so user can do some
\r
1146 * initialization in the function.
\r
1148 static void sensor_init_parameters_user(struct specific_sensor* spsensor,struct soc_camera_device *icd)
\r
1154 * :::::WARNING:::::
\r
1155 * It is not allowed to modify the following code
\r
1158 sensor_init_parameters_default_code();
\r
1160 sensor_v4l2_struct_initialization();
\r
1162 sensor_probe_default_code();
\r
1164 sensor_remove_default_code();
\r
1166 sensor_driver_default_module_code();
\r