arch/arm/mach-mt8127/kr076_nand/camera/camera/kd_camera_hw.c

   1 #include <linux/videodev2.h>
   2 #include <linux/i2c.h>
   3 #include <linux/platform_device.h>
   4 #include <linux/delay.h>
   5 #include <linux/cdev.h>
   6 #include <linux/uaccess.h>
   7 #include <linux/fs.h>
   8 #include <asm/atomic.h>
   9 #include <linux/xlog.h>
  10
  11 #include "kd_camera_hw.h"
  12
  13 #include "kd_imgsensor.h"
  14 #include "kd_imgsensor_define.h"
  15 #include "kd_camera_feature.h"
  16
  17 /******************************************************************************
  18  * Debug configuration
  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)
  23
  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...) \
  29                 do {    \
  30                    xlog_printk(ANDROID_LOG_INFO, PFX , fmt, ##arg); \
  31                 } while(0)
  32 #else
  33 #define PK_DBG(a,...)
  34 #define PK_ERR(a,...)
  35 #define PK_XLOG_INFO(fmt, args...)
  36 #endif
  37
  38
  39 int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx, char *currSensorName, BOOL On, char* mode_name)
  40 {
  41 #if !defined (MTK_ALPS_BOX_SUPPORT)
  42
  43     u32 pinSetIdx = 0;//default main sensor
  44     u32 pinSetIdxTmp = 0;
  45
  46 #define IDX_PS_CMRST 0
  47 #define IDX_PS_CMPDN 4
  48
  49 #define IDX_PS_MODE 1
  50 #define IDX_PS_ON   2
  51 #define IDX_PS_OFF  3
  52
  53 #define IDX_SUB_CAM 1
  54
  55     u32 pinSet[2][8] =
  56     {
  57         //for main sensor
  58         {
  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,
  65             GPIO_OUT_ONE,
  66             GPIO_OUT_ZERO,
  67         },
  68         //for sub sensor
  69         {
  70             GPIO_CAMERA_CMRST_PIN,
  71             GPIO_CAMERA_CMRST_PIN_M_GPIO,
  72             GPIO_OUT_ONE,
  73             GPIO_OUT_ZERO,
  74             GPIO_CAMERA_CMPDN1_PIN,
  75             GPIO_CAMERA_CMPDN1_PIN_M_GPIO,
  76             GPIO_OUT_ONE,
  77             GPIO_OUT_ZERO,
  78         },
  79     };
  80
  81     if (DUAL_CAMERA_MAIN_SENSOR == SensorIdx)
  82     {
  83         pinSetIdx = 0;
  84     }
  85     else if (DUAL_CAMERA_SUB_SENSOR == SensorIdx)
  86     {
  87         pinSetIdx = 1;
  88     }
  89
  90
  91     //power ON
  92     if (On)
  93     {
  94
  95         PK_DBG("kdCISModulePowerOn -on:currSensorName=%s;\n",currSensorName);
  96         PK_DBG("kdCISModulePowerOn -on:pinSetIdx=%d\n",pinSetIdx);
  97
  98         if ((pinSetIdx == 1) && currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI708_YUV,currSensorName)))
  99         {
 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
 102             {
 103                 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 104                 //return -EIO;
 105                 goto _kdCISModulePowerOn_exit_;
 106             }
 107
 108             if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name)) //AVDD
 109             {
 110                 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
 111                 //return -EIO;
 112                 goto _kdCISModulePowerOn_exit_;
 113             }
 114             if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1800,mode_name)) //DVDD no use
 115             {
 116                 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 117                 //return -EIO;
 118                 goto _kdCISModulePowerOn_exit_;
 119             }
 120             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON]))
 121             {
 122                 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 123             }
 124             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 125             {
 126                 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 127             }
 128
 129             //PDN/STBY pin
 130             if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
 131             {
 132
 133                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE]))
 134                 {
 135                     PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
 136                 }
 137                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT))
 138                 {
 139                     PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
 140                 }
 141                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF]))
 142                 {
 143                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 144                 }
 145
 146                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF]))
 147                 {
 148                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 149                 }
 150                 msleep(3);
 151
 152
 153                 //RST pin
 154                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE]))
 155                 {
 156                     PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
 157                 }
 158                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT))
 159                 {
 160                     PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
 161                 }
 162                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 163                 {
 164                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 165                 }
 166                 msleep(3);
 167                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_ON]))
 168                 {
 169                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 170                 }
 171                 msleep(3);
 172             }
 173
 174             //disable inactive sensor
 175             if(pinSetIdx == 0)  //disable sub
 176             {
 177                 pinSetIdxTmp = 1;
 178             }
 179             else
 180             {
 181                 pinSetIdxTmp = 0;
 182             }
 183 #if 1
 184             if (GPIO_CAMERA_INVALID != pinSet[pinSetIdxTmp][IDX_PS_CMRST])
 185             {
 186                 if(mt_set_gpio_mode(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],pinSet[pinSetIdxTmp][IDX_PS_CMPDN+IDX_PS_MODE]))
 187                 {
 188                     PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
 189                 }
 190
 191                 if(mt_set_gpio_dir(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],GPIO_DIR_OUT))
 192                 {
 193                     PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
 194                 }
 195
 196                 if(mt_set_gpio_out(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],pinSet[pinSetIdxTmp][IDX_PS_CMPDN+IDX_PS_OFF]))
 197                 {
 198                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");   //high == power down lens module
 199                 }
 200                 //RST pin
 201                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE]))
 202                 {
 203                     PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
 204                 }
 205                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT))
 206                 {
 207                     PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
 208                 }
 209                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 210                 {
 211                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 212                 }
 213                 msleep(3);
 214             }
 215 #endif
 216             //while(1);
 217         }
 218         else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV2680_RAW ,currSensorName))) {
 219             //OV5648 Power UP
 220             //First Power Pin low and Reset Pin Low
 221
 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
 229                         }
 230        /*[BUGFIX] ADD-END by sz.chengming.xiang for PR-1021927 2015/06/15*/
 231
 232             if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D2, VOL_1800, mode_name))
 233             {
 234                 PK_DBG("[CAMERA SENSOR] Fail to enable IO power\n");
 235                 goto _kdCISModulePowerOn_exit_;
 236             }
 237            {
 238                 //PDN pin
 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");}
 242                                 mdelay(10);
 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");}
 244                                 mdelay(5);
 245
 246                 //RST pin
 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");}
 250                                 mdelay(10);
 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");}
 252                                 mdelay(5);
 253             }
 254
 255             msleep(20);
 256
 257             if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800, mode_name))
 258             {
 259                 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
 260                 goto _kdCISModulePowerOn_exit_;
 261             }
 262
 263             //if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_D, VOL_1500,mode_name))
 264            // {
 265            //      PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 266            //      goto _kdCISModulePowerOn_exit_;
 267            // }
 268
 269
 270             // wait power to be stable
 271             mdelay(25);
 272         }
 273         else if ((pinSetIdx == 0) && currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K5E2YA_MIPI_RAW,currSensorName)))
 274         {
 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
 277             {
 278                 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 279                 //return -EIO;
 280                 goto _kdCISModulePowerOn_exit_;
 281             }
 282
 283             if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name)) //AVDD
 284             {
 285                 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
 286                 //return -EIO;
 287                 goto _kdCISModulePowerOn_exit_;
 288             }
 289             if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1200,mode_name)) //DVDD no use
 290             {
 291                 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 292                 //return -EIO;
 293                 goto _kdCISModulePowerOn_exit_;
 294             }
 295             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF]))
 296             {
 297                 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 298             }
 299             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 300             {
 301                 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 302             }
 303
 304             //PDN/STBY pin
 305             if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
 306             {
 307
 308                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE]))
 309                 {
 310                     PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
 311                 }
 312                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT))
 313                 {
 314                     PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
 315                 }
 316                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF]))
 317                 {
 318                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 319                 }
 320                 msleep(3);
 321                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON]))
 322                 {
 323                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 324                 }
 325                 msleep(3);
 326
 327
 328                 //RST pin
 329                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE]))
 330                 {
 331                     PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
 332                 }
 333                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT))
 334                 {
 335                     PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
 336                 }
 337                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 338                 {
 339                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 340                 }
 341                 msleep(3);
 342                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_ON]))
 343                 {
 344                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 345                 }
 346                 msleep(3);
 347             }
 348
 349             //disable inactive sensor
 350             if(pinSetIdx == 0)  //disable sub
 351             {
 352                 pinSetIdxTmp = 1;
 353             }
 354             else
 355             {
 356                 pinSetIdxTmp = 0;
 357             }
 358 #if 1
 359             if (GPIO_CAMERA_INVALID != pinSet[pinSetIdxTmp][IDX_PS_CMRST])
 360             {
 361                 if(mt_set_gpio_mode(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],pinSet[pinSetIdxTmp][IDX_PS_CMPDN+IDX_PS_MODE]))
 362                 {
 363                     PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
 364                 }
 365
 366                 if(mt_set_gpio_dir(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],GPIO_DIR_OUT))
 367                 {
 368                     PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
 369                 }
 370
 371                 if(mt_set_gpio_out(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],pinSet[pinSetIdxTmp][IDX_PS_CMPDN+IDX_PS_OFF]))
 372                 {
 373                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");   //high == power down lens module
 374                 }
 375                 //RST pin
 376                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE]))
 377                 {
 378                     PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
 379                 }
 380                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT))
 381                 {
 382                     PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
 383                 }
 384                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 385                 {
 386                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 387                 }
 388                 msleep(3);
 389             }
 390 #endif
 391             //while(1);
 392         }
 393         else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2355_RAW,currSensorName)))
 394         {
 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
 397             {
 398                 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 399                 //return -EIO;
 400                 goto _kdCISModulePowerOn_exit_;
 401             }
 402
 403             if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name)) //AVDD
 404             {
 405                 PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
 406                 //return -EIO;
 407                 goto _kdCISModulePowerOn_exit_;
 408             }
 409             if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1800,mode_name)) //DVDD no use
 410             {
 411                 PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 412                 //return -EIO;
 413                 goto _kdCISModulePowerOn_exit_;
 414             }
 415             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON]))
 416             {
 417                 PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 418             }
 419             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 420             {
 421                 PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 422             }
 423
 424             //PDN/STBY pin
 425             if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
 426             {
 427
 428                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE]))
 429                 {
 430                     PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
 431                 }
 432                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT))
 433                 {
 434                     PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
 435                 }
 436                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF]))
 437                 {
 438                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 439                 }
 440                 msleep(3);
 441                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF]))
 442                 {
 443                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");
 444                 }
 445                 msleep(3);
 446
 447
 448                 //RST pin
 449                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE]))
 450                 {
 451                     PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
 452                 }
 453                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT))
 454                 {
 455                     PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
 456                 }
 457                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 458                 {
 459                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 460                 }
 461                 msleep(3);
 462                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_ON]))
 463                 {
 464                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 465                 }
 466                 msleep(3);
 467             }
 468
 469             //disable inactive sensor
 470             if(pinSetIdx == 0)  //disable sub
 471             {
 472                 pinSetIdxTmp = 1;
 473             }
 474             else
 475             {
 476                 pinSetIdxTmp = 0;
 477             }
 478 #if 1
 479             if (GPIO_CAMERA_INVALID != pinSet[pinSetIdxTmp][IDX_PS_CMRST])
 480             {
 481                 if(mt_set_gpio_mode(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],pinSet[pinSetIdxTmp][IDX_PS_CMPDN+IDX_PS_MODE]))
 482                 {
 483                     PK_DBG("[CAMERA LENS] set gpio mode failed!! \n");
 484                 }
 485
 486                 if(mt_set_gpio_dir(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],GPIO_DIR_OUT))
 487                 {
 488                     PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");
 489                 }
 490
 491                 if(mt_set_gpio_out(pinSet[pinSetIdxTmp][IDX_PS_CMPDN],pinSet[pinSetIdxTmp][IDX_PS_CMPDN+IDX_PS_ON]))
 492                 {
 493                     PK_DBG("[CAMERA LENS] set gpio failed!! \n");   //high == power down lens module
 494                 }
 495                 //RST pin
 496                 if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE]))
 497                 {
 498                     PK_DBG("[CAMERA SENSOR] set gpio mode failed!! \n");
 499                 }
 500                 if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT))
 501                 {
 502                     PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");
 503                 }
 504                 if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF]))
 505                 {
 506                     PK_DBG("[CAMERA SENSOR] set gpio failed!! \n");
 507                 }
 508                 msleep(3);
 509             }
 510 #endif
 511             //while(1);
 512         }
 513         else{
 514                   if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A,mode_name)) {
 515             PK_DBG("[CAMERA SENSOR] Fail to OFF analog power\n");
 516             //return -EIO;
 517             //goto _kdCISModulePowerOn_exit_;
 518         }
 519         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A2,mode_name))
 520         {
 521             PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
 522             //return -EIO;
 523             //goto _kdCISModulePowerOn_exit_;
 524         }
 525         mdelay(5);
 526
 527         //DVDD
 528         if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1500,mode_name))
 529         {
 530              PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 531              //return -EIO;
 532              //goto _kdCISModulePowerOn_exit_;
 533         }
 534         mdelay(5);
 535
 536                 #if 0
 537        // AF_VCC
 538         if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A2, VOL_2800,mode_name))
 539        {
 540              PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
 541              //return -EIO;
 542              goto _kdCISModulePowerOn_exit_;
 543         }
 544         #endif
 545
 546                 //enable active sensor
 547                 if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
 548                         //RST pin
 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");}
 552                         mdelay(5);
 553
 554                         //PDN pin
 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");}
 558                         mdelay(5);
 559                 }
 560
 561
 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
 571                  }
 572          }
 573          else {
 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
 581                  }
 582          }
 583
 584
 585          }
 586         }
 587     else {//power OFF
 588
 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
 597         }
 598
 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])) {
 603         {
 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]);
 607         }
 608
 609         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A,mode_name)) {
 610             PK_DBG("[CAMERA SENSOR] Fail to OFF a power\n");
 611         }
 612         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A2,mode_name)){
 613             PK_DBG("[CAMERA SENSOR] Fail to OFF a2 power\n");
 614         }
 615         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_D, mode_name)) {
 616             PK_DBG("[CAMERA SENSOR] Fail to OFF d digital power\n");
 617         }
 618         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_D2,mode_name))
 619         {
 620             PK_DBG("[CAMERA SENSOR] Fail to OFF d2 digital power\n");
 621         }
 622     }//
 623
 624 #endif /* end of defined MTK_ALPS_BOX_SUPPORT */
 625
 626     return 0;
 627
 628 _kdCISModulePowerOn_exit_:
 629     return -EIO;
 630 }
 631 }
 632 EXPORT_SYMBOL(kdCISModulePowerOn);
 633
 634
 635 //!--
 636 //
 637
 638
 639
 640