MT6571 摄像头驱动

摄像头驱动

-----------------------camera---------------------------------
1、调camera sensor
   增加一个image sensor:
   1)、增加kernel和hal的两个imgsensor的子目录
        mediatek\custom\common\kernel\imgsensor\xxx_yuv
        mediatek\custom\common\hal\imgsensor\xxx_yuv (定义好函数xxx_YUV_SensorInit(){.xxx结构体..})
   2) 在mediatek\custom\common\kernel\imgsensor\inc\Kd_imgsensor.h增加
            #define XXX_SENSOR_ID     0x00A6 
            #define SENSOR_DRVNAME_XXX_YUV     "xxxyuv" 
   3) 在mediatek\custom\common\kernel\imgsensor\src\Kd_sensorlist.h的
       数组中ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT kdSensorList[MAX_NUM_OF_SUPPORT_SENSOR+1] ={...按顺序加上
        #if defined(XXX_YUV)//
    {XXX_SENSOR_ID, SENSOR_DRVNAME_XXX_YUV, XXX_YUV_SensorInit}, 
#endif


   4) 在mediatek\custom\common\hal\imgsensor\src\Sensorlist.cpp文件的
       数组中MSDK_SENSOR_INIT_FUNCTION_STRUCT SensorList[] ={...按顺序加上(与上面的kdSensorList[]要一一对应上)
#if defined(XXX_YUV)
   YUV_INFO(XXX_SENSOR_ID, SENSOR_DRVNAME_XXX_YUV, NULL), 
#endif
   //若要在SW实现多颗sensor的兼容,在配置kdSensorList和SensorList两个数组时,需要保证其信息一致。即这两个sensor list中sensor index的顺序要一致,
若不一致,则会导致错call到其它sensor的init函数,读错feature table(读了其它sensor的配置),最终产生问题。


2、camera的电源控制(kd_camera_hw.c 与功能机(MT62xx)的camera_hw.c是一样的)
   int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx, char *currSensorName, BOOL On, char* mode_name)
   {
      大部份摄像头都是  拉低工作=GPIO_OUT_ZERO,拉高不工作(powerDown)=GPIO_OUT_ONE
      #define IDX_PS_ON   2   //可以认为,表示工作(V LOW)
      #define IDX_PS_OFF  3   //可以认为,表示不工作(V HIGH)
   }
   各种电压值可调.
    if ((powerId == MT65XX_POWER_LDO_VSIM)
    ||(powerId == MT65XX_POWER_LDO_VSIM2)
    ||(powerId == MT65XX_POWER_LDO_VCAMD)
    ||(powerId == MT65XX_POWER_LDO_VCAM_IO)
    ||(powerId == MT65XX_POWER_LDO_VCAM_AF)
    ||(powerId == MT65XX_POWER_LDO_VMC)
    ||(powerId == MT65XX_POWER_LDO_VMCH)
    ||(powerId == MT65XX_POWER_LDO_VGP)
    ||(powerId == MT65XX_POWER_LDO_VGP2)
    ||(powerId == MT65XX_POWER_LDO_VIBR)
    ||(powerId == MT65XX_POWER_LDO_VA1)
    ||(powerId == MT65XX_POWER_LDO_VA2)
    ||(powerId == MT65XX_POWER_LDO_VCAMA)    




3、摄像头PIN连接
AVDD -- 2.8V
DVDD -- 1.8V 
DOVDD --IO电压 1.8V
对于低像素的(0.3M),基本上使用的都是1.8V,所以一般DVDD和DOVDD是并联1.8V。
对于高像素的(5M),则DVDD会要求要1.3V,则需要单独供电.
所以,DVDD要看是供了什么电压.


   

Pmic_drv.h (mediatek\custom\mt6571_phone_emmc\kernel\dct\dct)

#define PMIC_APP_MEMORY_CARD_VDD         MT6323_POWER_LDO_VMCH
#define PMIC_APP_CAP_TOUCH_VDD         MT6323_POWER_LDO_VGP1
#define PMIC_APP_MAIN_CAMERA_POWER_AF         MT6323_POWER_LDO_VCAM_AF
#define PMIC_APP_MAIN_CAMERA_POWER_D         MT6323_POWER_LDO_VCAMD
#define PMIC_APP_SUB_CAMERA_POWER_D         MT6323_POWER_LDO_VCAMD
#define PMIC_APP_MAIN_CAMERA_POWER_IO         MT6323_POWER_LDO_VCAM_IO
#define PMIC_APP_SUB_CAMERA_POWER_IO         MT6323_POWER_LDO_VCAM_IO
#define PMIC_APP_MAIN_CAMERA_POWER_A         MT6323_POWER_LDO_VCAMA
#define PMIC_APP_SUB_CAMERA_POWER_A         MT6323_POWER_LDO_VCAMA


kd_camera_hw.c (alps\mediatek\custom\mt6571v1_phone_emmc\kernel\camera\camera\kd_camera_hw.c)

#ifdef DEBUG_CAMERA_HW_K
#define PLOG(fmt, arg...)         printk("[CAMERA SENSOR] %s: " fmt, __FUNCTION__ ,##arg)
#else
#define PLOG(a,...)
#endif

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[2][8] = {
                  //for main sensor
                  {GPIO_CAMERA_CMRST_PIN,
                      GPIO_CAMERA_CMRST_PIN_M_GPIO,   /* mode */
                      GPIO_OUT_ONE,                   /* ON state */
                      GPIO_OUT_ZERO,                  /* OFF state */
                   GPIO_CAMERA_CMPDN_PIN,
                      GPIO_CAMERA_CMPDN_PIN_M_GPIO,
                      GPIO_OUT_ONE,
                      GPIO_OUT_ZERO,
                  },
                  //for sub sensor
                  {GPIO_CAMERA_2_CMRST_PIN,
                      GPIO_CAMERA_2_CMRST_PIN_M_GPIO,
                      GPIO_OUT_ONE,
                      GPIO_OUT_ZERO,
                   GPIO_CAMERA_2_CMPDN_PIN,
                      GPIO_CAMERA_2_CMPDN_PIN_M_GPIO,
                      GPIO_OUT_ONE,
                      GPIO_OUT_ZERO,
                  }
                 };

    if (DUAL_CAMERA_MAIN_SENSOR == SensorIdx){
        pinSetIdx = 0;
    }
    else if (DUAL_CAMERA_SUB_SENSOR == SensorIdx) {
        pinSetIdx = 1;
    }

    //power ON
    if (On) {
		//wuchaofei add 2014-03-22
        if (currSensorName && (
		(0 == strcmp(SENSOR_DRVNAME_GC2035_MIPI_YUV,currSensorName))||
		(0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName))||
		(0 == strcmp(SENSOR_DRVNAME_GC0328_YUV,currSensorName))||	   				
			(0 == strcmp(SENSOR_DRVNAME_BF3920_YUV,currSensorName))||
			(0 == strcmp(SENSOR_DRVNAME_BF3703_YUV,currSensorName))))
       {  
      
               if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_IO, VOL_1800, mode_name))
            {
                PLOG("  Fail to enable IO power\n");
                goto _kdCISModulePowerOn_exit_;
            }
            
            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_A, VOL_2800, mode_name))
            {
                PLOG("  Fail to enable analog power\n");
                goto _kdCISModulePowerOn_exit_;
            }
            
            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_D, VOL_1800,mode_name))
            {
                 PLOG("  Fail to enable digital power\n");
                 goto _kdCISModulePowerOn_exit_;
            } 
            
