int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx, char *currSensorName, BOOL On, char* mode_name)
{
u32 pinSetIdx = 0;//default main sensor
#define IDX_PS_CMRST 0
#define IDX_PS_CMPDN 4
#define IDX_PS_MODE 1
#define IDX_PS_ON 2
#define IDX_PS_OFF 3
u32 pinSet[3][8] = {
//for main sensor
{ CAMERA_CMRST_PIN, // The reset pin of main sensor uses GPIO10 of mt6306, please call mt6306 API to set
CAMERA_CMRST_PIN_M_GPIO, /* mode */
GPIO_OUT_ONE, /* ON state */
GPIO_OUT_ZERO, /* OFF state */
CAMERA_CMPDN_PIN,
CAMERA_CMPDN_PIN_M_GPIO,
GPIO_OUT_ONE,
GPIO_OUT_ZERO,
},
//for sub sensor
{ CAMERA_CMRST1_PIN,
CAMERA_CMRST1_PIN_M_GPIO,
GPIO_OUT_ONE,
GPIO_OUT_ZERO,
CAMERA_CMPDN1_PIN,
CAMERA_CMPDN1_PIN_M_GPIO,
GPIO_OUT_ONE,
GPIO_OUT_ZERO,
},
//for main_2 sensor
{ GPIO_CAMERA_INVALID,
GPIO_CAMERA_INVALID, /* mode */
GPIO_OUT_ONE, /* ON state */
GPIO_OUT_ZERO, /* OFF state */
GPIO_CAMERA_INVALID,
GPIO_CAMERA_INVALID,
GPIO_OUT_ONE,
GPIO_OUT_ZERO,
}
};
if (DUAL_CAMERA_MAIN_SENSOR == SensorIdx){
pinSetIdx = 0;
}
else if (DUAL_CAMERA_SUB_SENSOR == SensorIdx) {
pinSetIdx = 1;
}
else if (DUAL_CAMERA_MAIN_2_SENSOR == SensorIdx) {
pinSetIdx = 2;
}
//power ON
if (On) {
#if 0
ISP_MCLK1_EN(1);
ISP_MCLK2_EN(1);
ISP_MCLK3_EN(1);
#else
if(pinSetIdx == 0 ) {
ISP_MCLK1_EN(1);
}
else if (pinSetIdx == 1) {
ISP_MCLK2_EN(1);
}
#endif
PK_DBG("[PowerON]pinSetIdx:%d, currSensorName: %s\n", pinSetIdx, currSensorName);
if ((currSensorName && (0 == strcmp(currSensorName,"imx135mipiraw")))||
(currSensorName && (0 == strcmp(currSensorName,"imx220mipiraw"))))
{
//First Power Pin low and Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
//AF_VCC
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_AF, VOL_2800,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable analog power (VCAM_AF), power id = %d \n", CAMERA_POWER_VCAM_AF);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
//VCAM_A
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable analog power (VCAM_A), power id = %d\n", CAMERA_POWER_VCAM_A);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1000,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power (VCAM_D), power id = %d \n", CAMERA_POWER_VCAM_D);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
//VCAM_IO
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_IO, VOL_1800, mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power (VCAM_IO), power id = %d \n", CAMERA_POWER_VCAM_IO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(2);
//enable active sensor
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
}
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW, currSensorName)))
{
mt_set_gpio_mode(GPIO_SPI_MOSI_PIN,GPIO_MODE_00);
mt_set_gpio_dir(GPIO_SPI_MOSI_PIN,GPIO_DIR_OUT);
mt_set_gpio_out(GPIO_SPI_MOSI_PIN,GPIO_OUT_ONE);
//First Power Pin low and Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
//VCAM_IO
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_IO, VOL_1800, mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power (VCAM_IO), power id = %d \n", CAMERA_POWER_VCAM_IO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
//VCAM_A
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable analog power (VCAM_A), power id = %d\n", CAMERA_POWER_VCAM_A);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
if(TRUE != hwPowerOn(SUB_CAMERA_POWER_VCAM_D, VOL_1500,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power (VCAM_D), power id = %d \n", CAMERA_POWER_VCAM_D);
goto _kdCISModulePowerOn_exit_;
}
mdelay(5);
//AF_VCC
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_AF, VOL_2800,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable analog power (VCAM_AF), power id = %d \n", CAMERA_POWER_VCAM_AF);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
//enable active sensor
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
mdelay(2);
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
mdelay(20);
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2355_MIPI_RAW, currSensorName)))
{
mt_set_gpio_mode(GPIO_SPI_MOSI_PIN,GPIO_MODE_00);
mt_set_gpio_dir(GPIO_SPI_MOSI_PIN,GPIO_DIR_OUT);
mt_set_gpio_out(GPIO_SPI_MOSI_PIN,GPIO_OUT_ONE);
//First Power Pin low and Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
mdelay(50);
//VCAM_A
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable analog power (VCAM_A), power id = %d\n", CAMERA_POWER_VCAM_A);
goto _kdCISModulePowerOn_exit_;
}
mdelay(10);
//VCAM_IO
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_IO, VOL_1800, mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power (VCAM_IO), power id = %d \n", CAMERA_POWER_VCAM_IO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(10);
if(TRUE != hwPowerOn(SUB_CAMERA_POWER_VCAM_D, VOL_1500,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power (VCAM_D), power id = %d \n", CAMERA_POWER_VCAM_D);
goto _kdCISModulePowerOn_exit_;
}
mdelay(10);
//AF_VCC
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_AF, VOL_2800,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable analog power (VCAM_AF), power id = %d \n", CAMERA_POWER_VCAM_AF);
goto _kdCISModulePowerOn_exit_;
}
mdelay(50);
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
mdelay(5);
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!! (CMRST)\n");}
}
mdelay(5);
//enable active sensor
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
mdelay(5);
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!! (CMPDN)\n");}
}
mdelay(5);
}
else
{
//First Power Pin low and Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
//VCAM_IO
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_IO, VOL_1800, mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power (VCAM_IO), power id = %d \n", CAMERA_POWER_VCAM_IO);
goto _kdCISModulePowerOn_exit_;
}
//VCAM_A
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable analog power (VCAM_A), power id = %d\n", CAMERA_POWER_VCAM_A);
goto _kdCISModulePowerOn_exit_;
}
//VCAM_D
if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K2P8_MIPI_RAW, currSensorName)))
{
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1200,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
goto _kdCISModulePowerOn_exit_;
}
}
else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_IMX219_MIPI_RAW, currSensorName)))
{
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1200,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
goto _kdCISModulePowerOn_exit_;
}
}
else { // Main VCAMD max 1.5V
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1500,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
goto _kdCISModulePowerOn_exit_;
}
}
//AF_VCC
if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_AF, VOL_2800,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to enable analog power (VCAM_AF), power id = %d \n", CAMERA_POWER_VCAM_AF);
goto _kdCISModulePowerOn_exit_;
}
mdelay(5);
//enable active sensor
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
mdelay(1);
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
}
}
else {//power OFF
PK_DBG("[PowerOFF]pinSetIdx:%d\n", pinSetIdx);
if(pinSetIdx == 0 ) {
ISP_MCLK1_EN(0);
}
else if (pinSetIdx == 1) {
ISP_MCLK2_EN(0);
}
if ((currSensorName && (0 == strcmp(currSensorName,"imx135mipiraw")))||
(currSensorName && (0 == strcmp(currSensorName,"imx220mipiraw"))))
{
//Set Power Pin low and Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
//Set Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
//AF_VCC
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_AF,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to OFF AF power (VCAM_AF), power id = %d \n", CAMERA_POWER_VCAM_AF);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
//VCAM_IO
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_IO, mode_name)) {
PK_DBG("[CAMERA SENSOR] Fail to OFF digital power (VCAM_IO), power id = %d \n", CAMERA_POWER_VCAM_IO);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_D,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to OFF core power (VCAM_D), power id = %d \n",CAMERA_POWER_VCAM_D);
goto _kdCISModulePowerOn_exit_;
}
//VCAM_A
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A,mode_name)) {
PK_DBG("[CAMERA SENSOR] Fail to OFF analog power (VCAM_A), power id= (%d) \n", CAMERA_POWER_VCAM_A);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW, currSensorName)))
{
mt_set_gpio_out(GPIO_SPI_MOSI_PIN,GPIO_OUT_ZERO);
//Set Power Pin low and Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
if(TRUE != hwPowerDown(SUB_CAMERA_POWER_VCAM_D,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to OFF core power (VCAM_D), power id = %d \n",SUB_CAMERA_POWER_VCAM_D);
goto _kdCISModulePowerOn_exit_;
}
//VCAM_A
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A,mode_name)) {
PK_DBG("[CAMERA SENSOR] Fail to OFF analog power (VCAM_A), power id= (%d) \n", CAMERA_POWER_VCAM_A);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
//VCAM_IO
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_IO, mode_name)) {
PK_DBG("[CAMERA SENSOR] Fail to OFF digital power (VCAM_IO), power id = %d \n", CAMERA_POWER_VCAM_IO);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
//AF_VCC
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_AF,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to OFF AF power (VCAM_AF), power id = %d \n", CAMERA_POWER_VCAM_AF);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2355_MIPI_RAW, currSensorName)))
{
mt_set_gpio_out(GPIO_SPI_MOSI_PIN,GPIO_OUT_ZERO);
//Set Power Pin low and Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
if(TRUE != hwPowerDown(SUB_CAMERA_POWER_VCAM_D,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to OFF core power (VCAM_D), power id = %d \n",SUB_CAMERA_POWER_VCAM_D);
goto _kdCISModulePowerOn_exit_;
}
//VCAM_A
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A,mode_name)) {
PK_DBG("[CAMERA SENSOR] Fail to OFF analog power (VCAM_A), power id= (%d) \n", CAMERA_POWER_VCAM_A);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
//VCAM_IO
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_IO, mode_name)) {
PK_DBG("[CAMERA SENSOR] Fail to OFF digital power (VCAM_IO), power id = %d \n", CAMERA_POWER_VCAM_IO);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
//AF_VCC
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_AF,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to OFF AF power (VCAM_AF), power id = %d \n", CAMERA_POWER_VCAM_AF);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
}
else
{
//Set Power Pin low and Reset Pin Low
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
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!! (CMPDN)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! (CMPDN)\n");}
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!! (CMPDN)\n");}
}
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
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!! (CMRST)\n");}
if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! (CMRST)\n");}
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!! (CMRST)\n");}
}
if(TRUE != hwPowerDown(SUB_CAMERA_POWER_VCAM_D,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to OFF core power (VCAM_D), power id = %d \n",SUB_CAMERA_POWER_VCAM_D);
goto _kdCISModulePowerOn_exit_;
}
//VCAM_A
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A,mode_name)) {
PK_DBG("[CAMERA SENSOR] Fail to OFF analog power (VCAM_A), power id= (%d) \n", CAMERA_POWER_VCAM_A);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
//VCAM_IO
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_IO, mode_name)) {
PK_DBG("[CAMERA SENSOR] Fail to OFF digital power (VCAM_IO), power id = %d \n", CAMERA_POWER_VCAM_IO);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
//AF_VCC
if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_AF,mode_name))
{
PK_DBG("[CAMERA SENSOR] Fail to OFF AF power (VCAM_AF), power id = %d \n", CAMERA_POWER_VCAM_AF);
//return -EIO;
goto _kdCISModulePowerOn_exit_;
}
}
}
return 0;
_kdCISModulePowerOn_exit_:
return -EIO;
}
int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx, char *currSensorName, bool On, char *mode_name)
{
u32 pinSetIdx = 0;/* default main sensor */
#define IDX_PS_CMRST 0
#define IDX_PS_CMPDN 4
#define IDX_PS_MODE 1
#define IDX_PS_ON 2
#define IDX_PS_OFF 3
#define VOL_2800 2800000
#define VOL_1800 1800000
#define VOL_1500 1500000
#define VOL_1200 1200000
#define VOL_1000 1000000
u32 pinSet[3][8] = {
/* for main sensor */
{/* The reset pin of main sensor uses GPIO10 of mt6306, please call mt6306 API to set */
CAMERA_CMRST_PIN,
CAMERA_CMRST_PIN_M_GPIO, /* mode */
GPIO_OUT_ONE, /* ON state */
GPIO_OUT_ZERO, /* OFF state */
CAMERA_CMPDN_PIN,
CAMERA_CMPDN_PIN_M_GPIO,
GPIO_OUT_ONE,
GPIO_OUT_ZERO,
},
/* for sub sensor */
{
CAMERA_CMRST1_PIN,
CAMERA_CMRST1_PIN_M_GPIO,
GPIO_OUT_ONE,
GPIO_OUT_ZERO,
CAMERA_CMPDN1_PIN,
CAMERA_CMPDN1_PIN_M_GPIO,
GPIO_OUT_ONE,
GPIO_OUT_ZERO,
},
/* for main_2 sensor */
{
GPIO_CAMERA_INVALID,
GPIO_CAMERA_INVALID, /* mode */
GPIO_OUT_ONE, /* ON state */
GPIO_OUT_ZERO, /* OFF state */
GPIO_CAMERA_INVALID,
GPIO_CAMERA_INVALID,
GPIO_OUT_ONE,
GPIO_OUT_ZERO,
}
};
if (DUAL_CAMERA_MAIN_SENSOR == SensorIdx)
pinSetIdx = 0;
else if (DUAL_CAMERA_SUB_SENSOR == SensorIdx)
pinSetIdx = 1;
else if (DUAL_CAMERA_MAIN_2_SENSOR == SensorIdx)
pinSetIdx = 2;
/* power ON */
if (On) {
int i=0;
#if 0
ISP_MCLK1_EN(1);
ISP_MCLK2_EN(1);
ISP_MCLK3_EN(1);
#else
if (pinSetIdx == 0)
ISP_MCLK1_EN(1);
else if (pinSetIdx == 1)
ISP_MCLK2_EN(1);
#endif
PK_DBG("[PowerON]pinSetIdx:%d, currSensorName: %s\n", pinSetIdx, currSensorName);
if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV13850_MIPI_RAW, currSensorName))) {
/* First Power Pin low and Reset Pin Low */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN])
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
*/
#if 0
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
#else
for(i = 0; i<2; i++)
{
mtkcam_gpio_set(i, CAMRST, pinSet[i][IDX_PS_CMRST + IDX_PS_OFF]);
}
#endif
mdelay(2);
/* VCAM_A */
if (TRUE != _hwPowerOn(VCAMA, VOL_2800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable analog power (VCAM_A),power id = %d\n",
VCAMA);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_IO */
if (TRUE != _hwPowerOn(VCAMIO, VOL_1800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable IO power (VCAM_IO),power id = %d\n",
VCAMIO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
if (TRUE != _hwPowerOn(VCAMD, VOL_1200)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable digital power (VCAM_D),power id = %d\n",
VCAMD);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* AF_VCC */
if (TRUE != _hwPowerOn(VCAMAF, VOL_2800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable analog power (VCAM_AF),power id = %d\n",
VCAMAF);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
mdelay(5);
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_ON]);
}
mdelay(5);
/* enable active sensor */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_ON]);
mdelay(5);
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
}
*/
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_MN34153_MIPI_RAW, currSensorName))) {
/* First Power Pin low and Reset Pin Low */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN])
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
*/
#if 0
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
#else
for(i = 0; i<2; i++)
{
mtkcam_gpio_set(i, CAMRST, pinSet[i][IDX_PS_CMRST + IDX_PS_OFF]);
}
#endif
mdelay(2);
/* VCAM_A */
if (TRUE != _hwPowerOn(VCAMA, VOL_2800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable analog power (VCAM_A),power id = %d\n",
VCAMA);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_IO */
if (TRUE != _hwPowerOn(VCAMIO, VOL_1800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable IO power (VCAM_IO),power id = %d\n",
VCAMIO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
if (TRUE != _hwPowerOn(VCAMD, VOL_1200)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable digital power (VCAM_D),power id = %d\n",
VCAMD);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* AF_VCC */
if (TRUE != _hwPowerOn(VCAMAF, VOL_2800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable analog power (VCAM_AF),power id = %d\n",
VCAMAF);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
mdelay(5);
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_ON]);
}
mdelay(5);
/* enable active sensor */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_ON]);
mdelay(5);
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
}
*/
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI553_MIPI_RAW, currSensorName))) {
//mtkcam_gpio_set(pinSetIdx, CAMLDO, 1);
/* First Power Pin low and Reset Pin Low */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN])
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
*/
#if 0
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
#else
for(i = 0; i<2; i++)
{
mtkcam_gpio_set(i, CAMRST, pinSet[i][IDX_PS_CMRST + IDX_PS_OFF]);
}
#endif
mdelay(2);
/* VCAM_IO */
if (TRUE != _hwPowerOn(VCAMIO, VOL_1800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable IO power (VCAM_IO),power id = %d\n",
VCAMIO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_A */
if (TRUE != _hwPowerOn(VCAMA, VOL_2800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable analog power (VCAM_A),power id = %d\n",
VCAMA);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
if (TRUE != _hwPowerOn(VCAMD, VOL_1200)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable digital power (VCAM_D),power id = %d\n",
VCAMD);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
#if 0
/* AF_VCC */
if (TRUE != _hwPowerOn(VCAMAF, VOL_2800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable analog power (VCAM_AF),power id = %d\n",
VCAMAF);
goto _kdCISModulePowerOn_exit_;
}
#endif
mdelay(1);
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
mdelay(5);
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_ON]);
}
mdelay(5);
/* enable active sensor */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_ON]);
mdelay(5);
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
}
*/
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW, currSensorName))) {
/* First Power Pin low and Reset Pin Low */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN])
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
*/
#if 0
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
#else
for(i = 0; i<2; i++)
{
mtkcam_gpio_set(i, CAMRST, pinSet[i][IDX_PS_CMRST + IDX_PS_OFF]);
}
#endif
mdelay(2);
/* VCAM_A */
if (TRUE != _hwPowerOn(VCAMA, VOL_2800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable analog power (VCAM_A),power id = %d\n",
VCAMA);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_IO */
if (TRUE != _hwPowerOn(VCAMIO, VOL_1800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable IO power (VCAM_IO),power id = %d\n",
VCAMIO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
if (TRUE != _hwPowerOn(VCAMD, VOL_1200)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable digital power (VCAM_D),power id = %d\n",
VCAMD);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
#if 0
/* AF_VCC */
if (TRUE != _hwPowerOn(VCAMAF, VOL_2800)) {
PK_DBG
("[CAMERA SENSOR] Fail to enable analog power (VCAM_AF),power id = %d\n",
VCAMAF);
goto _kdCISModulePowerOn_exit_;
}
#endif
mdelay(5);
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
mdelay(5);
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_ON]);
}
/* enable active sensor */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_ON]);
mdelay(5);
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
}
*/
}
} else { /* power OFF */
PK_DBG("[PowerOFF]pinSetIdx:%d\n", pinSetIdx);
if (pinSetIdx == 0)
ISP_MCLK1_EN(0);
else if (pinSetIdx == 1)
ISP_MCLK2_EN(0);
if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV13850_MIPI_RAW, currSensorName))) {
/* Set Power Pin low and Reset Pin Low */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
}
*/
/* Set Reset Pin Low */
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
}
mdelay(1);
if (TRUE != _hwPowerDown(VCAMD)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF core power (VCAM_D), power id = %d\n",
VCAMD);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_A */
if (TRUE != _hwPowerDown(VCAMA)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF analog power (VCAM_A), power id= (%d)\n",
VCAMA);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_IO */
if (TRUE != _hwPowerDown(VCAMIO)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF digital power (VCAM_IO), power id = %d\n",
VCAMIO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* AF_VCC */
if (TRUE != _hwPowerDown(VCAMAF)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF AF power (VCAM_AF), power id = %d\n",
VCAMAF);
goto _kdCISModulePowerOn_exit_;
}
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_MN34153_MIPI_RAW, currSensorName))) {
/* Set Power Pin low and Reset Pin Low */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
}
*/
/* Set Reset Pin Low */
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
}
mdelay(1);
if (TRUE != _hwPowerDown(VCAMD)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF core power (VCAM_D), power id = %d\n",
VCAMD);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_A */
if (TRUE != _hwPowerDown(VCAMA)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF analog power (VCAM_A), power id= (%d)\n",
VCAMA);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_IO */
if (TRUE != _hwPowerDown(VCAMIO)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF digital power (VCAM_IO), power id = %d\n",
VCAMIO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* AF_VCC */
if (TRUE != _hwPowerDown(VCAMAF)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF AF power (VCAM_AF), power id = %d\n",
VCAMAF);
goto _kdCISModulePowerOn_exit_;
}
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI553_MIPI_RAW, currSensorName))) {
//mtkcam_gpio_set(pinSetIdx, CAMLDO, 0);
/* Set Power Pin low and Reset Pin Low */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
}
*/
/* Set Reset Pin Low */
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
}
mdelay(1);
if (TRUE != _hwPowerDown(VCAMD)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF core power (VCAM_D), power id = %d\n",
VCAMD);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_A */
if (TRUE != _hwPowerDown(VCAMA)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF analog power (VCAM_A), power id= (%d)\n",
VCAMA);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_IO */
if (TRUE != _hwPowerDown(VCAMIO)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF digital power (VCAM_IO), power id = %d\n",
VCAMIO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
#if 0
/* AF_VCC */
if (TRUE != _hwPowerDown(VCAMAF)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF AF power (VCAM_AF), power id = %d\n",
VCAMAF);
goto _kdCISModulePowerOn_exit_;
}
#endif
}
else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW, currSensorName))) {
/* Set Power Pin low and Reset Pin Low */
/*
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMPDN]) {
mtkcam_gpio_set(pinSetIdx, CAMPDN,
pinSet[pinSetIdx][IDX_PS_CMPDN + IDX_PS_OFF]);
}
*/
/* Set Reset Pin Low */
if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
mtkcam_gpio_set(pinSetIdx, CAMRST,
pinSet[pinSetIdx][IDX_PS_CMRST + IDX_PS_OFF]);
}
mdelay(1);
if (TRUE != _hwPowerDown(VCAMD)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF core power (VCAM_D), power id = %d\n",
VCAMD);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_IO */
if (TRUE != _hwPowerDown(VCAMIO)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF digital power (VCAM_IO), power id = %d\n",
VCAMIO);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
/* VCAM_A */
if (TRUE != _hwPowerDown(VCAMA)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF analog power (VCAM_A), power id= (%d)\n",
VCAMA);
goto _kdCISModulePowerOn_exit_;
}
mdelay(1);
#if 0
/* AF_VCC */
if (TRUE != _hwPowerDown(VCAMAF)) {
PK_DBG
("[CAMERA SENSOR] Fail to OFF AF power (VCAM_AF), power id = %d\n",
VCAMAF);
goto _kdCISModulePowerOn_exit_;
}
#endif
}
}
return 0;
_kdCISModulePowerOn_exit_:
return -EIO;
}
