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>
10 #include <mach/upmu_common.h>
12 #include "kd_camera_hw.h"
14 #include "kd_imgsensor.h"
15 #include "kd_imgsensor_define.h"
16 #include "kd_camera_feature.h"
18 /******************************************************************************
20 ******************************************************************************/
21 #define PFX "[kd_camera_hw]"
22 #define PK_DBG_NONE(fmt, arg...) do {} while (0)
23 #define PK_DBG_FUNC(fmt, arg...) xlog_printk(ANDROID_LOG_INFO, PFX , fmt, ##arg)
25 #define DEBUG_CAMERA_HW_K
26 #ifdef DEBUG_CAMERA_HW_K
27 #define PK_DBG PK_DBG_FUNC
28 #define PK_ERR(fmt, arg...) xlog_printk(ANDROID_LOG_ERR, PFX , fmt, ##arg)
29 #define PK_XLOG_INFO(fmt, args...) \
31 xlog_printk(ANDROID_LOG_INFO, PFX , fmt, ##arg); \
36 #define PK_XLOG_INFO(fmt, args...)
41 int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx
, char *currSensorName
, BOOL On
, char* mode_name
)
43 #if !defined (MTK_ALPS_BOX_SUPPORT)
45 u32 pinSetIdx
= 0;//default main sensor
47 #define IDX_PS_CMRST 0
48 #define IDX_PS_CMPDN 4
57 {GPIO_CAMERA_CMRST_PIN
,
58 GPIO_CAMERA_CMRST_PIN_M_GPIO
, /* mode */
59 GPIO_OUT_ONE
, /* ON state */
60 GPIO_OUT_ZERO
, /* OFF state */
61 GPIO_CAMERA_CMPDN_PIN
,
62 GPIO_CAMERA_CMPDN_PIN_M_GPIO
,
67 {GPIO_CAMERA_CMRST1_PIN
,
68 GPIO_CAMERA_CMRST1_PIN_M_GPIO
,
71 GPIO_CAMERA_CMPDN1_PIN
,
72 GPIO_CAMERA_CMPDN1_PIN_M_GPIO
,
84 if (DUAL_CAMERA_MAIN_SENSOR
== SensorIdx
){
87 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
==0) && currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_OV5647_RAW
, currSensorName
)))
100 //enable active sensor
101 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
103 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");}
104 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
105 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");}
109 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");}
110 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
111 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");}
116 PK_DBG("[ON_general 1.8V]sensorIdx:%d \n",SensorIdx
);
117 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
,mode_name
))
119 PK_DBG("[CAMERA SENSOR] Fail to enable D2 power\n");
121 //goto _kdCISModulePowerOn_exit_;
126 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
,mode_name
))
128 PK_DBG("[CAMERA SENSOR] Fail to enable A power\n");
130 //goto _kdCISModulePowerOn_exit_;
135 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D
, VOL_1500
,mode_name
))
137 PK_DBG("[CAMERA SENSOR] Fail to enable D power\n");
139 //goto _kdCISModulePowerOn_exit_;
144 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A2
, VOL_2800
,mode_name
))
146 PK_DBG("[CAMERA SENSOR] Fail to enable A2 power\n");
148 goto _kdCISModulePowerOn_exit_
;
152 //enable active sensor
153 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
155 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");}
156 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
157 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");}
161 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");}
162 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
163 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");}
170 PK_DBG("im sleep ...\n");
174 //disable inactive sensor
175 if(pinSetIdx
== 0 || pinSetIdx
== 2) {//disable sub
176 if (GPIO_CAMERA_INVALID
!= pinSet
[1][IDX_PS_CMRST
]) {
177 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");}
178 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");}
179 if(mt_set_gpio_dir(pinSet
[1][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
180 if(mt_set_gpio_dir(pinSet
[1][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
181 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
182 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
186 if (GPIO_CAMERA_INVALID
!= pinSet
[0][IDX_PS_CMRST
]) {
187 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");}
188 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");}
189 if(mt_set_gpio_dir(pinSet
[0][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
190 if(mt_set_gpio_dir(pinSet
[0][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
191 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
192 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
197 else if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_OV2659_YUV
, currSensorName
)))
199 //enable active sensor
200 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
202 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");}
203 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
204 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");}
208 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");}
209 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
210 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");}
213 /* Enlarge the VCAMIO voltage to increase driving capability to avoid unexpected lines shown
214 VCAMIO 1.8V + 0.02V ~ 0.16V
224 upmu_set_rg_vcam_io_cal(0x08); // 1.96V
227 PK_DBG("[ON_general 1.8V]sensorIdx:%d \n",SensorIdx
);
228 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
,mode_name
))
230 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
232 //goto _kdCISModulePowerOn_exit_;
237 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
,mode_name
))
239 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
241 //goto _kdCISModulePowerOn_exit_;
246 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D
, VOL_1500
,mode_name
))
248 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
250 //goto _kdCISModulePowerOn_exit_;
256 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A2
, VOL_2800
,mode_name
))
258 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
260 goto _kdCISModulePowerOn_exit_
;
264 //enable active sensor
265 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
267 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");}
268 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
269 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");}
273 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");}
274 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
275 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");}
280 //disable inactive sensor
281 if(pinSetIdx
== 0 || pinSetIdx
== 2) {//disable sub
282 if (GPIO_CAMERA_INVALID
!= pinSet
[1][IDX_PS_CMRST
]) {
283 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");}
284 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");}
285 if(mt_set_gpio_dir(pinSet
[1][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
286 if(mt_set_gpio_dir(pinSet
[1][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
287 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
288 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
292 if (GPIO_CAMERA_INVALID
!= pinSet
[0][IDX_PS_CMRST
]) {
293 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");}
294 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");}
295 if(mt_set_gpio_dir(pinSet
[0][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
296 if(mt_set_gpio_dir(pinSet
[0][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
297 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
298 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
307 //PK_DBG("[OFF]sensorIdx:%d \n",SensorIdx);
308 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
309 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");}
310 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");}
311 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
312 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
313 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
314 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
317 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A
,mode_name
)) {
318 PK_DBG("[CAMERA SENSOR] Fail to OFF a power\n");
320 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A2
,mode_name
)){
321 PK_DBG("[CAMERA SENSOR] Fail to OFF a2 power\n");
323 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D
, mode_name
)) {
324 PK_DBG("[CAMERA SENSOR] Fail to OFF d digital power\n");
326 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D2
,mode_name
))
328 PK_DBG("[CAMERA SENSOR] Fail to OFF d2 digital power\n");
332 #endif /* end of defined MTK_ALPS_BOX_SUPPORT */
336 _kdCISModulePowerOn_exit_
:
340 EXPORT_SYMBOL(kdCISModulePowerOn
);