1 #include <linux/videodev2.h>
3 #include <linux/platform_device.h>
4 #include <linux/delay.h>
5 #include <linux/cdev.h>
6 #include <linux/uaccess.h>
8 #include <asm/atomic.h>
9 #include <linux/xlog.h>
11 #include "kd_camera_hw.h"
13 #include "kd_imgsensor.h"
14 #include "kd_imgsensor_define.h"
15 #include "kd_camera_feature.h"
17 /******************************************************************************
19 ******************************************************************************/
20 #define PFX "[kd_camera_hw]"
21 #define PK_DBG_NONE(fmt, arg...) do {} while (0)
22 #define PK_DBG_FUNC(fmt, arg...) xlog_printk(ANDROID_LOG_INFO, PFX , fmt, ##arg)
24 #define DEBUG_CAMERA_HW_K
25 #ifdef DEBUG_CAMERA_HW_K
26 #define PK_DBG PK_DBG_FUNC
27 #define PK_ERR(fmt, arg...) xlog_printk(ANDROID_LOG_ERR, PFX , fmt, ##arg)
28 #define PK_XLOG_INFO(fmt, args...) \
30 xlog_printk(ANDROID_LOG_INFO, PFX , fmt, ##arg); \
35 #define PK_XLOG_INFO(fmt, args...)
39 int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx
, char *currSensorName
, BOOL On
, char* mode_name
)
41 #if !defined (MTK_ALPS_BOX_SUPPORT)
43 u32 pinSetIdx
= 0;//default main sensor
46 #define IDX_PS_CMRST 0
47 #define IDX_PS_CMPDN 4
59 GPIO_CAMERA_CMRST_PIN
,
60 GPIO_CAMERA_CMRST_PIN_M_GPIO
, /* mode */
61 GPIO_OUT_ONE
, /* ON state */
62 GPIO_OUT_ZERO
, /* OFF state */
63 GPIO_CAMERA_CMPDN_PIN
,
64 GPIO_CAMERA_CMPDN_PIN_M_GPIO
,
70 GPIO_CAMERA_CMRST_PIN
,
71 GPIO_CAMERA_CMRST_PIN_M_GPIO
,
74 GPIO_CAMERA_CMPDN1_PIN
,
75 GPIO_CAMERA_CMPDN1_PIN_M_GPIO
,
81 if (DUAL_CAMERA_MAIN_SENSOR
== SensorIdx
)
85 else if (DUAL_CAMERA_SUB_SENSOR
== SensorIdx
)
95 PK_DBG("kdCISModulePowerOn -on:currSensorName=%s;\n",currSensorName
);
96 PK_DBG("kdCISModulePowerOn -on:pinSetIdx=%d\n",pinSetIdx
);
98 if ((pinSetIdx
== 1) && currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_HI708_YUV
,currSensorName
)))
100 PK_DBG("[CAMERA SENSOR] kdCISModulePowerOn get in---GC2145_YUV sensorIdx:%d; pinSetIdx=%d\n",SensorIdx
, pinSetIdx
);
101 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
/*VOL_2800*/,mode_name
)) //IO
103 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
105 goto _kdCISModulePowerOn_exit_
;
108 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
,mode_name
)) //AVDD
110 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
112 goto _kdCISModulePowerOn_exit_
;
114 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D
, VOL_1800
,mode_name
)) //DVDD no use
116 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
118 goto _kdCISModulePowerOn_exit_
;
120 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_ON
]))
122 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
124 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
126 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
130 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
])
133 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_MODE
]))
135 PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
137 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
))
139 PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
141 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
]))
143 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
146 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
]))
148 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
154 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
]))
156 PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
158 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
))
160 PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
162 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
164 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
167 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_ON
]))
169 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
174 //disable inactive sensor
175 if(pinSetIdx
== 0) //disable sub
184 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdxTmp
][IDX_PS_CMRST
])
186 if(mt_set_gpio_mode(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
+IDX_PS_MODE
]))
188 PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
191 if(mt_set_gpio_dir(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],GPIO_DIR_OUT
))
193 PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
196 if(mt_set_gpio_out(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
+IDX_PS_OFF
]))
198 PK_DBG("[CAMERA LENS] set gpio failed!! \n"); //high == power down lens module
201 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
]))
203 PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
205 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
))
207 PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
209 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
211 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
218 else if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_OV2680_RAW
,currSensorName
))) {
220 //First Power Pin low and Reset Pin Low
222 /*[BUGFIX] ADD-BEGIN by sz.chengming.xiang for PR-1021927(pixi3-7-3G) 2015/06/15
223 set front sensor hi708's pwdn to high, make sure it is in Hi-Z state so that
224 it will not affect i2c comunication on this bus*/
225 if (GPIO_CAMERA_INVALID
!= pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
]) {
226 if(mt_set_gpio_mode(pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
],pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
+IDX_PS_MODE
])){PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");}
227 if(mt_set_gpio_dir(pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
228 if(mt_set_gpio_out(pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
],pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
+IDX_PS_ON
])){PK_DBG("[CAMERA LENS] set gpio failed!! \n");} //high == power down lens module
230 /*[BUGFIX] ADD-END by sz.chengming.xiang for PR-1021927 2015/06/15*/
232 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
, mode_name
))
234 PK_DBG("[CAMERA SENSOR] Fail to enable IO power\n");
235 goto _kdCISModulePowerOn_exit_
;
239 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMPDN
], pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_MODE
])){PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");}
240 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
], GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
241 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
], pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
])){PK_DBG("[CAMERA LENS] set gpio failed!! \n");}
243 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
], pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_ON
])){PK_DBG("[CAMERA LENS] set gpio failed!! \n");}
247 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
], pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
])){PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");}
248 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
], GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
249 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
], pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
])){PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");}
251 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
], pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_ON
])){PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");}
257 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
, mode_name
))
259 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
260 goto _kdCISModulePowerOn_exit_
;
263 //if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_D, VOL_1500,mode_name))
265 // PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
266 // goto _kdCISModulePowerOn_exit_;
270 // wait power to be stable
273 else if ((pinSetIdx
== 0) && currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_S5K5E2YA_MIPI_RAW
,currSensorName
)))
275 PK_DBG("[CAMERA SENSOR] kdCISModulePowerOn get in---GC2145_YUV sensorIdx:%d; pinSetIdx=%d\n",SensorIdx
, pinSetIdx
);
276 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
/*VOL_2800*/,mode_name
)) //IO
278 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
280 goto _kdCISModulePowerOn_exit_
;
283 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
,mode_name
)) //AVDD
285 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
287 goto _kdCISModulePowerOn_exit_
;
289 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D
, VOL_1200
,mode_name
)) //DVDD no use
291 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
293 goto _kdCISModulePowerOn_exit_
;
295 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
]))
297 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
299 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
301 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
305 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
])
308 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_MODE
]))
310 PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
312 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
))
314 PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
316 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
]))
318 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
321 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_ON
]))
323 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
329 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
]))
331 PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
333 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
))
335 PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
337 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
339 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
342 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_ON
]))
344 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
349 //disable inactive sensor
350 if(pinSetIdx
== 0) //disable sub
359 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdxTmp
][IDX_PS_CMRST
])
361 if(mt_set_gpio_mode(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
+IDX_PS_MODE
]))
363 PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
366 if(mt_set_gpio_dir(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],GPIO_DIR_OUT
))
368 PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
371 if(mt_set_gpio_out(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
+IDX_PS_OFF
]))
373 PK_DBG("[CAMERA LENS] set gpio failed!! \n"); //high == power down lens module
376 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
]))
378 PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
380 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
))
382 PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
384 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
386 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
393 else if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_GC2355_RAW
,currSensorName
)))
395 PK_DBG("[CAMERA SENSOR] kdCISModulePowerOn get in---GC2145_YUV sensorIdx:%d; pinSetIdx=%d\n",SensorIdx
, pinSetIdx
);
396 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
/*VOL_2800*/,mode_name
)) //IO
398 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
400 goto _kdCISModulePowerOn_exit_
;
403 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
,mode_name
)) //AVDD
405 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
407 goto _kdCISModulePowerOn_exit_
;
409 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D
, VOL_1800
,mode_name
)) //DVDD no use
411 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
413 goto _kdCISModulePowerOn_exit_
;
415 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_ON
]))
417 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
419 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
421 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
425 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
])
428 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_MODE
]))
430 PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
432 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
))
434 PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
436 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
]))
438 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
441 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
]))
443 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
449 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
]))
451 PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
453 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
))
455 PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
457 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
459 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
462 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_ON
]))
464 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
469 //disable inactive sensor
470 if(pinSetIdx
== 0) //disable sub
479 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdxTmp
][IDX_PS_CMRST
])
481 if(mt_set_gpio_mode(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
+IDX_PS_MODE
]))
483 PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
486 if(mt_set_gpio_dir(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],GPIO_DIR_OUT
))
488 PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
491 if(mt_set_gpio_out(pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
],pinSet
[pinSetIdxTmp
][IDX_PS_CMPDN
+IDX_PS_ON
]))
493 PK_DBG("[CAMERA LENS] set gpio failed!! \n"); //high == power down lens module
496 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
]))
498 PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
500 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
))
502 PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
504 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
]))
506 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
514 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A
,mode_name
)) {
515 PK_DBG("[CAMERA SENSOR] Fail to OFF analog power\n");
517 //goto _kdCISModulePowerOn_exit_;
519 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A2
,mode_name
))
521 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
523 //goto _kdCISModulePowerOn_exit_;
528 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D
, VOL_1500
,mode_name
))
530 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
532 //goto _kdCISModulePowerOn_exit_;
538 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A2
, VOL_2800
,mode_name
))
540 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
542 goto _kdCISModulePowerOn_exit_
;
546 //enable active sensor
547 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
549 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
])){PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");}
550 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
551 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_ON
])){PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");}
555 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_MODE
])){PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");}
556 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
557 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
])){PK_DBG("[CAMERA LENS] set gpio failed!! \n");}
562 //disable inactive sensor
563 if(pinSetIdx
== 0 || pinSetIdx
== 2) {//disable sub
564 if (GPIO_CAMERA_INVALID
!= pinSet
[1][IDX_PS_CMRST
]) {
565 if(mt_set_gpio_mode(pinSet
[1][IDX_PS_CMRST
],pinSet
[1][IDX_PS_CMRST
+IDX_PS_MODE
])){PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");}
566 if(mt_set_gpio_mode(pinSet
[1][IDX_PS_CMPDN
],pinSet
[1][IDX_PS_CMPDN
+IDX_PS_MODE
])){PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");}
567 if(mt_set_gpio_dir(pinSet
[1][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
568 if(mt_set_gpio_dir(pinSet
[1][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
569 if(mt_set_gpio_out(pinSet
[1][IDX_PS_CMRST
],pinSet
[1][IDX_PS_CMRST
+IDX_PS_OFF
])){PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");} //low == reset sensor
570 if(mt_set_gpio_out(pinSet
[1][IDX_PS_CMPDN
],pinSet
[1][IDX_PS_CMPDN
+IDX_PS_OFF
])){PK_DBG("[CAMERA LENS] set gpio failed!! \n");} //high == power down lens module
574 if (GPIO_CAMERA_INVALID
!= pinSet
[0][IDX_PS_CMRST
]) {
575 if(mt_set_gpio_mode(pinSet
[0][IDX_PS_CMRST
],pinSet
[0][IDX_PS_CMRST
+IDX_PS_MODE
])){PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");}
576 if(mt_set_gpio_mode(pinSet
[0][IDX_PS_CMPDN
],pinSet
[0][IDX_PS_CMPDN
+IDX_PS_MODE
])){PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");}
577 if(mt_set_gpio_dir(pinSet
[0][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
578 if(mt_set_gpio_dir(pinSet
[0][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
579 if(mt_set_gpio_out(pinSet
[0][IDX_PS_CMRST
],pinSet
[0][IDX_PS_CMRST
+IDX_PS_OFF
])){PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");} //low == reset sensor
580 if(mt_set_gpio_out(pinSet
[0][IDX_PS_CMPDN
],pinSet
[0][IDX_PS_CMPDN
+IDX_PS_OFF
])){PK_DBG("[CAMERA LENS] set gpio failed!! \n");} //high == power down lens module
589 //PK_DBG("[OFF]sensorIdx:%d \n",SensorIdx);
590 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
591 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_MODE
])){PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");}
592 if(mt_set_gpio_mode(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_MODE
])){PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");}
593 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
594 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
595 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],pinSet
[pinSetIdx
][IDX_PS_CMRST
+IDX_PS_OFF
])){PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");} //low == reset sensor
596 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],pinSet
[pinSetIdx
][IDX_PS_CMPDN
+IDX_PS_OFF
])){PK_DBG("[CAMERA LENS] set gpio failed!! \n");} //high == power down lens module
599 /*[BUGFIX] ADD-BEGIN by sz.chengming.xiang for PR-1021927(pixi3-7-3G) 2015/06/15
600 as open main camera will set sub cam's pwd to high ,so should set it back when close main camera
601 to prevent current leakage */
602 if ((pinSetIdx
!= IDX_SUB_CAM
) && (GPIO_CAMERA_INVALID
!= pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
])) {
604 mt_set_gpio_mode(pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
],pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
+IDX_PS_MODE
]);
605 mt_set_gpio_dir(pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
],GPIO_DIR_OUT
);
606 mt_set_gpio_out(pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
],pinSet
[IDX_SUB_CAM
][IDX_PS_CMPDN
+IDX_PS_OFF
]);
609 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A
,mode_name
)) {
610 PK_DBG("[CAMERA SENSOR] Fail to OFF a power\n");
612 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A2
,mode_name
)){
613 PK_DBG("[CAMERA SENSOR] Fail to OFF a2 power\n");
615 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D
, mode_name
)) {
616 PK_DBG("[CAMERA SENSOR] Fail to OFF d digital power\n");
618 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D2
,mode_name
))
620 PK_DBG("[CAMERA SENSOR] Fail to OFF d2 digital power\n");
624 #endif /* end of defined MTK_ALPS_BOX_SUPPORT */
628 _kdCISModulePowerOn_exit_
:
632 EXPORT_SYMBOL(kdCISModulePowerOn
);