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...)
40 int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx
, char *currSensorName
, BOOL On
, char* mode_name
)
42 #if !defined (MTK_ALPS_BOX_SUPPORT)
44 u32 pinSetIdx
= 0;//default main sensor
46 #define IDX_PS_CMRST 0
47 #define IDX_PS_CMPDN 4
56 {GPIO_CAMERA_CMRST_PIN
,
57 GPIO_CAMERA_CMRST_PIN_M_GPIO
, /* mode */
58 GPIO_OUT_ONE
, /* ON state */
59 GPIO_OUT_ZERO
, /* OFF state */
60 GPIO_CAMERA_CMPDN_PIN
,
61 GPIO_CAMERA_CMPDN_PIN_M_GPIO
,
66 {GPIO_CAMERA_CMRST1_PIN
,
67 GPIO_CAMERA_CMRST1_PIN_M_GPIO
,
70 GPIO_CAMERA_CMPDN1_PIN
,
71 GPIO_CAMERA_CMPDN1_PIN_M_GPIO
,
77 if (DUAL_CAMERA_MAIN_SENSOR
== SensorIdx
){
80 else if (DUAL_CAMERA_SUB_SENSOR
== SensorIdx
) {
87 PK_DBG("kdCISModulePowerOn -on:currSensorName=%s;\n",currSensorName
);
88 PK_DBG("kdCISModulePowerOn -on:pinSetIdx=%d\n",pinSetIdx
);
90 if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW
,currSensorName
)||0 == strcmp(SENSOR_DRVNAME_OV56702ND_MIPI_RAW
,currSensorName
))){
94 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");}
95 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
96 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_OUT_ZERO
)){PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");}
98 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
,mode_name
))
100 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
105 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");}
106 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
107 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMPDN
],GPIO_OUT_ONE
)){PK_DBG("[CAMERA LENS] set gpio failed!! \n");}
109 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
,mode_name
))
111 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
117 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D
, VOL_1200
,mode_name
))
119 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
123 if(mt_set_gpio_out(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_OUT_ONE
)){PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");}
126 }else if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_OV2680_RAW
,currSensorName
))) {
131 // 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");}
132 // if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN], GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
133 // 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");}
135 // 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");}
139 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");}
140 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
], GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
141 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");}
145 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
, mode_name
))
147 PK_DBG("[CAMERA SENSOR] Fail to enable IO power\n");
148 goto _kdCISModulePowerOn_exit_
;
153 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
, mode_name
))
155 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
156 goto _kdCISModulePowerOn_exit_
;
159 //if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_D, VOL_1500,mode_name))
161 // PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
162 // goto _kdCISModulePowerOn_exit_;
165 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");}
167 // wait power to be stable
171 }else if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_GC2355_MIPI_RAW
,currSensorName
))) {
175 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");}
176 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
], GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
177 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");}
180 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");}
181 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
], GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
182 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");}
185 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D2
, VOL_1800
, mode_name
))
187 PK_DBG("[CAMERA SENSOR] Fail to enable IO power\n");
188 goto _kdCISModulePowerOn_exit_
;
192 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_D
, VOL_1800
,mode_name
))
194 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
195 goto _kdCISModulePowerOn_exit_
;
198 if(TRUE
!= hwPowerOn(CAMERA_POWER_VCAM_A
, VOL_2800
, mode_name
))
200 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
201 goto _kdCISModulePowerOn_exit_
;
206 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");}
210 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");}
212 // wait power to be stable
222 if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW
,currSensorName
)||0 == strcmp(SENSOR_DRVNAME_OV56702ND_MIPI_RAW
,currSensorName
))){
225 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");}
226 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
227 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
230 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D
, mode_name
)) {
231 PK_DBG("[CAMERA SENSOR] Fail to OFF d digital power\n");
234 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D2
,mode_name
))
236 PK_DBG("[CAMERA SENSOR] Fail to OFF d2 digital power\n");
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");} //high == power down lens module
244 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A
,mode_name
)) {
245 PK_DBG("[CAMERA SENSOR] Fail to OFF a power\n");
250 } else if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_OV2680_RAW
,currSensorName
))){
253 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
255 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");}
256 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
257 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
261 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A
,mode_name
)) {
262 PK_DBG("[CAMERA SENSOR] Fail to OFF a power\n");
267 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D2
,mode_name
))
269 PK_DBG("[CAMERA SENSOR] Fail to OFF d2 digital power\n");
272 } else if (currSensorName
&& (0 == strcmp(SENSOR_DRVNAME_GC2355_MIPI_RAW
,currSensorName
))){
275 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");}
276 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMPDN
], GPIO_DIR_OUT
)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
277 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");}
281 if (GPIO_CAMERA_INVALID
!= pinSet
[pinSetIdx
][IDX_PS_CMRST
]) {
283 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");}
284 if(mt_set_gpio_dir(pinSet
[pinSetIdx
][IDX_PS_CMRST
],GPIO_DIR_OUT
)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
285 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
291 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_A
,mode_name
)) {
292 PK_DBG("[CAMERA SENSOR] Fail to OFF a power\n");
295 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D
,mode_name
))
297 PK_DBG("[CAMERA SENSOR] Fail to OFF d2 digital power\n");
300 if(TRUE
!= hwPowerDown(CAMERA_POWER_VCAM_D2
,mode_name
))
302 PK_DBG("[CAMERA SENSOR] Fail to OFF d2 digital power\n");
310 #endif /* end of defined MTK_ALPS_BOX_SUPPORT */
314 _kdCISModulePowerOn_exit_
:
318 EXPORT_SYMBOL(kdCISModulePowerOn
);