arch/arm/mach-mt8127/tpw8127_tb_c_l/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
  40 int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx, char *currSensorName, BOOL On, char* mode_name)
  41 {
  42 #if !defined (MTK_ALPS_BOX_SUPPORT)
  43
  44 u32 pinSetIdx = 0;//default main sensor
  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
  54 u32 pinSet[2][8] = {
  55                     //for main sensor
  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,
  62                         GPIO_OUT_ONE,
  63                         GPIO_OUT_ZERO,
  64                     },
  65                     //for sub sensor
  66                     {GPIO_CAMERA_CMRST1_PIN,
  67                      GPIO_CAMERA_CMRST1_PIN_M_GPIO,
  68                         GPIO_OUT_ONE,
  69                         GPIO_OUT_ZERO,
  70                      GPIO_CAMERA_CMPDN1_PIN,
  71                         GPIO_CAMERA_CMPDN1_PIN_M_GPIO,
  72                         GPIO_OUT_ONE,
  73                         GPIO_OUT_ZERO,
  74                     },
  75                    };
  76
  77
  78
  79
  80
  81
  82
  83     if (DUAL_CAMERA_MAIN_SENSOR == SensorIdx){
  84         pinSetIdx = 0;
  85     }
  86     else if (DUAL_CAMERA_SUB_SENSOR == SensorIdx) {
  87         pinSetIdx = 1;
  88     }
  89
  90
  91     //power ON
  92     if (On) {
  93
  94                 PK_DBG("kdCISModulePowerOn -on:currSensorName=%s;\n",currSensorName);
  95                 PK_DBG("kdCISModulePowerOn -on:pinSetIdx=%d\n",pinSetIdx);
  96
  97                  if ((pinSetIdx==0) && currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5647_RAW, currSensorName)))
  98                  {
  99                          //enable active sensor
 100                          if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
 101                                  //RST pin,active low
 102                                  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");}
 103                                  if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 104                                  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");}
 105                                  mdelay(5);
 106
 107                                  //PDN pin,high
 108                                  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");}
 109                                  if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 110                                  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");}
 111                                  mdelay(5);
 112                          }
 113
 114                          //DOVDD
 115                          PK_DBG("[ON_general 1.8V]sensorIdx:%d \n",SensorIdx);
 116                          if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D2, VOL_1800,mode_name))
 117                          {
 118                                  PK_DBG("[CAMERA SENSOR] Fail to enable D2 power\n");
 119                                  //return -EIO;
 120                                  //goto _kdCISModulePowerOn_exit_;
 121                          }
 122                          mdelay(5);
 123
 124                          //AVDD
 125                          if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name))
 126                          {
 127                                  PK_DBG("[CAMERA SENSOR] Fail to enable A power\n");
 128                                  //return -EIO;
 129                                  //goto _kdCISModulePowerOn_exit_;
 130                          }
 131                          mdelay(5);
 132
 133                          //DVDD
 134                          if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1500,mode_name))
 135                          {
 136                                   PK_DBG("[CAMERA SENSOR] Fail to enable D power\n");
 137                                   //return -EIO;
 138                                   //goto _kdCISModulePowerOn_exit_;
 139                          }
 140                          mdelay(5);
 141
 142                          //AF_VCC
 143                          if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A2, VOL_2800,mode_name))
 144                          {
 145                                   PK_DBG("[CAMERA SENSOR] Fail to enable A2 power\n");
 146                                   //return -EIO;
 147                                   goto _kdCISModulePowerOn_exit_;
 148                          }
 149                          mdelay(5);
 150
 151                          //enable active sensor
 152                          if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
 153                                  //RST pin
 154                                  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");}
 155                                  if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 156                                  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");}
 157                                  mdelay(5);
 158
 159                                  //PDN pin
 160                                  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");}
 161                                  if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 162                                  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");}
 163                                  mdelay(5);
 164                          }
 165 #if 0
 166                          while(1){
 167
 168                                 mdelay(2000);
 169                                 PK_DBG("im sleep ...\n");
 170                          }
 171 #endif
 172 #if 1
 173                          //disable inactive sensor
 174                          if(pinSetIdx == 0 || pinSetIdx == 2) {//disable sub
 175                                  if (GPIO_CAMERA_INVALID != pinSet[1][IDX_PS_CMRST]) {
 176                                          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");}
 177                                          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");}
 178                                          if(mt_set_gpio_dir(pinSet[1][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 179                                          if(mt_set_gpio_dir(pinSet[1][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 180                                          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
 181                                          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
 182                                  }
 183                          }
 184                          else {
 185                                  if (GPIO_CAMERA_INVALID != pinSet[0][IDX_PS_CMRST]) {
 186                                          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");}
 187                                          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");}
 188                                          if(mt_set_gpio_dir(pinSet[0][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 189                                          if(mt_set_gpio_dir(pinSet[0][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 190                                          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
 191                                          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
 192                                  }
 193                          }
 194 #endif
 195                  }
 196                 else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV2659_YUV, currSensorName)))
 197                  {
 198         //enable active sensor
 199         if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
 200             //RST pin,active low
 201             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");}
 202             if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 203             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");}
 204             mdelay(5);
 205
 206             //PDN pin,high
 207             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");}
 208             if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 209             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");}
 210             mdelay(5);
 211         }
 212
 213         //DOVDD
 214         PK_DBG("[ON_general 1.8V]sensorIdx:%d \n",SensorIdx);
 215         if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D2, VOL_1800,mode_name))
 216         {
 217             PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 218             //return -EIO;
 219             //goto _kdCISModulePowerOn_exit_;
 220         }
 221         mdelay(5);
 222
 223         //AVDD
 224         if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A, VOL_2800,mode_name))
 225         {
 226             PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
 227             //return -EIO;
 228             //goto _kdCISModulePowerOn_exit_;
 229         }
 230         mdelay(5);
 231
 232         //DVDD
 233         if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_D, VOL_1500,mode_name))
 234         {
 235              PK_DBG("[CAMERA SENSOR] Fail to enable digital power\n");
 236              //return -EIO;
 237              //goto _kdCISModulePowerOn_exit_;
 238         }
 239         mdelay(5);
 240
 241                 #if 0
 242        // AF_VCC
 243         if(TRUE != hwPowerOn(CAMERA_POWER_VCAM_A2, VOL_2800,mode_name))
 244        {
 245              PK_DBG("[CAMERA SENSOR] Fail to enable analog power\n");
 246              //return -EIO;
 247              goto _kdCISModulePowerOn_exit_;
 248         }
 249         #endif
 250
 251                 //enable active sensor
 252                 if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
 253                         //RST pin
 254                         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");}
 255                         if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 256                         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                         mdelay(5);
 258
 259                         //PDN pin
 260                         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");}
 261                         if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 262                         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");}
 263                         mdelay(5);
 264                 }
 265
 266
 267          //disable inactive sensor
 268          if(pinSetIdx == 0 || pinSetIdx == 2) {//disable sub
 269                  if (GPIO_CAMERA_INVALID != pinSet[1][IDX_PS_CMRST]) {
 270                          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");}
 271                          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");}
 272                          if(mt_set_gpio_dir(pinSet[1][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 273                          if(mt_set_gpio_dir(pinSet[1][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 274                          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
 275                          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
 276                  }
 277          }
 278          else {
 279                  if (GPIO_CAMERA_INVALID != pinSet[0][IDX_PS_CMRST]) {
 280                          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");}
 281                          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");}
 282                          if(mt_set_gpio_dir(pinSet[0][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 283                          if(mt_set_gpio_dir(pinSet[0][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 284                          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
 285                          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
 286                  }
 287          }
 288
 289
 290          }
 291         }
 292     else {//power OFF
 293
 294         //PK_DBG("[OFF]sensorIdx:%d \n",SensorIdx);
 295         if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
 296             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");}
 297             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");}
 298             if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PK_DBG("[CAMERA SENSOR] set gpio dir failed!! \n");}
 299             if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PK_DBG("[CAMERA LENS] set gpio dir failed!! \n");}
 300             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
 301             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
 302         }
 303
 304         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A,mode_name)) {
 305             PK_DBG("[CAMERA SENSOR] Fail to OFF a power\n");
 306         }
 307         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_A2,mode_name)){
 308             PK_DBG("[CAMERA SENSOR] Fail to OFF a2 power\n");
 309         }
 310         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_D, mode_name)) {
 311             PK_DBG("[CAMERA SENSOR] Fail to OFF d digital power\n");
 312         }
 313         if(TRUE != hwPowerDown(CAMERA_POWER_VCAM_D2,mode_name))
 314         {
 315             PK_DBG("[CAMERA SENSOR] Fail to OFF d2 digital power\n");
 316         }
 317     }//
 318
 319 #endif /* end of defined MTK_ALPS_BOX_SUPPORT */
 320
 321         return 0;
 322
 323 _kdCISModulePowerOn_exit_:
 324     return -EIO;
 325 }
 326
 327 EXPORT_SYMBOL(kdCISModulePowerOn);
 328
 329
 330 //!--
 331 //
 332
 333
 334
 335