//            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_AF, VOL_2800,mode_name))
//            {
//                PLOG("  Fail to enable AF power\n");
//                goto _kdCISModulePowerOn_exit_;
//            }
			
            //First Power Pin low and Reset Pin Low
            if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
                //PDN pin
                if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMPDN], pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN], GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON])){PLOG("  set gpio failed!! \n");}
             msleep(10);
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");}
             msleep(5);
            
                //Reset pin
                if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST], pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST], GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
                if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST], pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");}
             mdelay(10);
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");}
             mdelay(5);
            }        
            
         	if (GPIO_CAMERA_INVALID != pinSet[1-pinSetIdx][IDX_PS_CMRST]) {
                if(mt_set_gpio_mode(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_mode(pinSet[1-pinSetIdx][IDX_PS_CMPDN],pinSet[1-pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_dir(pinSet[1-pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
                if(mt_set_gpio_dir(pinSet[1-pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
             if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMPDN],pinSet[1-pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //high == power down lens module
             if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //low == reset sensor
                if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");} //low == reset sensor
             mdelay(10);
                if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //high == power down lens module
             mdelay(5);
            }
            // wait power to be stable 
            mdelay(5);
            
            //enable active sensor
            if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST]) {
                //PDN pin
                if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMPDN], pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN], GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
                if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN], pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON])){PLOG("  set gpio failed!! \n");}
            
                //RST pin
                if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST], pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST], GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
                if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST], pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");}
            }
            
            msleep(20);
		  
       }
       else if(currSensorName &&( 
	   	(0 == strcmp(SENSOR_DRVNAME_SP0718_YUV,currSensorName))||
	   	(0 == strcmp(SENSOR_DRVNAME_SP0A19_YUV,currSensorName))||
	   	(0 == strcmp(SENSOR_DRVNAME_SP2519_YUV,currSensorName))||
	   	(0 == strcmp(SENSOR_DRVNAME_SP2529_MIPI_YUV,currSensorName))))
       {  
		   PLOG("    get in SENSOR_DRVNAME_SP0A19_YUV sensorIdx:%d; pinSetIdx=%d, currSensorName=%s\n",SensorIdx, pinSetIdx,currSensorName);
	
		  if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_IO, VOL_1800, mode_name))
            {
                PLOG("  Fail to enable IO power\n");
                goto _kdCISModulePowerOn_exit_;
            }
            
            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_A, VOL_2800, mode_name))
            {
                PLOG("  Fail to enable analog power\n");
                goto _kdCISModulePowerOn_exit_;
            }
	     if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_SP2529_MIPI_YUV,currSensorName)))
	       {
	          if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_D, VOL_1800,mode_name))
	          {
	             PLOG("  Fail to enable digital power\n");
	             //return -EIO;
	             goto _kdCISModulePowerOn_exit_;
	          }
	      }
	   else
            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_D, VOL_1500,mode_name))
            {
                 PLOG("  Fail to enable digital power\n");
                 goto _kdCISModulePowerOn_exit_;
            } 
            
