drivers/media/video/nt99252_3way.c

   1 \r
   2 #include "generic_sensor.h"\r
   3 /*
   4 *      Driver Version Note\r
   5 *v0.0.1: this driver is compatible with generic_sensor\r
   6 *v0.1.1:\r
   7 *        add sensor_focus_af_const_pause_usr_cb;\r
   8 */\r
   9 static int version = KERNEL_VERSION(0,1,1);\r
  10 module_param(version, int, S_IRUGO);\r
  11 \r
  12 static int debug =1;\r
  13 module_param(debug, int, S_IRUGO|S_IWUSR);\r
  14 \r
  15 #define dprintk(level, fmt, arg...) do {                        \\r
  16         if (debug >= level)                                     \\r
  17         printk(KERN_WARNING fmt , ## arg); } while (0)\r
  18 \r
  19 /* Sensor Driver Configuration Begin */\r
  20 #define SENSOR_NAME RK29_CAM_SENSOR_NT99252\r
  21 #define SENSOR_V4L2_IDENT V4L2_IDENT_NT99252\r
  22 #define SENSOR_ID 0x2520\r
  23 #define SENSOR_BUS_PARAM                     (SOCAM_MASTER |\\r
  24                                              SOCAM_PCLK_SAMPLE_RISING|SOCAM_HSYNC_ACTIVE_HIGH| SOCAM_VSYNC_ACTIVE_HIGH|\\r
  25                                              SOCAM_DATA_ACTIVE_HIGH | SOCAM_DATAWIDTH_8  |SOCAM_MCLK_24MHZ)\r
  26 #define SENSOR_PREVIEW_W                     800\r
  27 #define SENSOR_PREVIEW_H                     600\r
  28 #define SENSOR_PREVIEW_FPS                   15000     // 15fps \r
  29 #define SENSOR_FULLRES_L_FPS                 5000      // 7.5fps\r
  30 #define SENSOR_FULLRES_H_FPS                 10000      // 7.5fps\r
  31 #define SENSOR_720P_FPS                      1\r
  32 #define SENSOR_1080P_FPS                     0\r
  33 \r
  34 #define SENSOR_REGISTER_LEN                  2         // sensor register address bytes\r
  35 #define SENSOR_VALUE_LEN                     1         // sensor register value bytes\r
  36                                     \r
  37 static unsigned int SensorConfiguration = 0;\r
  38 static unsigned int SensorChipID[] = {SENSOR_ID};\r
  39 /* Sensor Driver Configuration End */\r
  40 \r
  41 \r
  42 #define SENSOR_NAME_STRING(a) STR(CONS(SENSOR_NAME, a))\r
  43 #define SENSOR_NAME_VARFUN(a) CONS(SENSOR_NAME, a)\r
  44 \r
  45 #define SensorRegVal(a,b) CONS4(SensorReg,SENSOR_REGISTER_LEN,Val,SENSOR_VALUE_LEN)(a,b)\r
  46 #define sensor_write(client,reg,v) CONS4(sensor_write_reg,SENSOR_REGISTER_LEN,val,SENSOR_VALUE_LEN)(client,(reg),(v))\r
  47 #define sensor_read(client,reg,v) CONS4(sensor_read_reg,SENSOR_REGISTER_LEN,val,SENSOR_VALUE_LEN)(client,(reg),(v))\r
  48 #define sensor_write_array generic_sensor_write_array\r
  49 \r
  50 struct sensor_parameter\r
  51 {\r
  52         unsigned int PreviewDummyPixels;\r
  53         unsigned int CaptureDummyPixels;\r
  54         unsigned int preview_exposure;\r
  55         unsigned short int preview_line_width;\r
  56         unsigned short int preview_gain;\r
  57 \r
  58         unsigned short int PreviewPclk;\r
  59         unsigned short int CapturePclk;\r
  60         char awb[6];\r
  61 };\r
  62 \r
  63 struct specific_sensor{\r
  64         struct generic_sensor common_sensor;\r
  65         //define user data below\r
  66         struct sensor_parameter parameter;\r
  67 \r
  68 };\r
  69 \r
  70 /*\r
  71 *  The follow setting need been filled.\r
  72 *  \r
  73 *  Must Filled:\r
  74 *  sensor_init_data :               Sensor initial setting;\r
  75 *  sensor_fullres_lowfps_data :     Sensor full resolution setting with best auality, recommand for video;\r
  76 *  sensor_preview_data :            Sensor preview resolution setting, recommand it is vga or svga;\r
  77 *  sensor_softreset_data :          Sensor software reset register;\r
  78 *  sensor_check_id_data :           Sensir chip id register;\r
  79 *\r
  80 *  Optional filled:\r
  81 *  sensor_fullres_highfps_data:     Sensor full resolution setting with high framerate, recommand for video;\r
  82 *  sensor_720p:                     Sensor 720p setting, it is for video;\r
  83 *  sensor_1080p:                    Sensor 1080p setting, it is for video;\r
  84 *\r
  85 *  :::::WARNING:::::\r
  86 *  The SensorEnd which is the setting end flag must be filled int the last of each setting;\r
  87 */\r
  88 \r
  89 /* Sensor initial setting */\r
  90 static struct rk_sensor_reg sensor_init_data[] ={\r
  91         {0x302A, 0x00},\r
  92         {0x301F, 0x80},\r
  93         {0x303f, 0x0e},\r
  94         {0x3051, 0xE8},\r
  95         {0x320A, 0x00},\r
  96         {0x302E, 0x01},\r
  97         {0x3069, 0x04},\r
  98         {0x306a, 0x04},\r
  99         {0x3101, 0x80},\r
 100         {0x3104, 0x03},\r
 101         {0x3105, 0x03},\r
 102         {0x3106, 0x0D},\r
 103         {0x310A, 0x62},\r
 104         {0x310D, 0x60},\r
 105         {0x3111, 0x5B},\r
 106         {0x3131, 0x58},\r
 107         {0x3127, 0x01},\r
 108         {0x3210, 0x1E},\r
 109         {0x3211, 0x1E},\r
 110         {0x3212, 0x1E},\r
 111         {0x3213, 0x1E},\r
 112         {0x3214, 0x17},\r
 113         {0x3215, 0x17},\r
 114         {0x3216, 0x17},\r
 115         {0x3217, 0x17},\r
 116         {0x3218, 0x17},\r
 117         {0x3219, 0x17},\r
 118         {0x321A, 0x17},\r
 119         {0x321B, 0x17},\r
 120         {0x321C, 0x0F},\r
 121         {0x321D, 0x10},\r
 122         {0x321E, 0x0F},\r
 123         {0x321F, 0x0F},\r
 124         {0x3230, 0x00},\r
 125         {0x3231, 0x00},\r
 126         {0x3232, 0x00},\r
 127         {0x3233, 0x00},\r
 128         {0x3234, 0x00},\r
 129         {0x3235, 0x00},\r
 130         {0x3236, 0x00},\r
 131         {0x3237, 0x08},\r
 132         {0x3238, 0x20},\r
 133         {0x3239, 0x20},\r
 134         {0x323A, 0x20},\r
 135         {0x3243, 0xC3},\r
 136         {0x3244, 0x00},\r
 137         {0x3245, 0x00},\r
 138         {0x3302, 0x00},\r
 139         {0x3303, 0x54},\r
 140         {0x3304, 0x00},\r
 141         {0x3305, 0x91},\r
 142         {0x3306, 0x00},\r
 143         {0x3307, 0x1A},\r
 144         {0x3308, 0x07},\r
 145         {0x3309, 0xCD},\r
 146         {0x330A, 0x07},\r
 147         {0x330B, 0x51},\r
 148         {0x330C, 0x00},\r
 149         {0x330D, 0xE3},\r
 150         {0x330E, 0x00},\r
 151         {0x330F, 0xC6},\r
 152         {0x3310, 0x07},\r
 153         {0x3311, 0x4A},\r
 154         {0x3312, 0x07},\r
 155         {0x3313, 0xF1},\r
 156         {0x3270, 0x00},\r
 157         {0x3271, 0x0B},\r
 158         {0x3272, 0x16},\r
 159         {0x3273, 0x2B},\r
 160         {0x3274, 0x3F},\r
 161         {0x3275, 0x51},\r
 162         {0x3276, 0x72},\r
 163         {0x3277, 0x8F},\r
 164         {0x3278, 0xA7},\r
 165         {0x3279, 0xBC},\r
 166         {0x327A, 0xDC},\r
 167         {0x327B, 0xF0},\r
 168         {0x327C, 0xFA},\r
 169         {0x327D, 0xFE},\r
 170         {0x327E, 0xFF},\r
 171         {0x3327, 0x00},\r
 172         {0x3326, 0x1F},\r
 173         {0x3360, 0x08},\r
 174         {0x3361, 0x0E},\r
 175         {0x3362, 0x14},\r
 176         {0x3363, 0xB3},\r
 177         {0x3331, 0x0C},\r
 178         {0x3332, 0x60},\r
 179         {0x3365, 0x10},\r
 180         {0x3366, 0x10},\r
 181         {0x3368, 0x08},\r
 182         {0x3369, 0x08},\r
 183         {0x336A, 0x06},\r
 184         {0x336B, 0x00},\r
 185         {0x336d, 0x14},\r
 186         {0x336e, 0x14},\r
 187         {0x336f, 0x00},\r
 188         {0x3370, 0x00},\r
 189         {0x3379, 0x0A},\r
 190         {0x337A, 0x0A},\r
 191         {0x337B, 0x0A},\r
 192         {0x337C, 0x0A},\r
 193         {0x3371, 0x38},\r
 194         {0x3372, 0x38},\r
 195         {0x3373, 0x3F},\r
 196         {0x3374, 0x3F},\r
 197         {0x33A2, 0x00},\r
 198         {0x33A3, 0x30},\r
 199         {0x33A4, 0x01},\r
 200         {0x33c0, 0x03},\r
 201         {0x33c9, 0xCF},\r
 202         {0x33ca, 0x36},\r
 203         SensorEnd\r
 204 };\r
 205 /* Senor full resolution setting: recommand for capture */\r
 206 static struct rk_sensor_reg sensor_fullres_lowfps_data[] ={\r
 207         {0x32BF, 0x60},\r
 208         {0x32C0, 0x84},\r
 209         {0x32C1, 0x84},\r
 210         {0x32C2, 0x84},\r
 211         {0x32C3, 0x00},\r
 212         {0x32C4, 0x20},\r
 213         {0x32C5, 0x10},\r
 214         {0x32C6, 0x18},\r
 215         {0x32C7, 0x00},\r
 216         {0x32C8, 0x7E},\r
 217         {0x32C9, 0x84},\r
 218         {0x32CA, 0x94},\r
 219         {0x32CB, 0x94},\r
 220         {0x32CC, 0x9C},\r
 221         {0x32CD, 0x9C},\r
 222         {0x32DB, 0x6F},\r
 223         {0x3241, 0x89},\r
 224         {0x33A0, 0xAF},\r
 225         {0x33A1, 0x64},\r
 226         {0x3200, 0x3E},\r
 227         {0x3201, 0x3F},\r
 228         {0x302A, 0x00},\r
 229         {0x302C, 0x0C},\r
 230         {0x302C, 0x0B},\r
 231         {0x302D, 0x02},\r
 232         {0x3022, 0x24},\r
 233         {0x3023, 0x24},\r
 234         {0x3002, 0x00},\r
 235         {0x3003, 0x04},\r
 236         {0x3004, 0x00},\r
 237         {0x3005, 0x04},\r
 238         {0x3006, 0x06},\r
 239         {0x3007, 0x43},\r
 240         {0x3008, 0x04},\r
 241         {0x3009, 0xCC},\r
 242         {0x300A, 0x07},\r
 243         {0x300B, 0x6C},\r
 244         {0x300C, 0x09},\r
 245         {0x300D, 0xDE},\r
 246         {0x300E, 0x06},\r
 247         {0x300F, 0x40},\r
 248         {0x3010, 0x04},\r
 249         {0x3011, 0xB0},\r
 250         {0x32BB, 0x87},\r
 251         {0x32B8, 0x36},\r
 252         {0x32B9, 0x2A},\r
 253         {0x32BC, 0x30},\r
 254         {0x32BD, 0x33},\r
 255         {0x32BE, 0x2D},\r
 256         {0x325C, 0x03},\r
 257         {0x320A, 0x00},\r
 258         {0x3021, 0x06},\r
 259         {0x334A, 0x34},\r
 260         {0x334B, 0x14},\r
 261         {0x334C, 0x10},\r
 262         {0x3060, 0x01},\r
 263         SensorEnd\r
 264 };\r
 265 /* Senor full resolution setting: recommand for video */\r
 266 static struct rk_sensor_reg sensor_fullres_highfps_data[] ={\r
 267         {0x32BF, 0x60},\r
 268         {0x32C0, 0x74},\r
 269         {0x32C1, 0x74},\r
 270         {0x32C2, 0x74},\r
 271         {0x32C3, 0x00},\r
 272         {0x32C4, 0x20},\r
 273         {0x32C5, 0x10},\r
 274         {0x32C6, 0x18},\r
 275         {0x32C7, 0x00},\r
 276         {0x32C8, 0x7E},\r
 277         {0x32C9, 0x74},\r
 278         {0x32CA, 0x84},\r
 279         {0x32CB, 0x84},\r
 280         {0x32CC, 0x8C},\r
 281         {0x32CD, 0x8C},\r
 282         {0x32DB, 0x6F},\r
 283         {0x3241, 0x81},\r
 284         {0x33A0, 0xAF},\r
 285         {0x33A1, 0x54},\r
 286         {0x3200, 0x3E},\r
 287         {0x3201, 0x3F},\r
 288         {0x302A, 0x00},\r
 289         {0x302C, 0x0C},\r
 290         {0x302C, 0x0B},\r
 291         {0x302D, 0x02},\r
 292         {0x3022, 0x24},\r
 293         {0x3023, 0x24},\r
 294         {0x3002, 0x00},\r
 295         {0x3003, 0x04},\r
 296         {0x3004, 0x00},\r
 297         {0x3005, 0x04},\r
 298         {0x3006, 0x06},\r
 299         {0x3007, 0x43},\r
 300         {0x3008, 0x04},\r
 301         {0x3009, 0xCC},\r
 302         {0x300A, 0x07},\r
 303         {0x300B, 0x6C},\r
 304         {0x300C, 0x04},\r
 305         {0x300D, 0xEF},\r
 306         {0x300E, 0x06},\r
 307         {0x300F, 0x40},\r
 308         {0x3010, 0x04},\r
 309         {0x3011, 0xB0},\r
 310         {0x32BB, 0x87},\r
 311         {0x32B8, 0x36},\r
 312         {0x32B9, 0x2A},\r
 313         {0x32BC, 0x30},\r
 314         {0x32BD, 0x33},\r
 315         {0x32BE, 0x2D},\r
 316         {0x325C, 0x03},\r
 317         {0x320A, 0x00},\r
 318         {0x3021, 0x06},\r
 319         {0x334A, 0x34},\r
 320         {0x334B, 0x14},\r
 321         {0x334C, 0x10},\r
 322         {0x3060, 0x01},\r
 323         SensorEnd\r
 324 };\r
 325 /* Preview resolution setting*/\r
 326 static struct rk_sensor_reg sensor_preview_data[] ={\r
 327         {0x32BF, 0x60},\r
 328         {0x32C0, 0x6A},\r
 329         {0x32C1, 0x6A},\r
 330         {0x32C2, 0x6A},\r
 331         {0x32C3, 0x00},\r
 332         {0x32C4, 0x20},\r
 333         {0x32C5, 0x20},\r
 334         {0x32C6, 0x20},\r
 335         {0x32C7, 0x00},\r
 336         {0x32C8, 0xB9},\r
 337         {0x32C9, 0x6A},\r
 338         {0x32CA, 0x8A},\r
 339         {0x32CB, 0x8A},\r
 340         {0x32CC, 0x8A},\r
 341         {0x32CD, 0x8A},\r
 342         {0x32DB, 0x77},\r
 343         {0x3241, 0x80},\r
 344         {0x33A0, 0xB7},\r
 345         {0x33A1, 0x4A},\r
 346         {0x32E0, 0x03},\r
 347         {0x32E1, 0x20},\r
 348         {0x32E2, 0x02},\r
 349         {0x32E3, 0x58},\r
 350         {0x32E4, 0x00},\r
 351         {0x32E5, 0x00},\r
 352         {0x32E6, 0x00},\r
 353         {0x32E7, 0x00},\r
 354         {0x3200, 0x3E},\r
 355         {0x3201, 0x7F},\r
 356         {0x302A, 0x00},\r
 357         {0x302C, 0x0C},\r
 358         {0x302C, 0x0B},\r
 359         {0x302D, 0x02},\r
 360         {0x3022, 0x24},\r
 361         {0x3023, 0x6E},\r
 362         {0x3002, 0x00},\r
 363         {0x3003, 0x04},//x_start=4\r
 364         {0x3004, 0x00},\r
 365         {0x3005, 0x04},//y_start=4\r
 366         {0x3006, 0x06},\r
 367         {0x3007, 0x43},//x_end=1603\r
 368         {0x3008, 0x04},\r
 369         {0x3009, 0xCC},//y_end=1228\r
 370         {0x300A, 0x05},\r
 371         {0x300B, 0x14},//pixel=1300\r
 372         {0x300C, 0x02},\r
 373         {0x300D, 0x67},//line=615\r
 374         {0x300E, 0x03},\r
 375         {0x300F, 0x20},//x_width=800\r
 376         {0x3010, 0x02},\r
 377         {0x3011, 0x58},//y_width=600\r
 378         {0x32BB, 0x87},\r
 379         {0x32B8, 0x36},\r
 380         {0x32B9, 0x2A},\r
 381         {0x32BC, 0x30},\r
 382         {0x32BD, 0x33},\r
 383         {0x32BE, 0x2D},\r
 384         {0x325C, 0x02},\r
 385         {0x320A, 0x00},\r
 386         {0x3021, 0x06},\r
 387         {0x334A, 0x00},\r
 388         {0x334B, 0x7F},\r
 389         {0x334C, 0x1F},\r
 390         {0x3060, 0x01},\r
 391         SensorEnd\r
 392 };\r
 393 /* 1280x720 */\r
 394 static struct rk_sensor_reg sensor_720p[]={\r
 395         {0x32BF, 0x60},\r
 396         {0x32C0, 0x6A},  \r
 397         {0x32C1, 0x6A},\r
 398         {0x32C2, 0x6A},\r
 399         {0x32C3, 0x00},\r
 400         {0x32C4, 0x20},\r
 401         {0x32C5, 0x20},\r
 402         {0x32C6, 0x20},\r
 403         {0x32C7, 0x00},\r
 404         {0x32C8, 0x98},\r
 405         {0x32C9, 0x6A},\r
 406         {0x32CA, 0x8A},\r
 407         {0x32CB, 0x8A},\r
 408         {0x32CC, 0x8A},\r
 409         {0x32CD, 0x8A},\r
 410         {0x32DB, 0x73},\r
 411         {0x3241, 0x7E},\r
 412         {0x33A0, 0xB3},\r
 413         {0x33A1, 0x4A},\r
 414         {0x3200, 0x3E},\r
 415         {0x3201, 0x3F},\r
 416         {0x302A, 0x00},\r
 417         {0x302C, 0x0C},\r
 418         {0x302C, 0x0B},\r
 419         {0x302D, 0x02},\r
 420         {0x3022, 0x24},\r
 421         {0x3023, 0x24},\r
 422         {0x3002, 0x00},\r
 423         {0x3003, 0xA4},\r
 424         {0x3004, 0x00},\r
 425         {0x3005, 0xF4},\r
 426         {0x3006, 0x05},\r
 427         {0x3007, 0xA3},\r
 428         {0x3008, 0x04},\r
 429         {0x3009, 0xCC},\r
 430         {0x300A, 0x06},\r
 431         {0x300B, 0x2C},\r
 432         {0x300C, 0x02},\r
 433         {0x300D, 0xDC},\r
 434         {0x300E, 0x05},\r
 435         {0x300F, 0x00},\r
 436         {0x3010, 0x02},\r
 437         {0x3011, 0xD0},\r
 438         {0x32BB, 0x87},\r
 439         {0x32B8, 0x36},\r
 440         {0x32B9, 0x2A},\r
 441         {0x32BC, 0x30},\r
 442         {0x32BD, 0x33},\r
 443         {0x32BE, 0x2D},\r
 444         {0x325C, 0x03},\r
 445         {0x320A, 0x00},\r
 446         {0x3021, 0x06},\r
 447         {0x334A, 0x00},\r
 448         {0x334B, 0x7F},\r
 449         {0x334C, 0x1F},\r
 450         {0x3060, 0x01},\r
 451         SensorEnd\r
 452 };\r
 453 \r
 454 /* 1920x1080 */\r
 455 static struct rk_sensor_reg sensor_1080p[]={\r
 456         SensorEnd\r
 457 };\r
 458 \r
 459 \r
 460 static struct rk_sensor_reg sensor_softreset_data[]={\r
 461     SensorRegVal(0x3021,0x61),\r
 462         SensorEnd\r
 463 };\r
 464 \r
 465 static struct rk_sensor_reg sensor_check_id_data[]={\r
 466     SensorRegVal(0x3000,0),\r
 467     SensorRegVal(0x3001,0),\r
 468         SensorEnd\r
 469 };\r
 470 /*\r
 471 *  The following setting must been filled, if the function is turn on by CONFIG_SENSOR_xxxx\r
 472 */\r
 473 static struct rk_sensor_reg sensor_WhiteB_Auto[]=\r
 474 {\r
 475         //[WB-AUTO]\r
 476         {0x3201, 0x7F},  //AWB auto, bit[4]:1,auto\r
 477         SensorEnd\r
 478 };\r
 479 /* Cloudy Colour Temperature : 6500K - 8000K  */\r
 480 static  struct rk_sensor_reg sensor_WhiteB_Cloudy[]=\r
 481 {\r
 482         //[WB-CLOUDY]\r
 483         {0x3201, 0x6F},\r
 484         {0x3290, 0x01},\r
 485         {0x3291, 0x51},\r
 486         {0x3296, 0x01},\r
 487         {0x3297, 0x00},\r
 488         SensorEnd\r
 489 };\r
 490 /* ClearDay Colour Temperature : 5000K - 6500K  */\r
 491 static  struct rk_sensor_reg sensor_WhiteB_ClearDay[]=\r
 492 {\r
 493         //[WB-DAYLIGHT]\r
 494         {0x3201, 0x6F},\r
 495         {0x3290, 0x01},\r
 496         {0x3291, 0x38},\r
 497         {0x3296, 0x01},\r
 498         {0x3297, 0x68}, \r
 499         SensorEnd\r
 500 };\r
 501 /* Office Colour Temperature : 3500K - 5000K  */\r
 502 static  struct rk_sensor_reg sensor_WhiteB_TungstenLamp1[]=\r
 503 {\r
 504         //[WB-INCANDESCENCE]\r
 505         {0x3201, 0x6F},\r
 506         {0x3290, 0x01},\r
 507         {0x3291, 0x30},\r
 508         {0x3296, 0x01},\r
 509         {0x3297, 0xCB},\r
 510         SensorEnd\r
 511 \r
 512 };\r
 513 /* Home Colour Temperature : 2500K - 3500K      */\r
 514 static  struct rk_sensor_reg sensor_WhiteB_TungstenLamp2[]=\r
 515 {\r
 516         //[WB-FLUORESCENT]\r
 517         {0x3201, 0x6F},\r
 518         {0x3290, 0x01},\r
 519         {0x3291, 0x70},\r
 520         {0x3296, 0x01},\r
 521         {0x3297, 0xFF},\r
 522         SensorEnd\r
 523 };\r
 524 static  struct rk_sensor_reg sensor_WhiteB_TungstenLamp3[]=\r
 525 {\r
 526         //[WB-TUNGSTEN]\r
 527         {0x3201, 0x6F},\r
 528         {0x3290, 0x01},\r
 529         {0x3291, 0x00},\r
 530         {0x3296, 0x02},\r
 531         {0x3297, 0x30}, \r
 532         SensorEnd\r
 533 };\r
 534 \r
 535 static struct rk_sensor_reg *sensor_WhiteBalanceSeqe[] = {sensor_WhiteB_Auto, sensor_WhiteB_TungstenLamp1,sensor_WhiteB_TungstenLamp2,\r
 536         sensor_WhiteB_ClearDay, sensor_WhiteB_Cloudy, sensor_WhiteB_TungstenLamp3, NULL,\r
 537 };\r
 538 \r
 539 static  struct rk_sensor_reg sensor_Brightness0[]=\r
 540 {\r
 541         // Brightness -2\r
 542         SensorEnd\r
 543 };\r
 544 \r
 545 static  struct rk_sensor_reg sensor_Brightness1[]=\r
 546 {\r
 547         // Brightness -1\r
 548 \r
 549         SensorEnd\r
 550 };\r
 551 \r
 552 static  struct rk_sensor_reg sensor_Brightness2[]=\r
 553 {\r
 554         //      Brightness 0\r
 555 \r
 556         SensorEnd\r
 557 };\r
 558 \r
 559 static  struct rk_sensor_reg sensor_Brightness3[]=\r
 560 {\r
 561         // Brightness +1\r
 562 \r
 563         SensorEnd\r
 564 };\r
 565 \r
 566 static  struct rk_sensor_reg sensor_Brightness4[]=\r
 567 {\r
 568         //      Brightness +2\r
 569 \r
 570         SensorEnd\r
 571 };\r
 572 \r
 573 static  struct rk_sensor_reg sensor_Brightness5[]=\r
 574 {\r
 575         //      Brightness +3\r
 576 \r
 577         SensorEnd\r
 578 };\r
 579 static struct rk_sensor_reg *sensor_BrightnessSeqe[] = {sensor_Brightness0, sensor_Brightness1, sensor_Brightness2, sensor_Brightness3,\r
 580         sensor_Brightness4, sensor_Brightness5,NULL,\r
 581 };\r
 582 \r
 583 static  struct rk_sensor_reg sensor_Effect_Normal[] =\r
 584 {\r
 585         {0x32f1, 0x00},\r
 586         {0x32f8, 0x01},\r
 587         SensorEnd\r
 588 };\r
 589 \r
 590 static  struct rk_sensor_reg sensor_Effect_WandB[] =\r
 591 {\r
 592         //[SE-GrayScale]\r
 593         {0x32f1, 0x01},\r
 594         {0x32f8, 0x01},\r
 595         SensorEnd\r
 596 };\r
 597 \r
 598 static  struct rk_sensor_reg sensor_Effect_Sepia[] =\r
 599 {\r
 600         //[SE-SEPIA]\r
 601         {0x32f1, 0x02},\r
 602         {0x32f8, 0x01},\r
 603         SensorEnd\r
 604 };\r
 605 \r
 606 static  struct rk_sensor_reg sensor_Effect_Negative[] =\r
 607 {\r
 608         //[SE-Inverse] \r
 609         {0x32f1, 0x03},\r
 610         {0x32f8, 0x01},\r
 611         SensorEnd\r
 612 };\r
 613 static  struct rk_sensor_reg sensor_Effect_Bluish[] =\r
 614 {\r
 615         //[SE-SEPIABlue]\r
 616         {0x32f1, 0x05},\r
 617         {0x32f4, 0xf0},\r
 618         {0x32f5, 0x80},\r
 619         {0x32f8, 0x01}, \r
 620         SensorEnd\r
 621 };\r
 622 \r
 623 static  struct rk_sensor_reg sensor_Effect_Green[] =\r
 624 {\r
 625         //[SE-SEPIAGreen]\r
 626         {0x32f1, 0x05},\r
 627         {0x32f4, 0x60},\r
 628         {0x32f5, 0x20},\r
 629         {0x32f8, 0x01},\r
 630         SensorEnd\r
 631 };\r
 632 \r
 633 static  struct rk_sensor_reg sensor_Effect_Solarization[] =\r
 634 {\r
 635         //[SE-Solarization]\r
 636         {0x32f1, 0x04},\r
 637         {0x32f8, 0x01},\r
 638         SensorEnd\r
 639 };\r
 640 \r
 641 static struct rk_sensor_reg *sensor_EffectSeqe[] = {sensor_Effect_Normal, sensor_Effect_WandB, sensor_Effect_Negative,sensor_Effect_Sepia,\r
 642         sensor_Effect_Bluish, sensor_Effect_Green, sensor_Effect_Solarization, NULL,\r
 643 };\r
 644 \r
 645 static  struct rk_sensor_reg sensor_Exposure04[]=\r
 646 {\r
 647         //[EV-4]                                \r
 648         {0x32F2, 0x40},\r
 649         {0x32F8, 0x01},\r
 650         SensorEnd\r
 651 };\r
 652 \r
 653 static  struct rk_sensor_reg sensor_Exposure03[]=\r
 654 {\r
 655         //[EV-3]                                \r
 656         {0x32F2, 0x50},\r
 657         {0x32F8, 0x01},\r
 658         SensorEnd\r
 659 };\r
 660 \r
 661 static  struct rk_sensor_reg sensor_Exposure02[]=\r
 662 {\r
 663         //[EV-2]              \r
 664         {0x32F2, 0x60},\r
 665         {0x32F8, 0x01},\r
 666         SensorEnd\r
 667 };\r
 668 \r
 669 static  struct rk_sensor_reg sensor_Exposure01[]=\r
 670 {\r
 671         //[EV-1]                                \r
 672         {0x32F2, 0x70},\r
 673         {0x32F8, 0x01},\r
 674         SensorEnd\r
 675 };\r
 676 \r
 677 static  struct rk_sensor_reg sensor_Exposure00[]=\r
 678 {\r
 679         //[EV+0]                                \r
 680         {0x32F2, 0x80},\r
 681         {0x32F8, 0x01},\r
 682         SensorEnd\r
 683 };\r
 684 \r
 685 static  struct rk_sensor_reg sensor_Exposure11[]=\r
 686 {\r
 687         //[EV+1]              \r
 688         {0x32F2, 0x90},\r
 689         {0x32F8, 0x01},\r
 690         SensorEnd\r
 691 };\r
 692 \r
 693 static  struct rk_sensor_reg sensor_Exposure12[]=\r
 694 {\r
 695         //[EV+2]                                \r
 696         {0x32F2, 0xA0},\r
 697         {0x32F8, 0x01},\r
 698         SensorEnd\r
 699 };\r
 700 \r
 701 static  struct rk_sensor_reg sensor_Exposure13[]=\r
 702 {\r
 703         //[EV+3]              \r
 704         {0x32F2, 0xB0},\r
 705         {0x32F8, 0x01},\r
 706         SensorEnd\r
 707 };\r
 708 \r
 709 static  struct rk_sensor_reg sensor_Exposure14[]=\r
 710 {\r
 711         //[EV+4]                                \r
 712         {0x32F2, 0xC0},\r
 713         {0x32F8, 0x01},\r
 714         SensorEnd\r
 715 };\r
 716 \r
 717 static struct rk_sensor_reg *sensor_ExposureSeqe[] = {/*sensor_Exposure04,*/sensor_Exposure03, sensor_Exposure02, sensor_Exposure01, sensor_Exposure00,\r
 718         sensor_Exposure11, sensor_Exposure12,sensor_Exposure13,/*sensor_Exposure14,*/NULL,\r
 719 };\r
 720 \r
 721 \r
 722 static  struct rk_sensor_reg sensor_Saturation0[]=\r
 723 {\r
 724         SensorEnd\r
 725 };\r
 726 \r
 727 static  struct rk_sensor_reg sensor_Saturation1[]=\r
 728 {\r
 729         SensorEnd\r
 730 };\r
 731 \r
 732 static  struct rk_sensor_reg sensor_Saturation2[]=\r
 733 {\r
 734         SensorEnd\r
 735 };\r
 736 static struct rk_sensor_reg *sensor_SaturationSeqe[] = {sensor_Saturation0, sensor_Saturation1, sensor_Saturation2, NULL,};\r
 737 \r
 738 static  struct rk_sensor_reg sensor_Contrast04[]=\r
 739 {\r
 740         //[Contrast : -4]        \r
 741         {0x32FC, 0x40},\r
 742         {0x32F2, 0x40},\r
 743         {0x32f8, 0x01},\r
 744         SensorEnd\r
 745 };\r
 746 \r
 747 static  struct rk_sensor_reg sensor_Contrast03[]=\r
 748 {\r
 749         //[Contrast : -3]            \r
 750         {0x32FC, 0x30},\r
 751         {0x32F2, 0x50},\r
 752         {0x32f8, 0x01},\r
 753         SensorEnd\r
 754 };\r
 755 \r
 756 static  struct rk_sensor_reg sensor_Contrast02[]=\r
 757 {\r
 758         //[Contrast : -2]            \r
 759         {0x32FC, 0x20},\r
 760         {0x32F2, 0x60},\r
 761         {0x32f8, 0x01},\r
 762         SensorEnd\r
 763 };\r
 764 \r
 765 static  struct rk_sensor_reg sensor_Contrast01[]=\r
 766 {\r
 767         //[Contrast : -1]      \r
 768         {0x32FC, 0x10},\r
 769         {0x32F2, 0x70},\r
 770         {0x32f8, 0x01},\r
 771         SensorEnd\r
 772 };\r
 773 \r
 774 static  struct rk_sensor_reg sensor_Contrast00[]=\r
 775 {\r
 776         //[Contrast : 0]             \r
 777         {0x32FC, 0x00},\r
 778         {0x32F2, 0x80},\r
 779         {0x32f8, 0x01},\r
 780         SensorEnd\r
 781 };\r
 782 \r
 783 static  struct rk_sensor_reg sensor_Contrast11[]=\r
 784 {\r
 785         //[Contrast : +1]            \r
 786         {0x32FC, 0xF0},\r
 787         {0x32F2, 0x90},\r
 788         {0x32f8, 0x01},\r
 789         SensorEnd\r
 790 };\r
 791 \r
 792 \r
 793 static  struct rk_sensor_reg sensor_Contrast12[]=\r
 794 {\r
 795         //[Contrast : +2]            \r
 796         {0x32FC, 0xE0},\r
 797         {0x32F2, 0xA0},\r
 798         {0x32f8, 0x01},\r
 799         SensorEnd\r
 800 };\r
 801 \r
 802 static  struct rk_sensor_reg sensor_Contrast13[]=\r
 803 {\r
 804         //[Contrast : +3]            \r
 805         {0x32FC, 0xD0},\r
 806         {0x32F2, 0xB0},\r
 807         {0x32f8, 0x01},\r
 808         SensorEnd\r
 809 };\r
 810 \r
 811 static  struct rk_sensor_reg sensor_Contrast14[]=\r
 812 {\r
 813         //[Contrast : +4]        \r
 814         {0x32FC, 0xC0},\r
 815         {0x32F2, 0xC0},\r
 816         {0x32f8, 0x01},\r
 817         SensorEnd\r
 818 };\r
 819 static struct rk_sensor_reg *sensor_ContrastSeqe[] = {sensor_Contrast04, sensor_Contrast03, sensor_Contrast02, sensor_Contrast01,\r
 820         sensor_Contrast00, sensor_Contrast11, sensor_Contrast12, sensor_Contrast13, sensor_Contrast14,NULL,\r
 821 };\r
 822 \r
 823 static  struct rk_sensor_reg sensor_SceneAuto[] =\r
 824 {\r
 825         SensorEnd\r
 826 };\r
 827 \r
 828 static  struct rk_sensor_reg sensor_SceneNight[] =\r
 829 {\r
 830         SensorEnd\r
 831 };\r
 832 static struct rk_sensor_reg *sensor_SceneSeqe[] = {sensor_SceneAuto, sensor_SceneNight,NULL,};\r
 833 \r
 834 static struct rk_sensor_reg sensor_Zoom0[] =\r
 835 {\r
 836         SensorEnd\r
 837 };\r
 838 \r
 839 static struct rk_sensor_reg sensor_Zoom1[] =\r
 840 {\r
 841         SensorEnd\r
 842 };\r
 843 \r
 844 static struct rk_sensor_reg sensor_Zoom2[] =\r
 845 {\r
 846         SensorEnd\r
 847 };\r
 848 \r
 849 \r
 850 static struct rk_sensor_reg sensor_Zoom3[] =\r
 851 {\r
 852         SensorEnd\r
 853 };\r
 854 static struct rk_sensor_reg *sensor_ZoomSeqe[] = {sensor_Zoom0, sensor_Zoom1, sensor_Zoom2, sensor_Zoom3, NULL,};\r
 855 \r
 856 /*\r
 857 * User could be add v4l2_querymenu in sensor_controls by new_usr_v4l2menu\r
 858 */\r
 859 static struct v4l2_querymenu sensor_menus[] =\r
 860 {\r
 861         //white balance\r
 862         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,0,"auto",0),\r
 863         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,1,"incandescent",0),\r
 864         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,2,"fluorescent",0),\r
 865         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,3,"daylight",0),\r
 866         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,4,"cloudy-daylight",0),\r
 867         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,5,"tungsten",0),\r
 868 \r
 869         //speical effect\r
 870         new_usr_v4l2menu(V4L2_CID_EFFECT,0,"none",0),\r
 871         new_usr_v4l2menu(V4L2_CID_EFFECT,1,"mono",0),\r
 872         new_usr_v4l2menu(V4L2_CID_EFFECT,2,"negative",0),\r
 873         new_usr_v4l2menu(V4L2_CID_EFFECT,3,"sepia",0),\r
 874         new_usr_v4l2menu(V4L2_CID_EFFECT,4,"posterize",0),\r
 875         new_usr_v4l2menu(V4L2_CID_EFFECT,5,"aqua",0),\r
 876         new_usr_v4l2menu(V4L2_CID_EFFECT,6,"solarize",0),\r
 877 \r
 878 };\r
 879 /*\r
 880 * User could be add v4l2_queryctrl in sensor_controls by new_user_v4l2ctrl\r
 881 */\r
 882 static struct sensor_v4l2ctrl_usr_s sensor_controls[] =\r
 883 {\r
 884         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
 885         new_user_v4l2ctrl(V4L2_CID_EXPOSURE,V4L2_CTRL_TYPE_INTEGER,"Exposure Control", -3, 3, 1, 0,sensor_v4l2ctrl_default_cb, sensor_ExposureSeqe),\r
 886         new_user_v4l2ctrl(V4L2_CID_EFFECT,V4L2_CTRL_TYPE_MENU,"Effect Control", 0, 6, 1, 0,sensor_v4l2ctrl_default_cb, sensor_EffectSeqe),\r
 887         new_user_v4l2ctrl(V4L2_CID_CONTRAST,V4L2_CTRL_TYPE_INTEGER,"Contrast Control", -4, 4, 1, 0,sensor_v4l2ctrl_default_cb, sensor_ContrastSeqe),\r
 888 };\r
 889 \r
 890 //MUST define the current used format as the first item   \r
 891 static struct rk_sensor_datafmt sensor_colour_fmts[] = {\r
 892         {V4L2_MBUS_FMT_UYVY8_2X8, V4L2_COLORSPACE_JPEG},\r
 893         {V4L2_MBUS_FMT_YUYV8_2X8, V4L2_COLORSPACE_JPEG} \r
 894 };\r
 895 static struct soc_camera_ops sensor_ops;\r
 896 \r
 897 \r
 898 /*\r
 899 **********************************************************\r
 900 * Following is local code:\r
 901 * \r
 902 * Please codeing your program here \r
 903 **********************************************************\r
 904 */\r
 905 \r
 906 /*\r
 907 **********************************************************\r
 908 * Following is callback\r
 909 * If necessary, you could coding these callback\r
 910 **********************************************************\r
 911 */\r
 912 /*\r
 913 * the function is called in open sensor  \r
 914 */\r
 915 static int sensor_activate_cb(struct i2c_client *client)\r
 916 {\r
 917     SENSOR_DG("%s",__FUNCTION__);       \r
 918         return 0;\r
 919 }\r
 920 /*\r
 921 * the function is called in close sensor\r
 922 */\r
 923 static int sensor_deactivate_cb(struct i2c_client *client)\r
 924 {\r
 925         struct generic_sensor *sensor = to_generic_sensor(client);\r
 926 \r
 927     SENSOR_DG("%s",__FUNCTION__);\r
 928     \r
 929         /* ddl@rock-chips.com : all sensor output pin must switch into Hi-Z */\r
 930         if (sensor->info_priv.funmodule_state & SENSOR_INIT_IS_OK) {\r
 931                 //generic_sensor_ioctrl(icd, Sensor_PowerDown, 1);\r
 932                  sensor->info_priv.funmodule_state &= ~SENSOR_INIT_IS_OK;\r
 933         }\r
 934         return 0;\r
 935 }\r
 936 /*\r
 937 * the function is called before sensor register setting in VIDIOC_S_FMT  \r
 938 */\r
 939 static int sensor_s_fmt_cb_th(struct i2c_client *client,struct v4l2_mbus_framefmt *mf, bool capture)\r
 940 {\r
 941     if (capture) {\r
 942         //sensor_parameter_record(client);\r
 943     }\r
 944 \r
 945     return 0;\r
 946 }\r
 947 /*\r
 948 * the function is called after sensor register setting finished in VIDIOC_S_FMT  \r
 949 */\r
 950 static int sensor_s_fmt_cb_bh (struct i2c_client *client,struct v4l2_mbus_framefmt *mf, bool capture)\r
 951 {\r
 952     if (capture) {\r
 953         //sensor_ae_transfer(client);\r
 954     }\r
 955     return 0;\r
 956 }\r
 957 \r
 958 static int sensor_try_fmt_cb_th(struct i2c_client *client,struct v4l2_mbus_framefmt *mf)\r
 959 {\r
 960         return 0;\r
 961 }\r
 962 \r
 963 static int sensor_softrest_usr_cb(struct i2c_client *client,struct rk_sensor_reg *series)\r
 964 {\r
 965         \r
 966         return 0;\r
 967 }\r
 968 static int sensor_check_id_usr_cb(struct i2c_client *client,struct rk_sensor_reg *series)\r
 969 {\r
 970         return 0;\r
 971 }\r
 972 \r
 973 static int sensor_suspend(struct soc_camera_device *icd, pm_message_t pm_msg)\r
 974 {\r
 975         //struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));\r
 976                 \r
 977         if (pm_msg.event == PM_EVENT_SUSPEND) {\r
 978                 SENSOR_DG("Suspend");\r
 979                 \r
 980         } else {\r
 981                 SENSOR_TR("pm_msg.event(0x%x) != PM_EVENT_SUSPEND\n",pm_msg.event);\r
 982                 return -EINVAL;\r
 983         }\r
 984         return 0;\r
 985 }\r
 986 \r
 987 static int sensor_resume(struct soc_camera_device *icd)\r
 988 {\r
 989 \r
 990         SENSOR_DG("Resume");\r
 991 \r
 992         return 0;\r
 993 \r
 994 }\r
 995 static int sensor_mirror_cb (struct i2c_client *client, int mirror)\r
 996 {\r
 997         char val;\r
 998         int err = 0;\r
 999     \r
1000     SENSOR_DG("mirror: %d",mirror);\r
1001         if (mirror) {\r
1002                 err = sensor_read(client, 0x3022, &val);\r
1003                 if (err == 0) {\r
1004                         val |= 0x02;\r
1005                         err = sensor_write(client, 0x3022, val);\r
1006                 }\r
1007         } else {\r
1008                 err = sensor_read(client, 0x3022, &val);\r
1009                 if (err == 0) {\r
1010                         val &= 0xfd;\r
1011                         err = sensor_write(client, 0x3022, val);\r
1012                 }\r
1013         }\r
1014 \r
1015         return err;    \r
1016 }\r
1017 /*\r
1018 * the function is v4l2 control V4L2_CID_HFLIP callback  \r
1019 */\r
1020 static int sensor_v4l2ctrl_mirror_cb(struct soc_camera_device *icd, struct sensor_v4l2ctrl_info_s *ctrl_info, \r
1021                                                      struct v4l2_ext_control *ext_ctrl)\r
1022 {\r
1023         struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));\r
1024 \r
1025     if (sensor_mirror_cb(client,ext_ctrl->value) != 0)\r
1026                 SENSOR_TR("sensor_mirror failed, value:0x%x",ext_ctrl->value);\r
1027         \r
1028         SENSOR_DG("sensor_mirror success, value:0x%x",ext_ctrl->value);\r
1029         return 0;\r
1030 }\r
1031 \r
1032 static int sensor_flip_cb(struct i2c_client *client, int flip)\r
1033 {\r
1034         char val;\r
1035         int err = 0;    \r
1036 \r
1037     SENSOR_DG("flip: %d",flip);\r
1038         if (flip) {\r
1039                 err = sensor_read(client, 0x3022, &val);\r
1040                 if (err == 0) {\r
1041                         val |= 0x01;\r
1042                         err = sensor_write(client, 0x3022, val);\r
1043                 }\r
1044         } else {\r
1045                 err = sensor_read(client, 0x3022, &val);\r
1046                 if (err == 0) {\r
1047                         val &= 0xfe;\r
1048                         err = sensor_write(client, 0x3022, val);\r
1049                 }\r
1050         }\r
1051 \r
1052         return err;    \r
1053 }\r
1054 /*\r
1055 * the function is v4l2 control V4L2_CID_VFLIP callback  \r
1056 */\r
1057 static int sensor_v4l2ctrl_flip_cb(struct soc_camera_device *icd, struct sensor_v4l2ctrl_info_s *ctrl_info, \r
1058                                                      struct v4l2_ext_control *ext_ctrl)\r
1059 {\r
1060         struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));\r
1061 \r
1062     if (sensor_flip_cb(client,ext_ctrl->value) != 0)\r
1063                 SENSOR_TR("sensor_flip failed, value:0x%x",ext_ctrl->value);\r
1064         \r
1065         SENSOR_DG("sensor_flip success, value:0x%x",ext_ctrl->value);\r
1066         return 0;\r
1067 }\r
1068 static int sensor_focus_init_usr_cb(struct i2c_client *client){\r
1069         return 0;\r
1070 }\r
1071 \r
1072 static int sensor_focus_af_single_usr_cb(struct i2c_client *client){\r
1073         return 0;\r
1074 }\r
1075 \r
1076 static int sensor_focus_af_near_usr_cb(struct i2c_client *client){\r
1077         return 0;\r
1078 }\r
1079 \r
1080 static int sensor_focus_af_far_usr_cb(struct i2c_client *client){\r
1081         return 0;\r
1082 }\r
1083 \r
1084 static int sensor_focus_af_specialpos_usr_cb(struct i2c_client *client,int pos){\r
1085         return 0;\r
1086 }\r
1087 \r
1088 static int sensor_focus_af_const_usr_cb(struct i2c_client *client){\r
1089         return 0;\r
1090 }\r
1091 static int sensor_focus_af_const_pause_usr_cb(struct i2c_client *client)
1092 {
1093     return 0;
1094 }\r
1095 static int sensor_focus_af_close_usr_cb(struct i2c_client *client){\r
1096         return 0;\r
1097 }\r
1098 \r
1099 static int sensor_focus_af_zoneupdate_usr_cb(struct i2c_client *client, int *zone_tm_pos)\r
1100 {\r
1101         return 0;\r
1102 }\r
1103 \r
1104 /*\r
1105 face defect call back\r
1106 */\r
1107 static int      sensor_face_detect_usr_cb(struct i2c_client *client,int on){\r
1108         return 0;\r
1109 }\r
1110 \r
1111 /*\r
1112 *   The function can been run in sensor_init_parametres which run in sensor_probe, so user can do some\r
1113 * initialization in the function. \r
1114 */\r
1115 static void sensor_init_parameters_user(struct specific_sensor* spsensor,struct soc_camera_device *icd)\r
1116 {\r
1117     return;\r
1118 }\r
1119 \r
1120 /*\r
1121 * :::::WARNING:::::\r
1122 * It is not allowed to modify the following code\r
1123 */\r
1124 \r
1125 sensor_init_parameters_default_code();\r
1126 \r
1127 sensor_v4l2_struct_initialization();\r
1128 \r
1129 sensor_probe_default_code();\r
1130 \r
1131 sensor_remove_default_code();\r
1132 \r
1133 sensor_driver_default_module_code();\r
1134 \r
1135 \r
1136 \r