265b292419601be4a52a9ca319a6dc562b7c53eb
[firefly-linux-kernel-4.4.55.git] / drivers / media / video / nt99160_2way.c
1 \r
2 #include "generic_sensor.h"\r
3 \r
4 /*
5 *      Driver Version Note\r
6 *v0.0.1: this driver is compatible with generic_sensor\r
7 *v0.1.1:\r
8 *        add sensor_focus_af_const_pause_usr_cb;\r
9 */\r
10 static int version = KERNEL_VERSION(0,1,1);\r
11 module_param(version, int, S_IRUGO);\r
12 \r
13 static int debug =1;\r
14 module_param(debug, int, S_IRUGO|S_IWUSR);\r
15 \r
16 #define dprintk(level, fmt, arg...) do {                        \\r
17         if (debug >= level)                                     \\r
18         printk(KERN_WARNING fmt , ## arg); } while (0)\r
19 \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  (SOCAM_MASTER | SOCAM_PCLK_SAMPLE_RISING |\\r
26                           SOCAM_HSYNC_ACTIVE_HIGH | SOCAM_VSYNC_ACTIVE_HIGH|\\r
27                           SOCAM_DATA_ACTIVE_HIGH | SOCAM_DATAWIDTH_8  |SOCAM_MCLK_24MHZ)\r
28 \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
37 \r
38 #define SENSOR_REGISTER_LEN                  2         // sensor register address bytes\r
39 #define SENSOR_VALUE_LEN                     1         // sensor register value bytes\r
40 \r
41 static unsigned int SensorConfiguration = 0;\r
42 static unsigned int SensorChipID[] = {SENSOR_ID};\r
43 \r
44 /* Sensor Driver Configuration End */\r
45 \r
46 \r
47 #define SENSOR_NAME_STRING(a) STR(CONS(SENSOR_NAME, a))\r
48 #define SENSOR_NAME_VARFUN(a) CONS(SENSOR_NAME, a)\r
49 \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
54 \r
55 struct sensor_parameter\r
56 {\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
62 \r
63         unsigned short int PreviewPclk;\r
64         unsigned short int CapturePclk;\r
65         char awb[6];\r
66 };\r
67 \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
72 \r
73 };\r
74 \r
75 /*\r
76 *  The follow setting need been filled.\r
77 *  \r
78 *  Must 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
84 *\r
85 *  Optional filled:\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
89 *\r
90 *  :::::WARNING:::::\r
91 *  The SensorEnd which is the setting end flag must be filled int the last of each setting;\r
92 */\r
93 \r
94 /* Sensor initial setting */\r
95 static struct rk_sensor_reg sensor_init_data[] ={\r
96         {0x3100, 0x03},\r
97         {0x3101, 0x80},\r
98         {0x3102, 0x09},\r
99         {0x3104, 0x03},\r
100         {0x3105, 0x03},\r
101         {0x3106, 0x05},\r
102         {0x3107, 0x40},\r
103         {0x3108, 0x00},\r
104         {0x3109, 0x82},\r
105         {0x310A, 0x04},\r
106         {0x310B, 0x00},\r
107         {0x310C, 0x00},\r
108         {0x3111, 0x56},\r
109         {0x3113, 0x66},\r
110         {0x3118, 0xA7},\r
111         {0x3119, 0xA7},\r
112         {0x311A, 0xA7},\r
113         {0x311B, 0x1F},           \r
114         {0x303f, 0x0e},\r
115         {0x3041, 0x04},\r
116         {0x3051, 0xf4},\r
117         {0x320A, 0x5A},\r
118         {0x3250, 0x80},   \r
119         {0x3251, 0x01},\r
120         {0x3252, 0x38},\r
121         {0x3253, 0xA8},\r
122         {0x3254, 0x01},\r
123         {0x3255, 0x00},\r
124         {0x3256, 0x8C},\r
125         {0x3257, 0x70},\r
126         {0x329B, 0x00},\r
127         {0x32A1, 0x00},\r
128         {0x32A2, 0xd8},\r
129         {0x32A3, 0x01},\r
130         {0x32A4, 0x5d},\r
131         {0x32A5, 0x01},\r
132         {0x32A6, 0x0c},\r
133         {0x32A7, 0x01},\r
134         {0x32A8, 0xa8}, \r
135         {0x3210, 0x32},   \r
136         {0x3211, 0x2a},\r
137         {0x3212, 0x30},\r
138         {0x3213, 0x32},\r
139         {0x3214, 0x2e},\r
140         {0x3215, 0x2e},\r
141         {0x3216, 0x2e},\r
142         {0x3217, 0x2e},\r
143         {0x3218, 0x2c},\r
144         {0x3219, 0x2e},\r
145         {0x321A, 0x2a},\r
146         {0x321B, 0x2a},\r
147         {0x321C, 0x2e},\r
148         {0x321D, 0x2e},\r
149         {0x321E, 0x28},\r
150         {0x321F, 0x2c},   \r
151         {0x3220, 0x01},\r
152         {0x3221, 0x48},\r
153         {0x3222, 0x01},\r
154         {0x3223, 0x48},\r
155         {0x3224, 0x01},\r
156         {0x3225, 0x48},\r
157         {0x3226, 0x01},\r
158         {0x3227, 0x48},\r
159         {0x3228, 0x00},\r
160         {0x3229, 0xa4},\r
161         {0x322A, 0x00},\r
162         {0x322B, 0xa4},\r
163         {0x322C, 0x00},\r
164         {0x322D, 0xa4},\r
165         {0x322E, 0x00},\r
166         {0x322F, 0xa4},\r
167         {0x3243, 0xc2}, \r
168         {0x3270, 0x10},\r
169         {0x3271, 0x1B},\r
170         {0x3272, 0x26},\r
171         {0x3273, 0x3E},\r
172         {0x3274, 0x4F},\r
173         {0x3275, 0x5E},\r
174         {0x3276, 0x78},\r
175         {0x3277, 0x8F},\r
176         {0x3278, 0xA3},\r
177         {0x3279, 0xB4},\r
178         {0x327A, 0xD2},\r
179         {0x327B, 0xE3},\r
180         {0x327C, 0xF0},\r
181         {0x327D, 0xF7},\r
182         {0x327E, 0xFF}, \r
183         {0x32F6, 0x0C},\r
184         {0x33c2, 0xF0},\r
185         {0x3302, 0x00},\r
186         {0x3303, 0x3E},\r
187         {0x3304, 0x00},\r
188         {0x3305, 0xC2},\r
189         {0x3306, 0x00},\r
190         {0x3307, 0x00},\r
191         {0x3308, 0x07},\r
192         {0x3309, 0xC4},\r
193         {0x330A, 0x06},\r
194         {0x330B, 0xED},\r
195         {0x330C, 0x01},\r
196         {0x330D, 0x4F},\r
197         {0x330E, 0x01},\r
198         {0x330F, 0x41},\r
199         {0x3310, 0x06},\r
200         {0x3311, 0xDD},\r
201         {0x3312, 0x07},\r
202         {0x3313, 0xE3}, \r
203         {0x3326, 0x14},\r
204         {0x3327, 0x04},\r
205         {0x3328, 0x04},\r
206         {0x3329, 0x02},\r
207         {0x332A, 0x02},\r
208         {0x332B, 0x1D},\r
209         {0x332C, 0x1D},\r
210         {0x332D, 0x04},\r
211         {0x332E, 0x1E},\r
212         {0x332F, 0x1F}, \r
213         {0x3331, 0x0a},\r
214         {0x3332, 0x40},\r
215         {0x33C9, 0xD8},\r
216         {0x33C0, 0x01},\r
217         {0x333F, 0x07},\r
218         {0x3360, 0x10},\r
219         {0x3361, 0x18},\r
220         {0x3362, 0x1f},\r
221         {0x3363, 0xb3},          \r
222         {0x3368, 0xb0},\r
223         {0x3369, 0xa0},\r
224         {0x336A, 0x90},\r
225         {0x336B, 0x80},\r
226         {0x336C, 0x00},\r
227         {0x3363, 0xB3},\r
228         {0x3364, 0x00},\r
229         {0x3365, 0x10},\r
230         {0x3366, 0x06},          \r
231         {0x336d, 0x18},\r
232         {0x336e, 0x18},\r
233         {0x336f, 0x10},\r
234         {0x3370, 0x10},                      \r
235         {0x3371, 0x3F},\r
236         {0x3372, 0x3F},\r
237         {0x3373, 0x3F},\r
238         {0x3374, 0x3F},\r
239         {0x3375, 0x20},\r
240         {0x3376, 0x20},\r
241         {0x3377, 0x28},\r
242         {0x3378, 0x30},                      \r
243         {0x32f6, 0x0C},\r
244         {0x33A0, 0xE0},\r
245         {0x33A1, 0x20},\r
246         {0x33A2, 0x00},\r
247         {0x33A3, 0x40},\r
248         {0x33A4, 0x00},\r
249         {0x32BF, 0x60},\r
250         SensorEnd\r
251 };\r
252 \r
253 static struct rk_sensor_reg sensor_fullres_lowfps_data[] ={\r
254         {0x32BF, 0x60},\r
255         {0x32C0, 0x84},\r
256         {0x32C1, 0x84},\r
257         {0x32C2, 0x84},\r
258         {0x32C3, 0x00},\r
259         {0x32C4, 0x20},\r
260         {0x32C5, 0x20},\r
261         {0x32C6, 0x20},\r
262         {0x32C7, 0x00},\r
263         {0x32C8, 0x95},\r
264         {0x32C9, 0x84},\r
265         {0x32CA, 0xA4},\r
266         {0x32CB, 0xA4},\r
267         {0x32CC, 0xA4},\r
268         {0x32CD, 0xA4},\r
269         {0x32DB, 0x72},\r
270         {0x3241, 0x8B},\r
271         {0x32F0, 0x00},\r
272         {0x3200, 0x3E},\r
273         {0x3201, 0x0F},\r
274         {0x302A, 0x00},\r
275         {0x302C, 0x07},\r
276         {0x302D, 0x00},\r
277         {0x302E, 0x00},\r
278         {0x302F, 0x02},\r
279         {0x3022, 0x24},\r
280         {0x3023, 0x24},\r
281         {0x3002, 0x00},\r
282         {0x3003, 0x04},//x_start=4\r
283         {0x3004, 0x00},\r
284         {0x3005, 0x04},//y_start=4\r
285         {0x3006, 0x05},\r
286         {0x3007, 0x03},//x_end =1283\r
287         {0x3008, 0x02},\r
288         {0x3009, 0xD3},//y_end =723\r
289         {0x300A, 0x06},\r
290         {0x300B, 0x48},//pixel_num=1608\r
291         {0x300C, 0x0B},\r
292         {0x300D, 0xA9},//line_num=2985\r
293         {0x300E, 0x05},\r
294         {0x300F, 0x00},//x_width = 1280\r
295         {0x3010, 0x02},\r
296         {0x3011, 0xD0},//y_height=720\r
297         {0x32B8, 0x3F},\r
298         {0x32B9, 0x31},\r
299         {0x32BB, 0x87},\r
300         {0x32BC, 0x38},\r
301         {0x32BD, 0x3C},\r
302         {0x32BE, 0x34},\r
303         {0x3201, 0x3F},\r
304         {0x3109, 0x82},\r
305         {0x310B, 0x00},\r
306         {0x3530, 0xC0},\r
307         {0x3021, 0x06},\r
308         {0x3060, 0x01},\r
309         SensorEnd\r
310 };\r
311 \r
312 \r
313 /* Senor full resolution setting: recommand for capture */\r
314 static struct rk_sensor_reg sensor_fullres_midfps_data[] ={\r
315         {0x32BF, 0x60},\r
316         {0x32C0, 0x74},\r
317         {0x32C1, 0x74},\r
318         {0x32C2, 0x74},\r
319         {0x32C3, 0x00},\r
320         {0x32C4, 0x20},\r
321         {0x32C5, 0x20},\r
322         {0x32C6, 0x20},\r
323         {0x32C7, 0x00},\r
324         {0x32C8, 0x95},\r
325         {0x32C9, 0x74},\r
326         {0x32CA, 0x94},\r
327         {0x32CB, 0x94},\r
328         {0x32CC, 0x94},\r
329         {0x32CD, 0x94},\r
330         {0x32DB, 0x72},\r
331         {0x3241, 0x83},\r
332         {0x32F0, 0x00},\r
333         {0x3200, 0x3E},\r
334         {0x3201, 0x0F},\r
335         {0x302A, 0x00},\r
336         {0x302C, 0x07},\r
337         {0x302D, 0x00},\r
338         {0x302E, 0x00},\r
339         {0x302F, 0x02},\r
340         {0x3022, 0x27},\r
341         {0x3023, 0x24},\r
342         {0x3002, 0x00},\r
343         {0x3003, 0x04},//x_start=4\r
344         {0x3004, 0x00},\r
345         {0x3005, 0x04},//y_start=4\r
346         {0x3006, 0x05},\r
347         {0x3007, 0x03},//x_end = 1283\r
348         {0x3008, 0x02},\r
349         {0x3009, 0xD3},//y_end =723\r
350         {0x300A, 0x06},\r
351         {0x300B, 0x48},//pixel_num = 1608\r
352         {0x300C, 0x05},\r
353         {0x300D, 0xD4},//line_num = 1492\r
354         {0x300E, 0x05},\r
355         {0x300F, 0x00},//x_width = 1280\r
356         {0x3010, 0x02},\r
357         {0x3011, 0xD0},//y_height=720\r
358         {0x32B8, 0x3F},\r
359         {0x32B9, 0x31},\r
360         {0x32BB, 0x87},\r
361         {0x32BC, 0x38},\r
362         {0x32BD, 0x3C},\r
363         {0x32BE, 0x34},\r
364         {0x3201, 0x3F},\r
365         {0x3109, 0x82},\r
366         {0x310B, 0x00},\r
367         {0x3530, 0xC0},\r
368         {0x3021, 0x06},\r
369         {0x3060, 0x01},\r
370         SensorEnd\r
371 };\r
372 /* Senor full resolution setting: recommand for video */\r
373 static struct rk_sensor_reg sensor_fullres_highfps_data[] ={\r
374         {0x32BF, 0x60},\r
375         {0x32C0, 0x6A},\r
376         {0x32C1, 0x6A},\r
377         {0x32C2, 0x6A},\r
378         {0x32C3, 0x00},\r
379         {0x32C4, 0x20},\r
380         {0x32C5, 0x20},\r
381         {0x32C6, 0x20},\r
382         {0x32C7, 0x00},\r
383         {0x32C8, 0x95},\r
384         {0x32C9, 0x6A},\r
385         {0x32CA, 0x8A},\r
386         {0x32CB, 0x8A},\r
387         {0x32CC, 0x8A},\r
388         {0x32CD, 0x8A},\r
389         {0x32DB, 0x72},\r
390         {0x3241, 0x7E},\r
391         {0x32F0, 0x00},\r
392         {0x3200, 0x3E},\r
393         {0x3201, 0x0F},\r
394         {0x302A, 0x00},\r
395         {0x302C, 0x07},\r
396         {0x302D, 0x00},\r
397         {0x302E, 0x00},\r
398         {0x302F, 0x02},\r
399         {0x3022, 0x27},\r
400         {0x3023, 0x24},\r
401         {0x3002, 0x00},\r
402         {0x3003, 0x04},//x_start=4\r
403         {0x3004, 0x00},\r
404         {0x3005, 0x04},//y_start=4\r
405         {0x3006, 0x05},\r
406         {0x3007, 0x03},//x_end=1283  x_width=1280\r
407         {0x3008, 0x02},\r
408         {0x3009, 0xD3},//y_end=723        y_height=720\r
409         {0x300A, 0x06},\r
410         {0x300B, 0x48},//line_pixel_num =1608\r
411         {0x300C, 0x02},\r
412         {0x300D, 0xEA},//line_num=746\r
413         {0x300E, 0x05},\r
414         {0x300F, 0x00},//x_width = 1280\r
415         {0x3010, 0x02},\r
416         {0x3011, 0xD0},//y_height = 720\r
417         {0x32B8, 0x3F},\r
418         {0x32B9, 0x31},\r
419         {0x32BB, 0x87},\r
420         {0x32BC, 0x38},\r
421         {0x32BD, 0x3C},\r
422         {0x32BE, 0x34},\r
423         {0x3201, 0x3F},\r
424         {0x3109, 0x82},\r
425         {0x310B, 0x00},\r
426         {0x3530, 0xC0},\r
427         {0x3021, 0x06},\r
428         {0x3060, 0x01}, \r
429         SensorEnd\r
430 };\r
431 /* Preview resolution setting*/\r
432 static struct rk_sensor_reg sensor_preview_data[] =\r
433 {\r
434         {0x32BF, 0x60},\r
435         {0x32C0, 0x6A},\r
436         {0x32C1, 0x6A},\r
437         {0x32C2, 0x6A},\r
438         {0x32C3, 0x00},\r
439         {0x32C4, 0x20},\r
440         {0x32C5, 0x20},\r
441         {0x32C6, 0x20},\r
442         {0x32C7, 0x00},\r
443         {0x32C8, 0xBA},\r
444         {0x32C9, 0x6A},\r
445         {0x32CA, 0x8A},\r
446         {0x32CB, 0x8A},\r
447         {0x32CC, 0x8A},\r
448         {0x32CD, 0x8A},\r
449         {0x32DB, 0x77},\r
450         {0x3241, 0x80},\r
451         {0x32E0, 0x03},\r
452         {0x32E1, 0x20},\r
453         {0x32E2, 0x02},\r
454         {0x32E3, 0x58},\r
455         {0x32E4, 0x00},\r
456         {0x32E5, 0x33},\r
457         {0x32E6, 0x00},\r
458         {0x32E7, 0x33},\r
459         {0x32E8, 0x01},\r
460         {0x32F0, 0x00},\r
461         {0x3200, 0x3E},\r
462         {0x3201, 0x0F},\r
463         {0x302A, 0x00},\r
464         {0x302C, 0x07},\r
465         {0x302D, 0x00},\r
466         {0x302E, 0x00},\r
467         {0x302F, 0x02},\r
468         {0x3022, 0x24},\r
469         {0x3023, 0x24},\r
470         {0x3002, 0x00},\r
471         {0x3003, 0xA4},//x_start=164\r
472         {0x3004, 0x00},\r
473         {0x3005, 0x04},//y_start=4\r
474         {0x3006, 0x04},\r
475         {0x3007, 0x63},//x_end=1123\r
476         {0x3008, 0x02},\r
477         {0x3009, 0xD3},//y_end=723\r
478         {0x300A, 0x05},\r
479         {0x300B, 0x08},//pixel_num=1288\r
480         {0x300C, 0x02},\r
481         {0x300D, 0xE0},//line_num=736\r
482         {0x300E, 0x03},\r
483         {0x300F, 0xC0},//x_width=960\r
484         {0x3010, 0x02},\r
485         {0x3011, 0xD0},//y_height=720\r
486         {0x32B8, 0x3F},\r
487         {0x32B9, 0x31},\r
488         {0x32BB, 0x87},\r
489         {0x32BC, 0x38},\r
490         {0x32BD, 0x3C},\r
491         {0x32BE, 0x34},\r
492         {0x3201, 0x7F},\r
493         {0x3109, 0x82},\r
494         {0x310B, 0x00},\r
495         {0x3530, 0xC0},\r
496         {0x3021, 0x06},\r
497         {0x3060, 0x01},\r
498 \r
499         SensorEnd\r
500 };\r
501 /* 1280x720 */\r
502 static struct rk_sensor_reg sensor_720p[]={\r
503         \r
504         {0x32BF, 0x60},\r
505         {0x32C0, 0x84},\r
506         {0x32C1, 0x84},\r
507         {0x32C2, 0x84},\r
508         {0x32C3, 0x00},\r
509         {0x32C4, 0x20},\r
510         {0x32C5, 0x20},\r
511         {0x32C6, 0x20},\r
512         {0x32C7, 0x00},\r
513         {0x32C8, 0x95},\r
514         {0x32C9, 0x84},\r
515         {0x32CA, 0xA4},\r
516         {0x32CB, 0xA4},\r
517         {0x32CC, 0xA4},\r
518         {0x32CD, 0xA4},\r
519         {0x32DB, 0x72},\r
520         {0x3241, 0x8B},\r
521         {0x32F0, 0x00},\r
522         {0x3200, 0x3E},\r
523         {0x3201, 0x0F},\r
524         {0x302A, 0x00},\r
525         {0x302C, 0x07},\r
526         {0x302D, 0x00},\r
527         {0x302E, 0x00},\r
528         {0x302F, 0x02},\r
529         {0x3022, 0x24},\r
530         {0x3023, 0x24},\r
531         {0x3002, 0x00},\r
532         {0x3003, 0x04},//x_start=4\r
533         {0x3004, 0x00},\r
534         {0x3005, 0x04},//y_start=4\r
535         {0x3006, 0x05},\r
536         {0x3007, 0x03},//x_end =1283\r
537         {0x3008, 0x02},\r
538         {0x3009, 0xD3},//y_end =723\r
539         {0x300A, 0x06},\r
540         {0x300B, 0x48},//pixel_num=1608\r
541         {0x300C, 0x0B},\r
542         {0x300D, 0xA9},//line_num=2985\r
543         {0x300E, 0x05},\r
544         {0x300F, 0x00},//x_width = 1280\r
545         {0x3010, 0x02},\r
546         {0x3011, 0xD0},//y_height=720\r
547         {0x32B8, 0x3F},\r
548         {0x32B9, 0x31},\r
549         {0x32BB, 0x87},\r
550         {0x32BC, 0x38},\r
551         {0x32BD, 0x3C},\r
552         {0x32BE, 0x34},\r
553         {0x3201, 0x3F},\r
554         {0x3109, 0x82},\r
555         {0x310B, 0x00},\r
556         {0x3530, 0xC0},\r
557         {0x3021, 0x06},\r
558         {0x3060, 0x01},\r
559         SensorEnd\r
560 };\r
561 \r
562 /* 1920x1080 */\r
563 static struct rk_sensor_reg sensor_1080p[]={\r
564         SensorEnd\r
565 };\r
566 \r
567 \r
568 static struct rk_sensor_reg sensor_softreset_data[]={\r
569     SensorRegVal(0x3021,0x61),\r
570         SensorEnd\r
571 };\r
572 \r
573 static struct rk_sensor_reg sensor_check_id_data[]={\r
574     SensorRegVal(0x3000,0),\r
575     SensorRegVal(0x3001,0),\r
576         SensorEnd\r
577 };\r
578 /*\r
579 *  The following setting must been filled, if the function is turn on by CONFIG_SENSOR_xxxx\r
580 */\r
581 static struct rk_sensor_reg sensor_WhiteB_Auto[]=\r
582 {\r
583         {0x3201, 0x3F},\r
584         SensorEnd\r
585 };\r
586 /* Cloudy Colour Temperature : 6500K - 8000K  */\r
587 static  struct rk_sensor_reg sensor_WhiteB_Cloudy[]=\r
588 {\r
589         {0x3201, 0x2F},\r
590         {0x3290, 0x01},\r
591         {0x3291, 0x51},\r
592         {0x3296, 0x01},\r
593         {0x3297, 0x00},\r
594         {0x3060, 0x01},\r
595         SensorEnd\r
596 };\r
597 /* ClearDay Colour Temperature : 5000K - 6500K  */\r
598 static  struct rk_sensor_reg sensor_WhiteB_ClearDay[]=\r
599 {       \r
600         {0x3201, 0x2F},\r
601         {0x3290, 0x01},\r
602         {0x3291, 0x38},\r
603         {0x3296, 0x01},\r
604         {0x3297, 0x68},  \r
605         {0x3060, 0x01},  \r
606         SensorEnd\r
607 };\r
608 /* Office Colour Temperature : 3500K - 5000K  */\r
609 static  struct rk_sensor_reg sensor_WhiteB_TungstenLamp1[]=\r
610 {\r
611         //INCANDESCENCE \r
612         {0x3201, 0x2F},\r
613         {0x3290, 0x01},\r
614         {0x3291, 0x30},\r
615         {0x3296, 0x01},\r
616         {0x3297, 0xCB},\r
617         {0x3060, 0x01},\r
618         SensorEnd\r
619 };\r
620 /* Home Colour Temperature : 2500K - 3500K      */\r
621 static  struct rk_sensor_reg sensor_WhiteB_TungstenLamp2[]=\r
622 {\r
623         //FLUORESCENT]\r
624         {0x3201, 0x2F},\r
625         {0x3290, 0x01},\r
626         {0x3291, 0x70},\r
627         {0x3296, 0x01},\r
628         {0x3297, 0xFF},\r
629         {0x3060, 0x01},\r
630         SensorEnd\r
631 };\r
632 \r
633 /* Home Colour Temperature : 2500K - 3500K      */\r
634 static  struct rk_sensor_reg sensor_WhiteB_TungstenLamp3[]=\r
635 {\r
636         //TUNGSTEN]\r
637         {0x3201, 0x2F},\r
638         {0x3290, 0x01},\r
639         {0x3291, 0x00},\r
640         {0x3296, 0x02},\r
641         {0x3297, 0x30},\r
642         {0x3060, 0x01},\r
643         SensorEnd\r
644 };\r
645 \r
646 static struct rk_sensor_reg *sensor_WhiteBalanceSeqe[] = {sensor_WhiteB_Auto, sensor_WhiteB_TungstenLamp1,sensor_WhiteB_TungstenLamp2,\r
647         sensor_WhiteB_ClearDay, sensor_WhiteB_Cloudy,sensor_WhiteB_TungstenLamp3,NULL,\r
648 };\r
649 \r
650 static  struct rk_sensor_reg sensor_Brightness0[]=\r
651 {\r
652         // Brightness -2\r
653         SensorEnd\r
654 };\r
655 \r
656 static  struct rk_sensor_reg sensor_Brightness1[]=\r
657 {\r
658         // Brightness -1\r
659 \r
660         SensorEnd\r
661 };\r
662 \r
663 static  struct rk_sensor_reg sensor_Brightness2[]=\r
664 {\r
665         //      Brightness 0\r
666 \r
667         SensorEnd\r
668 };\r
669 \r
670 static  struct rk_sensor_reg sensor_Brightness3[]=\r
671 {\r
672         // Brightness +1\r
673 \r
674         SensorEnd\r
675 };\r
676 \r
677 static  struct rk_sensor_reg sensor_Brightness4[]=\r
678 {\r
679         //      Brightness +2\r
680 \r
681         SensorEnd\r
682 };\r
683 \r
684 static  struct rk_sensor_reg sensor_Brightness5[]=\r
685 {\r
686         //      Brightness +3\r
687 \r
688         SensorEnd\r
689 };\r
690 static struct rk_sensor_reg *sensor_BrightnessSeqe[] = {sensor_Brightness0, sensor_Brightness1, sensor_Brightness2, sensor_Brightness3,\r
691         sensor_Brightness4, sensor_Brightness5,NULL,\r
692 };\r
693 \r
694 static  struct rk_sensor_reg sensor_Effect_Normal[] =\r
695 {\r
696         {0x32F1, 0x00},\r
697         {0x32F4, 0x80},\r
698         {0x32F5, 0x80},\r
699         SensorEnd\r
700 };\r
701 \r
702 static  struct rk_sensor_reg sensor_Effect_WandB[] =\r
703 {       \r
704         //Grayscale\r
705         {0x32F1, 0x01},\r
706         {0x32F6, 0X08},\r
707         SensorEnd\r
708 };\r
709 \r
710 static  struct rk_sensor_reg sensor_Effect_Sepia[] =\r
711 {\r
712         //Sepia\r
713         {0x32F1, 0x02},\r
714         SensorEnd\r
715 };\r
716 \r
717 static  struct rk_sensor_reg sensor_Effect_Inverse[] =\r
718 {\r
719         //Inverse\r
720         {0x32F1, 0x03}, \r
721         SensorEnd\r
722 };\r
723 static  struct rk_sensor_reg sensor_Effect_Bluish[] =\r
724 {\r
725         // Bluish\r
726         {0x32F1, 0x05},\r
727         {0x32F4, 0xF0},\r
728         {0x32F5, 0x80},\r
729         SensorEnd\r
730 };\r
731 \r
732 static  struct rk_sensor_reg sensor_Effect_Green[] =\r
733 {\r
734         //Greenish\r
735         {0x32F1, 0x05},\r
736         {0x32F4, 0x60},\r
737         {0x32F5, 0x20},\r
738         SensorEnd\r
739 };\r
740 \r
741 static  struct rk_sensor_reg sensor_Effect_Solarization[] =\r
742 {\r
743         //Solarization\r
744         {0x32F1, 0x04},\r
745         SensorEnd\r
746 };\r
747 \r
748 \r
749 static struct rk_sensor_reg *sensor_EffectSeqe[] = {sensor_Effect_Normal, sensor_Effect_WandB, sensor_Effect_Inverse,sensor_Effect_Sepia,\r
750         sensor_Effect_Bluish,sensor_Effect_Green,sensor_Effect_Solarization, NULL,\r
751 };\r
752 \r
753 static  struct rk_sensor_reg sensor_Exposure04[]=\r
754 {\r
755         //[EV-4]                                \r
756         {0x32F6, 0X0C},\r
757         {0x32F2, 0x40},\r
758         SensorEnd\r
759 };\r
760 \r
761 \r
762 static  struct rk_sensor_reg sensor_Exposure03[]=\r
763 {\r
764         //[EV-3]                                \r
765         {0x32F6, 0X0C},\r
766         {0x32F2, 0x50},\r
767         SensorEnd\r
768 };\r
769 \r
770 static  struct rk_sensor_reg sensor_Exposure02[]=\r
771 {\r
772         //[EV-2]                                \r
773         {0x32F6, 0X0C},\r
774         {0x32F2, 0x60},\r
775         SensorEnd\r
776 };\r
777 \r
778 static  struct rk_sensor_reg sensor_Exposure01[]=\r
779 {\r
780         //[EV-1]                                \r
781         {0x32F6, 0X0C},\r
782         {0x32F2, 0x70},\r
783         SensorEnd\r
784 };\r
785 \r
786 static  struct rk_sensor_reg sensor_Exposure00[]=\r
787 {\r
788         //[EV+0]                                \r
789         {0x32F6, 0X0C},\r
790         {0x32F2, 0x80},\r
791         SensorEnd\r
792 };\r
793 \r
794 static  struct rk_sensor_reg sensor_Exposure11[]=\r
795 {\r
796         //[EV+1]              \r
797         {0x32F6, 0X0C},\r
798         {0x32F2, 0x90},\r
799         SensorEnd\r
800 };\r
801 \r
802 static  struct rk_sensor_reg sensor_Exposure12[]=\r
803 {\r
804         //[EV+2]              \r
805         {0x32F6, 0X0C},\r
806         {0x32F2, 0xA0},\r
807         SensorEnd\r
808 };\r
809 \r
810 static  struct rk_sensor_reg sensor_Exposure13[]=\r
811 {\r
812         //[EV+3]              \r
813         {0x32F6, 0X0C},\r
814         {0x32F2, 0xB0},\r
815         SensorEnd\r
816 };\r
817 \r
818 static  struct rk_sensor_reg sensor_Exposure14[]=\r
819 {\r
820         //[EV+4]                                \r
821         {0x32F6, 0X0C},\r
822         {0x32F2, 0xC0},\r
823         SensorEnd\r
824 };\r
825 \r
826 static struct rk_sensor_reg *sensor_ExposureSeqe[] = {sensor_Exposure04,sensor_Exposure03, sensor_Exposure02, sensor_Exposure01, sensor_Exposure00,\r
827         sensor_Exposure11, sensor_Exposure12,sensor_Exposure13,sensor_Exposure14,NULL,\r
828 };\r
829 \r
830 static  struct rk_sensor_reg sensor_Saturation0[]=\r
831 {\r
832         SensorEnd\r
833 };\r
834 \r
835 static  struct rk_sensor_reg sensor_Saturation1[]=\r
836 {\r
837         SensorEnd\r
838 };\r
839 \r
840 static  struct rk_sensor_reg sensor_Saturation2[]=\r
841 {\r
842         SensorEnd\r
843 };\r
844 static struct rk_sensor_reg *sensor_SaturationSeqe[] = {sensor_Saturation0, sensor_Saturation1, sensor_Saturation2, NULL,};\r
845 \r
846 static  struct rk_sensor_reg sensor_Contrast04[]=\r
847 {\r
848         //[Contrast : -4]\r
849         {0x32F6, 0x0C}, \r
850         {0x32C2, 0x40},\r
851         {0x32F2, 0x40},\r
852         {0x3060, 0x01},\r
853         SensorEnd\r
854 };\r
855 \r
856 static  struct rk_sensor_reg sensor_Contrast03[]=\r
857 {\r
858                 //[Contrast : -3]  \r
859         {0x32F6, 0x0C},    \r
860         {0x32C2, 0x30},\r
861         {0x32F2, 0x50},\r
862         {0x3060, 0x01},\r
863         SensorEnd\r
864 };\r
865 \r
866 static  struct rk_sensor_reg sensor_Contrast02[]=\r
867 {\r
868         //[Contrast : -2]    \r
869         {0x32F6, 0x0C},  \r
870         {0x32C2, 0x20},\r
871         {0x32F2, 0x60},\r
872         {0x3060, 0x01},\r
873         SensorEnd\r
874 };\r
875 static  struct rk_sensor_reg sensor_Contrast01[]=\r
876 {\r
877         //[Contrast : -1] \r
878         {0x32F6, 0x0C},     \r
879         {0x32C2, 0x10},\r
880         {0x32F2, 0x70},\r
881         {0x3060, 0x01},\r
882         SensorEnd\r
883 };\r
884 \r
885 static  struct rk_sensor_reg sensor_Contrast00[]=\r
886 {\r
887         //[Contrast : 0]        \r
888         {0x32F6, 0x0C},         \r
889         {0x32C2, 0x00},\r
890         {0x32F2, 0x80},\r
891         {0x3060, 0x01},\r
892         SensorEnd\r
893 };\r
894 \r
895 \r
896 static  struct rk_sensor_reg sensor_Contrast11[]=\r
897 {\r
898         //[Contrast : +1]   \r
899         {0x32F6, 0x0C},   \r
900         {0x32C2, 0xF0},\r
901         {0x32F2, 0x90},\r
902         {0x3060, 0x01},\r
903         SensorEnd\r
904 };\r
905 \r
906 \r
907 static  struct rk_sensor_reg sensor_Contrast12[]=\r
908 {\r
909         //[Contrast : +2]  \r
910         {0x32F6, 0x0C},    \r
911         {0x32C2, 0xE0},\r
912         {0x32F2, 0xA0},\r
913         {0x3060, 0x01},\r
914         SensorEnd\r
915 };\r
916 \r
917 static  struct rk_sensor_reg sensor_Contrast13[]=\r
918 {\r
919         //[Contrast : +3]  \r
920         {0x32F6, 0x0C},    \r
921         {0x32C2, 0xD0},\r
922         {0x32F2, 0xB0},\r
923         {0x3060, 0x01},\r
924         SensorEnd\r
925 };\r
926 \r
927 static  struct rk_sensor_reg sensor_Contrast14[]=\r
928 {\r
929         //[Contrast : +4]  \r
930         {0x32F6, 0x0C},         \r
931         {0x32C2, 0xC0},\r
932         {0x32F2, 0xC0},\r
933         {0x3060, 0x01},\r
934         SensorEnd\r
935 };\r
936 \r
937 static struct rk_sensor_reg *sensor_ContrastSeqe[] = {sensor_Contrast04, sensor_Contrast03, sensor_Contrast02, sensor_Contrast01,\r
938         sensor_Contrast00, sensor_Contrast11, sensor_Contrast12, sensor_Contrast13, sensor_Contrast14,NULL,\r
939 };\r
940 static  struct rk_sensor_reg sensor_SceneAuto[] =\r
941 {\r
942         SensorEnd\r
943 };\r
944 \r
945 static  struct rk_sensor_reg sensor_SceneNight[] =\r
946 {\r
947         SensorEnd\r
948 };\r
949 static struct rk_sensor_reg *sensor_SceneSeqe[] = {sensor_SceneAuto, sensor_SceneNight,NULL,};\r
950 \r
951 static struct rk_sensor_reg sensor_Zoom0[] =\r
952 {\r
953         SensorEnd\r
954 };\r
955 \r
956 static struct rk_sensor_reg sensor_Zoom1[] =\r
957 {\r
958         SensorEnd\r
959 };\r
960 \r
961 static struct rk_sensor_reg sensor_Zoom2[] =\r
962 {\r
963         SensorEnd\r
964 };\r
965 \r
966 \r
967 static struct rk_sensor_reg sensor_Zoom3[] =\r
968 {\r
969         SensorEnd\r
970 };\r
971 static struct rk_sensor_reg *sensor_ZoomSeqe[] = {sensor_Zoom0, sensor_Zoom1, sensor_Zoom2, sensor_Zoom3, NULL,};\r
972 \r
973 /*\r
974 * User could be add v4l2_querymenu in sensor_controls by new_usr_v4l2menu\r
975 */\r
976 static struct v4l2_querymenu sensor_menus[] =\r
977 {\r
978         //white balance\r
979         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,0,"auto",0),\r
980         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,1,"incandescent",0),\r
981         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,2,"fluorescent",0),\r
982         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,3,"daylight",0),\r
983         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,4,"cloudy-daylight",0),\r
984         new_usr_v4l2menu(V4L2_CID_DO_WHITE_BALANCE,5,"tungsten",0),\r
985 \r
986         //speical effect\r
987         new_usr_v4l2menu(V4L2_CID_EFFECT,0,"none",0),\r
988         new_usr_v4l2menu(V4L2_CID_EFFECT,1,"mono",0),\r
989         new_usr_v4l2menu(V4L2_CID_EFFECT,2,"negative",0),\r
990         new_usr_v4l2menu(V4L2_CID_EFFECT,3,"sepia",0),\r
991         new_usr_v4l2menu(V4L2_CID_EFFECT,4,"posterize",0),\r
992         new_usr_v4l2menu(V4L2_CID_EFFECT,5,"aqua",0),\r
993         new_usr_v4l2menu(V4L2_CID_EFFECT,6,"solarize",0),\r
994 };\r
995 /*\r
996 * User could be add v4l2_queryctrl in sensor_controls by new_user_v4l2ctrl\r
997 */\r
998 static struct sensor_v4l2ctrl_usr_s sensor_controls[] =\r
999 {\r
1000         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
1001         new_user_v4l2ctrl(V4L2_CID_EXPOSURE,V4L2_CTRL_TYPE_INTEGER,"Exposure Control", -4, 4, 1, 0,sensor_v4l2ctrl_default_cb, sensor_ExposureSeqe),\r
1002         new_user_v4l2ctrl(V4L2_CID_EFFECT,V4L2_CTRL_TYPE_MENU,"Effect Control", 0, 6, 1, 0,sensor_v4l2ctrl_default_cb, sensor_EffectSeqe),\r
1003         new_user_v4l2ctrl(V4L2_CID_CONTRAST,V4L2_CTRL_TYPE_INTEGER,"Contrast Control", -4, 4, 1, 0,sensor_v4l2ctrl_default_cb, sensor_ContrastSeqe),\r
1004 };\r
1005 \r
1006 \r
1007 //MUST define the current used format as the first item   \r
1008 static struct rk_sensor_datafmt sensor_colour_fmts[] = {\r
1009         {V4L2_MBUS_FMT_UYVY8_2X8, V4L2_COLORSPACE_JPEG},\r
1010         {V4L2_MBUS_FMT_YUYV8_2X8, V4L2_COLORSPACE_JPEG} \r
1011 };\r
1012 static struct soc_camera_ops sensor_ops;\r
1013 \r
1014 /*\r
1015 **********************************************************\r
1016 * Following is local code:\r
1017\r
1018 * Please codeing your program here \r
1019 **********************************************************\r
1020 */\r
1021 #define NT99160_FULL_PERIOD_PIXEL_NUMS  (1608)  // default pixel#(w/o dummy pixels) in UXGA mode\r
1022 #define NT99160_FULL_PERIOD_LINE_NUMS   (746)  // default line#(w/o dummy lines) in UXGA mode\r
1023 #define NT99160_PV_PERIOD_PIXEL_NUMS   (1288)  // default pixel#(w/o dummy pixels) in SVGA mode\r
1024 #define NT99160_PV_PERIOD_LINE_NUMS       (736)   // default line#(w/o dummy lines) in SVGA mode\r
1025 \r
1026 /* SENSOR EXPOSURE LINE LIMITATION */\r
1027 #define NT99160_FULL_EXPOSURE_LIMITATION   (1492)\r
1028 #define NT99160_PV_EXPOSURE_LIMITATION    (736)\r
1029 \r
1030 // SENSOR UXGA SIZE\r
1031 #define NT99160_IMAGE_SENSOR_FULL_WIDTH   (1280)\r
1032 #define NT99160_IMAGE_SENSOR_FULL_HEIGHT   (720)\r
1033 \r
1034 #define NT99160_FULL_GRAB_WIDTH                         (NT99160_IMAGE_SENSOR_FULL_WIDTH - 16)\r
1035 #define NT99160_FULL_GRAB_HEIGHT                        (NT99160_IMAGE_SENSOR_FULL_HEIGHT - 12)\r
1036 \r
1037 /*\r
1038 **********************************************************\r
1039 * Following is callback\r
1040 * If necessary, you could coding these callback\r
1041 **********************************************************\r
1042 */\r
1043 /*\r
1044 * the function is called in open sensor  \r
1045 */\r
1046 static int sensor_activate_cb(struct i2c_client *client)\r
1047 {\r
1048     u8 reg_val;\r
1049 \r
1050     SENSOR_DG("%s\n",__FUNCTION__);\r
1051 \r
1052         return 0;\r
1053 }\r
1054 /*\r
1055 * the function is called in close sensor\r
1056 */\r
1057 static int sensor_deactivate_cb(struct i2c_client *client)\r
1058 {\r
1059         u8 reg_val;\r
1060         struct generic_sensor *sensor = to_generic_sensor(client);\r
1061 \r
1062     SENSOR_DG("%s",__FUNCTION__);\r
1063     \r
1064         /* ddl@rock-chips.com : all sensor output pin must switch into Hi-Z */\r
1065         \r
1066         if (sensor->info_priv.funmodule_state & SENSOR_INIT_IS_OK) {\r
1067                 //generic_sensor_ioctrl(icd, Sensor_PowerDown, 1);\r
1068                  sensor->info_priv.funmodule_state &= ~SENSOR_INIT_IS_OK;\r
1069         }\r
1070         \r
1071         return 0;\r
1072 }\r
1073 /*\r
1074 * the function is called before sensor register setting in VIDIOC_S_FMT  \r
1075 */\r
1076 static int sensor_s_fmt_cb_th(struct i2c_client *client,struct v4l2_mbus_framefmt *mf, bool capture)\r
1077 {\r
1078     return 0;\r
1079 }\r
1080 /*\r
1081 * the function is called after sensor register setting finished in VIDIOC_S_FMT  \r
1082 */\r
1083 static int sensor_s_fmt_cb_bh (struct i2c_client *client,struct v4l2_mbus_framefmt *mf, bool capture)\r
1084 {\r
1085     return 0;\r
1086 }\r
1087 \r
1088 static int sensor_try_fmt_cb_th(struct i2c_client *client,struct v4l2_mbus_framefmt *mf)\r
1089 {\r
1090         return 0;\r
1091 }\r
1092 \r
1093 static int sensor_softrest_usr_cb(struct i2c_client *client,struct rk_sensor_reg *series)\r
1094 {\r
1095         \r
1096         return 0;\r
1097 }\r
1098 static int sensor_check_id_usr_cb(struct i2c_client *client,struct rk_sensor_reg *series)\r
1099 {\r
1100         return 0;\r
1101 }\r
1102 \r
1103 static int sensor_suspend(struct soc_camera_device *icd, pm_message_t pm_msg)\r
1104 {\r
1105         //struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));\r
1106                 \r
1107         if (pm_msg.event == PM_EVENT_SUSPEND) {\r
1108                 SENSOR_DG("Suspend");\r
1109                 \r
1110         } else {\r
1111                 SENSOR_TR("pm_msg.event(0x%x) != PM_EVENT_SUSPEND\n",pm_msg.event);\r
1112                 return -EINVAL;\r
1113         }\r
1114         return 0;\r
1115 }\r
1116 \r
1117 static int sensor_resume(struct soc_camera_device *icd)\r
1118 {\r
1119         int ret=0;\r
1120         \r
1121         SENSOR_DG("Resume");\r
1122         //ret = generic_sensor_ioctrl(icd, Sensor_PowerDown, 0);\r
1123 \r
1124         return ret;\r
1125 \r
1126 }\r
1127 static int sensor_mirror_cb (struct i2c_client *client, int mirror)\r
1128 {\r
1129         char val;\r
1130         int err = 0;\r
1131     \r
1132     SENSOR_DG("mirror: %d",mirror);\r
1133         if (mirror) {\r
1134                 err = sensor_read(client, 0x3022, &val);\r
1135                 if (err == 0) {\r
1136                         val |= 0x02;\r
1137                         err = sensor_write(client, 0x3022, val);\r
1138                 }\r
1139         } else {\r
1140                 err = sensor_read(client, 0x3022, &val);\r
1141                 if (err == 0) {\r
1142                         val &= 0xfd;\r
1143                         err = sensor_write(client, 0x3022, val);\r
1144                 }\r
1145         }\r
1146 \r
1147         return err;    \r
1148 }\r
1149 /*\r
1150 * the function is v4l2 control V4L2_CID_HFLIP callback  \r
1151 */\r
1152 static int sensor_v4l2ctrl_mirror_cb(struct soc_camera_device *icd, struct sensor_v4l2ctrl_info_s *ctrl_info, \r
1153                                                      struct v4l2_ext_control *ext_ctrl)\r
1154 {\r
1155         struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));\r
1156 \r
1157     if (sensor_mirror_cb(client,ext_ctrl->value) != 0)\r
1158                 SENSOR_TR("sensor_mirror failed, value:0x%x",ext_ctrl->value);\r
1159         \r
1160         SENSOR_DG("sensor_mirror success, value:0x%x",ext_ctrl->value);\r
1161         return 0;\r
1162 }\r
1163 \r
1164 static int sensor_flip_cb(struct i2c_client *client, int flip)\r
1165 {\r
1166         char val;\r
1167         int err = 0;    \r
1168 \r
1169 \r
1170     SENSOR_DG("flip: %d",flip);\r
1171         if (flip) {\r
1172                 err = sensor_read(client, 0x3022, &val);\r
1173                 if (err == 0) {\r
1174                         val |= 0x01;\r
1175                         err = sensor_write(client, 0x3022, val);\r
1176                 }\r
1177         } else {\r
1178                 err = sensor_read(client, 0x3022, &val);\r
1179                 if (err == 0) {\r
1180                         val &= 0xfe;\r
1181                         err = sensor_write(client, 0x3022, val);\r
1182                 }\r
1183         }\r
1184 \r
1185         return err;    \r
1186 }\r
1187 /*\r
1188 * the function is v4l2 control V4L2_CID_VFLIP callback  \r
1189 */\r
1190 static int sensor_v4l2ctrl_flip_cb(struct soc_camera_device *icd, struct sensor_v4l2ctrl_info_s *ctrl_info, \r
1191                                                      struct v4l2_ext_control *ext_ctrl)\r
1192 {\r
1193         struct i2c_client *client = to_i2c_client(to_soc_camera_control(icd));\r
1194 \r
1195     if (sensor_flip_cb(client,ext_ctrl->value) != 0)\r
1196                 SENSOR_TR("sensor_flip failed, value:0x%x",ext_ctrl->value);\r
1197         \r
1198         SENSOR_DG("sensor_flip success, value:0x%x",ext_ctrl->value);\r
1199         return 0;\r
1200 }\r
1201 \r
1202 static int sensor_focus_init_usr_cb(struct i2c_client *client){\r
1203         return 0;\r
1204 }\r
1205 \r
1206 static int sensor_focus_af_single_usr_cb(struct i2c_client *client){\r
1207         return 0;\r
1208 }\r
1209 \r
1210 static int sensor_focus_af_near_usr_cb(struct i2c_client *client){\r
1211         return 0;\r
1212 }\r
1213 \r
1214 static int sensor_focus_af_far_usr_cb(struct i2c_client *client){\r
1215         return 0;\r
1216 }\r
1217 \r
1218 static int sensor_focus_af_specialpos_usr_cb(struct i2c_client *client,int pos){\r
1219         return 0;\r
1220 }\r
1221 \r
1222 static int sensor_focus_af_const_usr_cb(struct i2c_client *client){\r
1223         return 0;\r
1224 }\r
1225 static int sensor_focus_af_const_pause_usr_cb(struct i2c_client *client)
1226 {
1227     return 0;
1228 }\r
1229 static int sensor_focus_af_close_usr_cb(struct i2c_client *client){\r
1230         return 0;\r
1231 }\r
1232 \r
1233 static int sensor_focus_af_zoneupdate_usr_cb(struct i2c_client *client){\r
1234         return 0;\r
1235 }\r
1236 \r
1237 /*\r
1238 face defect call back\r
1239 */\r
1240 static int      sensor_face_detect_usr_cb(struct i2c_client *client,int on){\r
1241         return 0;\r
1242 }\r
1243 \r
1244 /*\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
1247 */\r
1248 static void sensor_init_parameters_user(struct specific_sensor* spsensor,struct soc_camera_device *icd)\r
1249 {\r
1250         \r
1251     return;\r
1252 }\r
1253 \r
1254 /*\r
1255 * :::::WARNING:::::\r
1256 * It is not allowed to modify the following code\r
1257 */\r
1258 \r
1259 sensor_init_parameters_default_code();\r
1260 \r
1261 sensor_v4l2_struct_initialization();\r
1262 \r
1263 sensor_probe_default_code();\r
1264 \r
1265 sensor_remove_default_code();\r
1266 \r
1267 sensor_driver_default_module_code();\r
1268 \r
1269 \r
1270 \r