//            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_AF, VOL_2800,mode_name))
//            {
//                PLOG("  Fail to enable AF power\n");
//                goto _kdCISModulePowerOn_exit_;
//            }

          //PDN/STBY pin
          if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
          {
             if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
             if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
			if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");}
             msleep(10);

             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON])){PLOG("  set gpio failed!! \n");}
             msleep(10);
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");}
             msleep(5);
       
                //Reset pin
                if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST], pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST], GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
                if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST], pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");}
             mdelay(10);
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");}
             mdelay(5);
          }
		  
         	if (GPIO_CAMERA_INVALID != pinSet[1-pinSetIdx][IDX_PS_CMRST]) {
                if(mt_set_gpio_mode(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_mode(pinSet[1-pinSetIdx][IDX_PS_CMPDN],pinSet[1-pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_dir(pinSet[1-pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
                if(mt_set_gpio_dir(pinSet[1-pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
             if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMPDN],pinSet[1-pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //high == power down lens module
             if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //low == reset sensor
                if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");} //low == reset sensor
             mdelay(10);
                if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //high == power down lens module
             mdelay(5);
          }          
       } 
	   else if (currSensorName && (
	   	(0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName))||
	   	(0 == strcmp(SENSOR_DRVNAME_GC0308_YUV,currSensorName))))
       {  
		   PLOG("get in-GC032x_YUV sensorIdx:%d; pinSetIdx=%d, currSensorName=%s\n",SensorIdx, pinSetIdx,currSensorName);
       
          		  if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_IO, VOL_1800, mode_name))
            {
                PLOG("  Fail to enable IO power\n");
                goto _kdCISModulePowerOn_exit_;
            }
            
            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_A, VOL_2800, mode_name))
            {
                PLOG("  Fail to enable analog power\n");
                goto _kdCISModulePowerOn_exit_;
            }

            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_D, VOL_1800,mode_name))
            {
                 PLOG("  Fail to enable digital power\n");
                 goto _kdCISModulePowerOn_exit_;
            } 
            
//            if(TRUE != hwPowerOn(PMIC_APP_MAIN_CAMERA_POWER_AF, VOL_2800,mode_name))
//            {
//                PLOG("  Fail to enable AF power\n");
//                goto _kdCISModulePowerOn_exit_;
//            }
          //PDN/STBY pin
          if (GPIO_CAMERA_INVALID != pinSet[pinSetIdx][IDX_PS_CMRST])
          {
             if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
             if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON])){PLOG("  set gpio failed!! \n");}
             msleep(10);
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");}
             msleep(5);
       
             //RST pin
             if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
             if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");}
             mdelay(10);
             if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");}
             mdelay(5);
          }

	  if (GPIO_CAMERA_INVALID != pinSet[1-pinSetIdx][IDX_PS_CMRST]) {
                if(mt_set_gpio_mode(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_mode(pinSet[1-pinSetIdx][IDX_PS_CMPDN],pinSet[1-pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
                if(mt_set_gpio_dir(pinSet[1-pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
                if(mt_set_gpio_dir(pinSet[1-pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
             if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMPDN],pinSet[1-pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //low == power down lens module				            
             if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //low == reset sensor
                if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");} //low == reset sensor
             mdelay(10);
                if(mt_set_gpio_out(pinSet[1-pinSetIdx][IDX_PS_CMRST],pinSet[1-pinSetIdx][IDX_PS_CMRST+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //high == power down lens module
             mdelay(5);
          }       
       }
       else{
	   	PLOG("No found Camera!!!! \n");
       }
    
    }
    else {//power OFF
       
        PLOG("-off:currSensorName=%s,pinSetIdx=%d\n", currSensorName,pinSetIdx);
              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])){PLOG("  set gpio mode failed!! \n");}
           if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMRST],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}
           if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMRST],pinSet[pinSetIdx][IDX_PS_CMRST+IDX_PS_OFF])){PLOG("  set gpio failed!! \n");} //low == reset sensor
       
           if(mt_set_gpio_mode(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_MODE])){PLOG("  set gpio mode failed!! \n");}
           if(mt_set_gpio_dir(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_DIR_OUT)){PLOG("  set gpio dir failed!! \n");}

		if (currSensorName && (
			(0 == strcmp(SENSOR_DRVNAME_SP0A19_YUV,currSensorName))||
			(0 == strcmp(SENSOR_DRVNAME_SP0718_YUV,currSensorName))||
			(0 == strcmp(SENSOR_DRVNAME_SP2519_YUV,currSensorName))||
			(0 == strcmp(SENSOR_DRVNAME_SP2529_MIPI_YUV,currSensorName)))){
	        	if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],GPIO_OUT_ONE)){PLOG("  set gpio failed!! \n");} //high == power down lens module
			else        	
				if(mt_set_gpio_out(pinSet[pinSetIdx][IDX_PS_CMPDN],pinSet[pinSetIdx][IDX_PS_CMPDN+IDX_PS_ON])){PLOG("  set gpio failed!! \n");} //high == power down lens module
			}
		
       }
			   
