2 #include "generic_sensor.h"
\r
5 * Driver Version Note
\r
6 *v0.0.1: this driver is compatible with generic_sensor
\r
8 * add sensor_focus_af_const_pause_usr_cb;
\r
10 static int version = KERNEL_VERSION(0,1,1);
\r
11 module_param(version, int, S_IRUGO);
\r
13 static int debug =1;
\r
14 module_param(debug, int, S_IRUGO|S_IWUSR);
\r
16 #define dprintk(level, fmt, arg...) do { \
\r
17 if (debug >= level) \
\r
18 printk(KERN_WARNING fmt , ## arg); } while (0)
\r
20 /* Sensor Driver Configuration Begin */
\r
21 //define sensor_i2c_slave_id 0x54
\r
22 #define SENSOR_NAME RK29_CAM_SENSOR_NT99160
\r
23 #define SENSOR_V4L2_IDENT V4L2_IDENT_NT99160
\r
24 #define SENSOR_ID 0x1600
\r
25 #define SENSOR_BUS_PARAM (V4L2_MBUS_MASTER |\
\r
26 V4L2_MBUS_PCLK_SAMPLE_RISING|V4L2_MBUS_HSYNC_ACTIVE_HIGH| V4L2_MBUS_VSYNC_ACTIVE_HIGH|\
\r
27 V4L2_MBUS_DATA_ACTIVE_HIGH |SOCAM_MCLK_24MHZ)
\r
29 #define SENSOR_PREVIEW_W 800
\r
30 #define SENSOR_PREVIEW_H 600
\r
31 #define SENSOR_PREVIEW_FPS 15000 // 15fps
\r
32 #define SENSOR_FULLRES_L_FPS 5000 // 5fps
\r
33 #define SENSOR_FULLRES_M_FPS 10000 // 5fps
\r
34 #define SENSOR_FULLRES_H_FPS 15000 // 15-20fps
\r
35 #define SENSOR_720P_FPS 5000
\r
36 #define SENSOR_1080P_FPS 0
\r
38 #define SENSOR_REGISTER_LEN 2 // sensor register address bytes
\r
39 #define SENSOR_VALUE_LEN 1 // sensor register value bytes
\r
41 static unsigned int SensorConfiguration = 0;
\r
42 static unsigned int SensorChipID[] = {SENSOR_ID};
\r
44 /* Sensor Driver Configuration End */
\r
47 #define SENSOR_NAME_STRING(a) STR(CONS(SENSOR_NAME, a))
\r
48 #define SENSOR_NAME_VARFUN(a) CONS(SENSOR_NAME, a)
\r
50 #define SensorRegVal(a,b) CONS4(SensorReg,SENSOR_REGISTER_LEN,Val,SENSOR_VALUE_LEN)(a,b)
\r
51 #define sensor_write(client,reg,v) CONS4(sensor_write_reg,SENSOR_REGISTER_LEN,val,SENSOR_VALUE_LEN)(client,(reg),(v))
\r
52 #define sensor_read(client,reg,v) CONS4(sensor_read_reg,SENSOR_REGISTER_LEN,val,SENSOR_VALUE_LEN)(client,(reg),(v))
\r
53 #define sensor_write_array generic_sensor_write_array
\r
55 struct sensor_parameter
\r
57 unsigned int PreviewDummyPixels;
\r
58 unsigned int CaptureDummyPixels;
\r
59 unsigned int preview_exposure;
\r
60 unsigned short int preview_line_width;
\r
61 unsigned short int preview_gain;
\r
63 unsigned short int PreviewPclk;
\r
64 unsigned short int CapturePclk;
\r
68 struct specific_sensor{
\r
69 struct generic_sensor common_sensor;
\r
70 //define user data below
\r
71 struct sensor_parameter parameter;
\r
76 * The follow setting need been filled.
\r
79 * sensor_init_data : Sensor initial setting;
\r
80 * sensor_fullres_lowfps_data : Sensor full resolution setting with best auality, recommand for video;
\r
81 * sensor_preview_data : Sensor preview resolution setting, recommand it is vga or svga;
\r
82 * sensor_softreset_data : Sensor software reset register;
\r
83 * sensor_check_id_data : Sensir chip id register;
\r
86 * sensor_fullres_highfps_data: Sensor full resolution setting with high framerate, recommand for video;
\r
87 * sensor_720p: Sensor 720p setting, it is for video;
\r
88 * sensor_1080p: Sensor 1080p setting, it is for video;
\r
91 * The SensorEnd which is the setting end flag must be filled int the last of each setting;
\r
94 /* Sensor initial setting */
\r
95 static struct rk_sensor_reg sensor_init_data[] ={
\r
253 static struct rk_sensor_reg sensor_fullres_lowfps_data[] ={
\r
282 {0x3003, 0x04},//x_start=4
\r
284 {0x3005, 0x04},//y_start=4
\r
286 {0x3007, 0x03},//x_end =1283
\r
288 {0x3009, 0xD3},//y_end =723
\r
290 {0x300B, 0x48},//pixel_num=1608
\r
292 {0x300D, 0xA9},//line_num=2985
\r
294 {0x300F, 0x00},//x_width = 1280
\r
296 {0x3011, 0xD0},//y_height=720
\r
313 /* Senor full resolution setting: recommand for capture */
\r
315 static struct rk_sensor_reg sensor_fullres_midfps_data[] ={
\r
344 {0x3003, 0x04},//x_start=4
\r
346 {0x3005, 0x04},//y_start=4
\r
348 {0x3007, 0x03},//x_end = 1283
\r
350 {0x3009, 0xD3},//y_end =723
\r
352 {0x300B, 0x48},//pixel_num = 1608
\r
354 {0x300D, 0xD4},//line_num = 1492
\r
356 {0x300F, 0x00},//x_width = 1280
\r
358 {0x3011, 0xD0},//y_height=720
\r
374 /* Senor full resolution setting: recommand for video */
\r
375 static struct rk_sensor_reg sensor_fullres_highfps_data[] ={
\r
404 {0x3003, 0x04},//x_start=4
\r
406 {0x3005, 0x04},//y_start=4
\r
408 {0x3007, 0x03},//x_end=1283 x_width=1280
\r
410 {0x3009, 0xD3},//y_end=723 y_height=720
\r
412 {0x300B, 0x48},//line_pixel_num =1608
\r
414 {0x300D, 0xEA},//line_num=746
\r
416 {0x300F, 0x00},//x_width = 1280
\r
418 {0x3011, 0xD0},//y_height = 720
\r
433 /* Preview resolution setting*/
\r
434 static struct rk_sensor_reg sensor_preview_data[] =
\r
473 {0x3003, 0xA4},//x_start=164
\r
475 {0x3005, 0x04},//y_start=4
\r
477 {0x3007, 0x63},//x_end=1123
\r
479 {0x3009, 0xD3},//y_end=723
\r
481 {0x300B, 0x08},//pixel_num=1288
\r
483 {0x300D, 0xE0},//line_num=736
\r
485 {0x300F, 0xC0},//x_width=960
\r
487 {0x3011, 0xD0},//y_height=720
\r
504 static struct rk_sensor_reg sensor_720p[]={
\r
534 {0x3003, 0x04},//x_start=4
\r
536 {0x3005, 0x04},//y_start=4
\r
538 {0x3007, 0x03},//x_end =1283
\r
540 {0x3009, 0xD3},//y_end =723
\r
542 {0x300B, 0x48},//pixel_num=1608
\r
544 {0x300D, 0xA9},//line_num=2985
\r
546 {0x300F, 0x00},//x_width = 1280
\r
548 {0x3011, 0xD0},//y_height=720
\r
565 static struct rk_sensor_reg sensor_1080p[]={
\r
570 static struct rk_sensor_reg sensor_softreset_data[]={
\r
571 SensorRegVal(0x3021,0x61),
\r
575 static struct rk_sensor_reg sensor_check_id_data[]={
\r
576 SensorRegVal(0x3000,0),
\r
577 SensorRegVal(0x3001,0),
\r
581 * The following setting must been filled, if the function is turn on by CONFIG_SENSOR_xxxx
\r
583 static struct rk_sensor_reg sensor_WhiteB_Auto[]=
\r
588 /* Cloudy Colour Temperature : 6500K - 8000K */
\r
589 static struct rk_sensor_reg sensor_WhiteB_Cloudy[]=
\r
599 /* ClearDay Colour Temperature : 5000K - 6500K */
\r
600 static struct rk_sensor_reg sensor_WhiteB_ClearDay[]=
\r
610 /* Office Colour Temperature : 3500K - 5000K */
\r
611 static struct rk_sensor_reg sensor_WhiteB_TungstenLamp1[]=
\r
622 /* Home Colour Temperature : 2500K - 3500K */
\r
623 static struct rk_sensor_reg sensor_WhiteB_TungstenLamp2[]=
\r
635 /* Home Colour Temperature : 2500K - 3500K */
\r
636 static struct rk_sensor_reg sensor_WhiteB_TungstenLamp3[]=
\r
648 static struct rk_sensor_reg *sensor_WhiteBalanceSeqe[] = {sensor_WhiteB_Auto, sensor_WhiteB_TungstenLamp1,sensor_WhiteB_TungstenLamp2,
\r
649 sensor_WhiteB_ClearDay, sensor_WhiteB_Cloudy,sensor_WhiteB_TungstenLamp3,NULL,
\r
652 static struct rk_sensor_reg sensor_Brightness0[]=
\r
658 static struct rk_sensor_reg sensor_Brightness1[]=
\r
665 static struct rk_sensor_reg sensor_Brightness2[]=
\r
672 static struct rk_sensor_reg sensor_Brightness3[]=
\r
679 static struct rk_sensor_reg sensor_Brightness4[]=
\r
686 static struct rk_sensor_reg sensor_Brightness5[]=
\r
692 static struct rk_sensor_reg *sensor_BrightnessSeqe[] = {sensor_Brightness0, sensor_Brightness1, sensor_Brightness2, sensor_Brightness3,
\r
693 sensor_Brightness4, sensor_Brightness5,NULL,
\r
696 static struct rk_sensor_reg sensor_Effect_Normal[] =
\r
704 static struct rk_sensor_reg sensor_Effect_WandB[] =
\r
712 static struct rk_sensor_reg sensor_Effect_Sepia[] =
\r
719 static struct rk_sensor_reg sensor_Effect_Inverse[] =
\r
725 static struct rk_sensor_reg sensor_Effect_Bluish[] =
\r
734 static struct rk_sensor_reg sensor_Effect_Green[] =
\r
743 static struct rk_sensor_reg sensor_Effect_Solarization[] =
\r
751 static struct rk_sensor_reg *sensor_EffectSeqe[] = {sensor_Effect_Normal, sensor_Effect_WandB, sensor_Effect_Inverse,sensor_Effect_Sepia,
\r
752 sensor_Effect_Bluish,sensor_Effect_Green,sensor_Effect_Solarization, NULL,
\r
755 static struct rk_sensor_reg sensor_Exposure04[]=
\r
764 static struct rk_sensor_reg sensor_Exposure03[]=
\r
772 static struct rk_sensor_reg sensor_Exposure02[]=
\r
780 static struct rk_sensor_reg sensor_Exposure01[]=
\r
788 static struct rk_sensor_reg sensor_Exposure00[]=
\r
796 static struct rk_sensor_reg sensor_Exposure11[]=
\r
804 static struct rk_sensor_reg sensor_Exposure12[]=
\r
812 static struct rk_sensor_reg sensor_Exposure13[]=
\r
820 static struct rk_sensor_reg sensor_Exposure14[]=
\r
828 static struct rk_sensor_reg *sensor_ExposureSeqe[] = {sensor_Exposure04,sensor_Exposure03, sensor_Exposure02, sensor_Exposure01, sensor_Exposure00,
\r
829 sensor_Exposure11, sensor_Exposure12,sensor_Exposure13,sensor_Exposure14,NULL,
\r
832 static struct rk_sensor_reg sensor_Saturation0[]=
\r
837 static struct rk_sensor_reg sensor_Saturation1[]=
\r
842 static struct rk_sensor_reg sensor_Saturation2[]=
\r
846 static struct rk_sensor_reg *sensor_SaturationSeqe[] = {sensor_Saturation0, sensor_Saturation1, sensor_Saturation2, NULL,};
\r
848 static struct rk_sensor_reg sensor_Contrast04[]=
\r
858 static struct rk_sensor_reg sensor_Contrast03[]=
\r
868 static struct rk_sensor_reg sensor_Contrast02[]=
\r
877 static struct rk_sensor_reg sensor_Contrast01[]=
\r
887 static struct rk_sensor_reg sensor_Contrast00[]=
\r
898 static struct rk_sensor_reg sensor_Contrast11[]=
\r
909 static struct rk_sensor_reg sensor_Contrast12[]=
\r
919 static struct rk_sensor_reg sensor_Contrast13[]=
\r
929 static struct rk_sensor_reg sensor_Contrast14[]=
\r
939 static struct rk_sensor_reg *sensor_ContrastSeqe[] = {sensor_Contrast04, sensor_Contrast03, sensor_Contrast02, sensor_Contrast01,
\r
940 sensor_Contrast00, sensor_Contrast11, sensor_Contrast12, sensor_Contrast13, sensor_Contrast14,NULL,
\r
942 static struct rk_sensor_reg sensor_SceneAuto[] =
\r
947 static struct rk_sensor_reg sensor_SceneNight[] =
\r
951 static struct rk_sensor_reg *sensor_SceneSeqe[] = {sensor_SceneAuto, sensor_SceneNight,NULL,};
\r
953 static struct rk_sensor_reg sensor_Zoom0[] =
\r
958 static struct rk_sensor_reg sensor_Zoom1[] =
\r
963 static struct rk_sensor_reg sensor_Zoom2[] =
\r
969 static struct rk_sensor_reg sensor_Zoom3[] =
\r
973 static struct rk_sensor_reg *sensor_ZoomSeqe[] = {sensor_Zoom0, sensor_Zoom1, sensor_Zoom2, sensor_Zoom3, NULL,};
\r
976 * User could be add v4l2_querymenu in sensor_controls by new_usr_v4l2menu
\r
978 static struct v4l2_querymenu sensor_menus[] =
\r
981 new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,0,"auto",0),
\r
982 new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,1,"incandescent",0),
\r
983 new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,2,"fluorescent",0),
\r
984 new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,3,"daylight",0),
\r
985 new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,4,"cloudy-daylight",0),
\r
986 new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,5,"tungsten",0),
\r
989 new_usr_v4l2menu(V4L2_CID_EFFECT,0,"none",0),
\r
990 new_usr_v4l2menu(V4L2_CID_EFFECT,1,"mono",0),
\r
991 new_usr_v4l2menu(V4L2_CID_EFFECT,2,"negative",0),
\r
992 new_usr_v4l2menu(V4L2_CID_EFFECT,3,"sepia",0),
\r
993 new_usr_v4l2menu(V4L2_CID_EFFECT,4,"posterize",0),
\r
994 new_usr_v4l2menu(V4L2_CID_EFFECT,5,"aqua",0),
\r
995 new_usr_v4l2menu(V4L2_CID_EFFECT,6,"solarize",0),
\r
998 * User could be add v4l2_queryctrl in sensor_controls by new_user_v4l2ctrl
\r
1000 static struct sensor_v4l2ctrl_usr_s sensor_controls[] =
\r
1002 new_user_v4l2ctrl(V4L2_CID_DO_WHITE_BALANCE,V4L2_CTRL_TYPE_MENU,"White Balance Control", 0, 5, 1, 0,sensor_v4l2ctrl_default_cb, sensor_WhiteBalanceSeqe),
\r
1003 new_user_v4l2ctrl(V4L2_CID_EXPOSURE,V4L2_CTRL_TYPE_INTEGER,"Exposure Control", -4, 4, 1, 0,sensor_v4l2ctrl_default_cb, sensor_ExposureSeqe),
\r
1004 new_user_v4l2ctrl(V4L2_CID_EFFECT,V4L2_CTRL_TYPE_MENU,"Effect Control", 0, 6, 1, 0,sensor_v4l2ctrl_default_cb, sensor_EffectSeqe),
\r
1005 new_user_v4l2ctrl(V4L2_CID_CONTRAST,V4L2_CTRL_TYPE_INTEGER,"Contrast Control", -4, 4, 1, 0,sensor_v4l2ctrl_default_cb, sensor_ContrastSeqe),
\r
1009 //MUST define the current used format as the first item
\r
1010 static struct rk_sensor_datafmt sensor_colour_fmts[] = {
\r
1011 {V4L2_MBUS_FMT_UYVY8_2X8, V4L2_COLORSPACE_JPEG},
\r
1012 {V4L2_MBUS_FMT_YUYV8_2X8, V4L2_COLORSPACE_JPEG}
\r
1014 /*static struct soc_camera_ops sensor_ops;*/
\r
1017 **********************************************************
\r
1018 * Following is local code:
\r
1020 * Please codeing your program here
\r
1021 **********************************************************
\r
1023 #define NT99160_FULL_PERIOD_PIXEL_NUMS (1608) // default pixel#(w/o dummy pixels) in UXGA mode
\r
1024 #define NT99160_FULL_PERIOD_LINE_NUMS (746) // default line#(w/o dummy lines) in UXGA mode
\r
1025 #define NT99160_PV_PERIOD_PIXEL_NUMS (1288) // default pixel#(w/o dummy pixels) in SVGA mode
\r
1026 #define NT99160_PV_PERIOD_LINE_NUMS (736) // default line#(w/o dummy lines) in SVGA mode
\r
1028 /* SENSOR EXPOSURE LINE LIMITATION */
\r
1029 #define NT99160_FULL_EXPOSURE_LIMITATION (1492)
\r
1030 #define NT99160_PV_EXPOSURE_LIMITATION (736)
\r
1032 // SENSOR UXGA SIZE
\r
1033 #define NT99160_IMAGE_SENSOR_FULL_WIDTH (1280)
\r
1034 #define NT99160_IMAGE_SENSOR_FULL_HEIGHT (720)
\r
1036 #define NT99160_FULL_GRAB_WIDTH (NT99160_IMAGE_SENSOR_FULL_WIDTH - 16)
\r
1037 #define NT99160_FULL_GRAB_HEIGHT (NT99160_IMAGE_SENSOR_FULL_HEIGHT - 12)
\r
1040 **********************************************************
\r
1041 * Following is callback
\r
1042 * If necessary, you could coding these callback
\r
1043 **********************************************************
\r
1046 * the function is called in open sensor
\r
1048 static int sensor_activate_cb(struct i2c_client *client)
\r
1050 SENSOR_DG("%s\n",__FUNCTION__);
\r
1055 * the function is called in close sensor
\r
1057 static int sensor_deactivate_cb(struct i2c_client *client)
\r
1059 struct generic_sensor *sensor = to_generic_sensor(client);
\r
1061 SENSOR_DG("%s",__FUNCTION__);
\r
1063 /* ddl@rock-chips.com : all sensor output pin must switch into Hi-Z */
\r
1065 if (sensor->info_priv.funmodule_state & SENSOR_INIT_IS_OK) {
\r
1066 //generic_sensor_ioctrl(icd, Sensor_PowerDown, 1);
\r
1067 sensor->info_priv.funmodule_state &= ~SENSOR_INIT_IS_OK;
\r
1073 * the function is called before sensor register setting in VIDIOC_S_FMT
\r
1075 static int sensor_s_fmt_cb_th(struct i2c_client *client,struct v4l2_mbus_framefmt *mf, bool capture)
\r
1080 * the function is called after sensor register setting finished in VIDIOC_S_FMT
\r
1082 static int sensor_s_fmt_cb_bh (struct i2c_client *client,struct v4l2_mbus_framefmt *mf, bool capture)
\r
1087 static int sensor_try_fmt_cb_th(struct i2c_client *client,struct v4l2_mbus_framefmt *mf)
\r
1092 static int sensor_softrest_usr_cb(struct i2c_client *client,struct rk_sensor_reg *series)
\r
1097 static int sensor_check_id_usr_cb(struct i2c_client *client,struct rk_sensor_reg *series)
\r
1102 static int sensor_suspend(struct soc_camera_device *icd, pm_message_t pm_msg)
\r
1104 //struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));
\r
1106 if (pm_msg.event == PM_EVENT_SUSPEND) {
\r
1107 SENSOR_DG("Suspend");
\r
1110 SENSOR_TR("pm_msg.event(0x%x) != PM_EVENT_SUSPEND\n",pm_msg.event);
\r
1116 static int sensor_resume(struct soc_camera_device *icd)
\r
1120 SENSOR_DG("Resume");
\r
1121 //ret = generic_sensor_ioctrl(icd, Sensor_PowerDown, 0);
\r
1126 static int sensor_mirror_cb (struct i2c_client *client, int mirror)
\r
1131 SENSOR_DG("mirror: %d",mirror);
\r
1133 err = sensor_read(client, 0x3022, &val);
\r
1136 err = sensor_write(client, 0x3022, val);
\r
1139 err = sensor_read(client, 0x3022, &val);
\r
1142 err = sensor_write(client, 0x3022, val);
\r
1149 * the function is v4l2 control V4L2_CID_HFLIP callback
\r
1151 static int sensor_v4l2ctrl_mirror_cb(struct soc_camera_device *icd, struct sensor_v4l2ctrl_info_s *ctrl_info,
\r
1152 struct v4l2_ext_control *ext_ctrl)
\r
1154 struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));
\r
1156 if (sensor_mirror_cb(client,ext_ctrl->value) != 0)
\r
1157 SENSOR_TR("sensor_mirror failed, value:0x%x",ext_ctrl->value);
\r
1159 SENSOR_DG("sensor_mirror success, value:0x%x",ext_ctrl->value);
\r
1163 static int sensor_flip_cb(struct i2c_client *client, int flip)
\r
1169 SENSOR_DG("flip: %d",flip);
\r
1171 err = sensor_read(client, 0x3022, &val);
\r
1174 err = sensor_write(client, 0x3022, val);
\r
1177 err = sensor_read(client, 0x3022, &val);
\r
1180 err = sensor_write(client, 0x3022, val);
\r
1187 * the function is v4l2 control V4L2_CID_VFLIP callback
\r
1189 static int sensor_v4l2ctrl_flip_cb(struct soc_camera_device *icd, struct sensor_v4l2ctrl_info_s *ctrl_info,
\r
1190 struct v4l2_ext_control *ext_ctrl)
\r
1192 struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));
\r
1194 if (sensor_flip_cb(client,ext_ctrl->value) != 0)
\r
1195 SENSOR_TR("sensor_flip failed, value:0x%x",ext_ctrl->value);
\r
1197 SENSOR_DG("sensor_flip success, value:0x%x",ext_ctrl->value);
\r
1201 static int sensor_focus_init_usr_cb(struct i2c_client *client){
\r
1205 static int sensor_focus_af_single_usr_cb(struct i2c_client *client){
\r
1209 static int sensor_focus_af_near_usr_cb(struct i2c_client *client){
\r
1213 static int sensor_focus_af_far_usr_cb(struct i2c_client *client){
\r
1217 static int sensor_focus_af_specialpos_usr_cb(struct i2c_client *client,int pos){
\r
1221 static int sensor_focus_af_const_usr_cb(struct i2c_client *client){
\r
1224 static int sensor_focus_af_const_pause_usr_cb(struct i2c_client *client)
1228 static int sensor_focus_af_close_usr_cb(struct i2c_client *client){
\r
1232 static int sensor_focus_af_zoneupdate_usr_cb(struct i2c_client *client, int *zone_tm_pos)
\r
1238 face defect call back
\r
1240 static int sensor_face_detect_usr_cb(struct i2c_client *client,int on){
\r
1245 * The function can been run in sensor_init_parametres which run in sensor_probe, so user can do some
\r
1246 * initialization in the function.
\r
1248 static void sensor_init_parameters_user(struct specific_sensor* spsensor,struct soc_camera_device *icd)
\r
1255 * :::::WARNING:::::
\r
1256 * It is not allowed to modify the following code
\r
1259 sensor_init_parameters_default_code();
\r
1261 sensor_v4l2_struct_initialization();
\r
1263 sensor_probe_default_code();
\r
1265 sensor_remove_default_code();
\r
1267 sensor_driver_default_module_code();
\r