//		if(TRUE != hwPowerDown(PMIC_APP_MAIN_CAMERA_POWER_AF,mode_name))
//            {
//                PLOG("  Fail to OFF AF power\n");
//                goto _kdCISModulePowerOn_exit_;
//            }
		
			if(TRUE != hwPowerDown(PMIC_APP_MAIN_CAMERA_POWER_IO,mode_name))
            {
                PLOG("Fail to OFF IO power\n");
                goto _kdCISModulePowerOn_exit_;
            }
	
			if(TRUE != hwPowerDown(PMIC_APP_MAIN_CAMERA_POWER_A,mode_name)) 
			{
                PLOG("Fail to OFF analog power\n");
                goto _kdCISModulePowerOn_exit_;
            }

		if(TRUE != hwPowerDown(PMIC_APP_MAIN_CAMERA_POWER_D, mode_name)) 
			{
                PLOG("Fail to OFF digital power\n");
                goto _kdCISModulePowerOn_exit_;
            }
			
		
  }

  return 0;
  
_kdCISModulePowerOn_exit_:
    return -EIO;
}





本案使用后摄像头:SP2529 MIPI接口摄像头,前摄像头GC0309 串口方式前摄像头识别到id, 但就是preview时没有图像,是codegen.dws没有按D0~D7,clock也要配置才行。


  • 0
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值