MTK Camera 开机启动流程（转载）

一、MTK平台Camera框架

         MTK平台的Camera的架构见下图，

     这里主要介绍kernel部分和HAL层部分。

    1、Kernel 部分主要有两块:

           1.1、image sensordriver,负责具体型号的 sensor 的 id 检测,上电，以及在preview、capture、初始化、3A等等功能设定时的寄存器配置。

           1.2、isp driver，通过DMA将sensor数据流上传。

        2、HAL层部分主要有三部分组成：

           2.1、imageio，主要负责数据buffer上传的pipe。

          2.2、drv，包含imgsensor和isp的hal层控制。

          2.3、feature io，包含各种3A等性能配置。

                  

二、Camera打开流程分析

         Camera开启流程图如下：

        主要发生在两个时间点：

    1、开机时：camera完成了sensor框架初始化，id检测并匹配sensor，以及上下电操作。

    2、打开Camera应用时：camera会有上电，完成sensor的寄存器初始化配置，向上层传递基本参数和配置信息，以及preview和capture模式循环。

      

1、开机初始化过程

         由于一开始不知道上电camera初始化从哪开始，我们可以借助抓取的mtk mobile log去分析。先看hal层log开始处：

[plain] view plaincopy
 
  1. 12-24 10:02:07.601   148   148 D MtkCam/module: [instantiate_camera_module]  
  2. 12-24 10:02:07.601   148   148 D MtkCam/Utils/Property: [clear] pid/tid=148/148  
  3. 12-24 10:02:07.601   148   148 I CameraService: Loaded "MediaTek Camera Module" camera module  
  4. 12-24 10:02:07.601   148   148 D MtkCam/MtkCamUtils: [CamDevMetaInfoMap::clear] pid/tid=148/148  
  5. 12-24 10:02:07.601   148   148 D SensorHal: [getInstance][SensorHalImp] getInstance  
  6. 12-24 10:02:07.601   148   148 D SensorHal: [createImp][createImp]: 0  
  7. 12-24 10:02:07.601   148   148 D SeninfDrvImp: [getInstance][getInstance]  
  8. 12-24 10:02:07.601   148   148 D SeninfDrvImp: [SeninfDrvImp][SeninfDrvImp]  
  9. 12-24 10:02:07.601   148   148 D SeninfDrvImp: [init][init]: 0  

        通过sourceinsight搜索发现开始是从CamDeviceManagerImp.cpp函数的enumDeviceLocked()开始。该函数的源代码如下：

===>mediatek/platform/mt6582/hardware/mtkcam/devicemgr/CamDeviceManagerImp.cpp

[cpp] view plaincopy
 
  1. /****************************************************************************** 
  2.  * 
  3.  ******************************************************************************/  
  4. int32_t  
  5. CamDeviceManagerImp::  
  6. enumDeviceLocked()  
  7. {  
  8.     Utils::CamProfile _profile(__FUNCTION__, "CamDeviceManagerImp");  
  9.     //  
  10.     status_t status = OK;  
  11.     int32_t i4DeviceNum = 0;  
  12.     //  
  13.     mEnumMap.clear();  
  14. //------------------------------------------------------------------------------  
  15. #if '1'==MTKCAM_HAVE_SENSOR_HAL  
  16.   
  17.     mEnumMap.clear();  
  18.     DevMetaInfo::clear();  
  19.     //  
  20.     int32_t isFakeOrientation = 0;  
  21.     int32_t i4DevSetupOrientation = 0;  
  22.     camera_info camInfo;  
  23.     camInfo.device_version = CAMERA_DEVICE_API_VERSION_1_0;  
  24.     camInfo.static_camera_characteristics = NULL;  
  25.     //  
  26.     SensorHal* pSensorHal = SensorHal::createInstance();//创建sensor对象  
  27.     if  ( ! pSensorHal )  
  28.     {  
  29.         MY_LOGE("pSensorHal == NULL");  
  30.         return 0;  
  31.     }  
  32.     //  
  33.     int32_t const iSensorsList = pSensorHal->searchSensor();//此函数是入口，主要查找匹配的硬件sensor  
  34.     //  
  35.     //  
  36.     if  ( (iSensorsList & SENSOR_DEV_MAIN_3D) == SENSOR_DEV_MAIN_3D )  
  37.     {  
  38.         MY_LOGI("Stereo 3D Camera found");  
  39. #warning "[TODO] Stereo 3D Camera"  
  40.     }  
  41.     //  
  42.     if  ( (iSensorsList & SENSOR_DEV_MAIN) == SENSOR_DEV_MAIN )  
  43.     {  
  44.         int32_t const deviceId = i4DeviceNum;  
  45.         //  
  46.         halSensorDev_e const eHalSensorDev = SENSOR_DEV_MAIN;  
  47.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_FAKE_ORIENTATION, (int)&isFakeOrientation);  
  48.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_ORIENTATION_ANGLE, (int)&i4DevSetupOrientation);  
  49.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_FACING_DIRECTION, (int)&camInfo.facing);  
  50.         camInfo.orientation = i4DevSetupOrientation;  
  51.         if  ( isFakeOrientation )  
  52.         {  
  53.             camInfo.orientation = (0==camInfo.facing) ? 90 : 270;  
  54.             MY_LOGW("Fake orientation:%d instead of %d, facing=%d HalSensorDev=%#x", camInfo.orientation, i4DevSetupOrientation, camInfo.facing, eHalSensorDev);  
  55.         }  
  56.         DevMetaInfo::add(deviceId, camInfo, i4DevSetupOrientation, eDevId_ImgSensor, eHalSensorDev);  
  57.         //  
  58.         sp<EnumInfo> pInfo = new EnumInfo;  
  59.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  60.         pInfo->pMetadata            = NULL;  
  61.         pInfo->iFacing              = camInfo.facing;  
  62.         pInfo->iWantedOrientation   = camInfo.orientation;  
  63.         pInfo->iSetupOrientation    = i4DevSetupOrientation;  
  64.         mEnumMap.add(deviceId, pInfo);  
  65.         //  
  66.         i4DeviceNum++;  
  67.     }  
  68.     //  
  69.     if  ( (iSensorsList & SENSOR_DEV_SUB) == SENSOR_DEV_SUB )  
  70.     {  
  71.         int32_t const deviceId = i4DeviceNum;  
  72.         //  
  73.         halSensorDev_e const eHalSensorDev = SENSOR_DEV_SUB;  
  74.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_FAKE_ORIENTATION, (int)&isFakeOrientation);  
  75.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_ORIENTATION_ANGLE, (int)&i4DevSetupOrientation);  
  76.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_FACING_DIRECTION, (int)&camInfo.facing);  
  77.         camInfo.orientation = i4DevSetupOrientation;  
  78.         if  ( isFakeOrientation )  
  79.         {  
  80.             camInfo.orientation = (0==camInfo.facing) ? 90 : 270;  
  81.             MY_LOGW("Fake orientation:%d instead of %d, facing=%d HalSensorDev=%#x", camInfo.orientation, i4DevSetupOrientation, camInfo.facing, eHalSensorDev);  
  82.         }  
  83.         DevMetaInfo::add(deviceId, camInfo, i4DevSetupOrientation, eDevId_ImgSensor, eHalSensorDev);  
  84.         //  
  85.         sp<EnumInfo> pInfo = new EnumInfo;  
  86.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  87.         pInfo->pMetadata            = NULL;  
  88.         pInfo->iFacing              = camInfo.facing;  
  89.         pInfo->iWantedOrientation   = camInfo.orientation;  
  90.         pInfo->iSetupOrientation    = i4DevSetupOrientation;  
  91.         mEnumMap.add(deviceId, pInfo);  
  92.         //  
  93.         i4DeviceNum++;  
  94.     }  
  95.     //  
  96. //    if  ( (iSensorsList & SENSOR_DEV_ATV) == SENSOR_DEV_ATV )  
  97.     {  
  98.         int32_t const deviceId = 0xFF;  
  99.         //  
  100.         halSensorDev_e const eHalSensorDev = SENSOR_DEV_ATV;  
  101.         camInfo.facing = 0;  
  102.         camInfo.orientation = 0;  
  103.         DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_AtvSensor, eHalSensorDev);  
  104.         //  
  105.         sp<EnumInfo> pInfo = new EnumInfo;  
  106.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  107.         pInfo->pMetadata            = NULL;  
  108.         pInfo->iFacing              = camInfo.facing;  
  109.         pInfo->iWantedOrientation   = camInfo.orientation;  
  110.         pInfo->iSetupOrientation    = i4DevSetupOrientation;  
  111.         mEnumMap.add(deviceId, pInfo);  
  112.         //  
  113. //        i4DeviceNum++;  
  114.     }  
  115.     //  
  116.     //  
  117.     if  ( pSensorHal )  
  118.     {  
  119.         pSensorHal->destroyInstance();  
  120.         pSensorHal = NULL;  
  121.     }  
  122.     //  
  123.     MY_LOGI("iSensorsList=0x%08X, i4DeviceNum=%d", iSensorsList, i4DeviceNum);  
  124.     for (size_t i = 0; i < mEnumMap.size(); i++)  
  125.     {  
  126.         int32_t const deviceId = mEnumMap.keyAt(i);  
  127.         sp<EnumInfo> pInfo = mEnumMap.valueAt(i);  
  128.         uint32_t const uDeviceVersion   = pInfo->uDeviceVersion;  
  129.         camera_metadata const*pMetadata = pInfo->pMetadata;  
  130.         int32_t const iFacing           = pInfo->iFacing;  
  131.         int32_t const iWantedOrientation= pInfo->iWantedOrientation;  
  132.         int32_t const iSetupOrientation = pInfo->iSetupOrientation;  
  133.         MY_LOGI(  
  134.             "[0x%02x] orientation(wanted/setup)=(%d/%d) facing:%d metadata:%p DeviceVersion:0x%x",   
  135.             deviceId, iWantedOrientation, iSetupOrientation,   
  136.             iFacing, pMetadata, uDeviceVersion  
  137.         );  
  138.     }  
  139.   
  140. #else   //----------------------------------------------------------------------  
  141.   
  142.     #warning "[WARN] Simulation for CamDeviceManagerImp::enumDeviceLocked()"  
  143.   
  144.     mEnumMap.clear();  
  145.     DevMetaInfo::clear();  
  146.     {  
  147.         int32_t const deviceId = 0;  
  148.         //  
  149.         camera_info camInfo;  
  150.         camInfo.device_version  = CAMERA_DEVICE_API_VERSION_1_0;  
  151.         camInfo.static_camera_characteristics = NULL;  
  152.         camInfo.facing      = 0;  
  153.         camInfo.orientation = 90;  
  154.         DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_ImgSensor, 0x01/*SENSOR_DEV_MAIN*/);  
  155.         //  
  156.         sp<EnumInfo> pInfo = new EnumInfo;  
  157.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  158.         pInfo->pMetadata            = NULL;  
  159.         pInfo->iFacing              = 0;  
  160.         pInfo->iWantedOrientation   = 90;  
  161.         pInfo->iSetupOrientation    = 90;  
  162.         mEnumMap.add(deviceId, pInfo);  
  163.     }  
  164.     //  
  165.     {  
  166.         int32_t const deviceId = 0xFF;  
  167.         //  
  168.         camera_info camInfo;  
  169.         camInfo.device_version  = CAMERA_DEVICE_API_VERSION_1_0;  
  170.         camInfo.static_camera_characteristics = NULL;  
  171.         camInfo.facing      = 0;  
  172.         camInfo.orientation = 0;  
  173.         DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_AtvSensor, 0x04/*SENSOR_DEV_ATV*/);  
  174.         //  
  175.         sp<EnumInfo> pInfo = new EnumInfo;  
  176.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  177.         pInfo->pMetadata            = NULL;  
  178.         pInfo->iFacing              = 0;  
  179.         pInfo->iWantedOrientation   = 0;  
  180.         pInfo->iSetupOrientation    = 0;  
  181.         mEnumMap.add(deviceId, pInfo);  
  182.     }  
  183.     //  
  184.     i4DeviceNum = 1;  
  185.   
  186. #endif  
  187. //------------------------------------------------------------------------------  
  188.     //  
  189.     _profile.print("");  
  190.     return  i4DeviceNum;  
  191. }  

       

      函数pSensorHal->searchSensor()将调用SensorDrv::searchSensor(NULL)函数，该函数再调用ImgSensor_drv.cpp文件中中的ImgSensorDrv::impSearchSensor函数。

===>mediatek/platform/mt6582/hardware/mtkcam/core/drv/imgsensor/ImgSensor_drv.cpp

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * 
  3. ********************************************************************************/  
  4.   
  5. MINT32   
  6. ImgSensorDrv::impSearchSensor(pfExIdChk pExIdChkCbf)  
  7. {  
  8.     MUINT32 SensorEnum = (MUINT32) DUAL_CAMERA_MAIN_SENSOR;  
  9.     MUINT32 i,id[KDIMGSENSOR_MAX_INVOKE_DRIVERS] = {0,0};  
  10.     MBOOL SensorConnect=TRUE;  
  11.     UCHAR cBuf[64];  
  12.     MINT32 err = SENSOR_NO_ERROR;  
  13.     MINT32 err2 = SENSOR_NO_ERROR;  
  14.     ACDK_SENSOR_INFO_STRUCT SensorInfo;  
  15.     ACDK_SENSOR_CONFIG_STRUCT SensorConfigData;  
  16.     ACDK_SENSOR_RESOLUTION_INFO_STRUCT SensorResolution;  
  17.     MINT32 sensorDevs = SENSOR_NONE;  
  18.     IMAGE_SENSOR_TYPE sensorType = IMAGE_SENSOR_TYPE_UNKNOWN;  
  19.     IMGSENSOR_SOCKET_POSITION_ENUM socketPos = IMGSENSOR_SOCKET_POS_NONE;  
  20.   
  21.   
  22.     //! If imp sensor search process already done before,   
  23.     //! only need to return the sensorDevs, not need to   
  24.     //! search again.   
  25.     if (SENSOR_DOES_NOT_EXIST != m_mainSensorId) {  
  26.         //been processed.  
  27.         LOG_MSG("[impSearchSensor] Already processed  ");   
  28.         if (BAD_SENSOR_INDEX != m_mainSensorIdx) {  
  29.             sensorDevs |= SENSOR_MAIN;  
  30.         }  
  31.   
  32.         if (BAD_SENSOR_INDEX != m_subSensorIdx) {  
  33.             sensorDevs |= SENSOR_SUB;  
  34.         }  
  35.   
  36.         #ifdef  ATVCHIP_MTK_ENABLE  
  37.   
  38.             sensorDevs |= SENSOR_ATV;  
  39.   
  40.         #endif  
  41.   
  42.   
  43.         return sensorDevs;   
  44.     }  
  45.       
  46.     GetSensorInitFuncList(&m_pstSensorInitFunc);//----(1)获取hal层的sensor列表  
  47.   
  48.     LOG_MSG("SENSOR search start  ");  
  49.   
  50.     if (-1 != m_fdSensor) {  
  51.         ::close(m_fdSensor);  
  52.         m_fdSensor = -1;  
  53.     }  
  54.     sprintf(cBuf,"/dev/%s",CAMERA_HW_DEVNAME);  
  55.     m_fdSensor = ::open(cBuf, O_RDWR);  
  56.     if (m_fdSensor < 0) {  
  57.          LOG_ERR("[impSearchSensor]: error opening %s: %s  ", cBuf, strerror(errno));   
  58.         return sensorDevs;  
  59.     }  
  60.     LOG_MSG("[impSearchSensor] m_fdSensor = %d   ", m_fdSensor);  
  61.   
  62.     // search main/main_2/sub 3 sockets  
  63.    #ifdef MTK_SUB_IMGSENSOR   
  64.     for (SensorEnum = DUAL_CAMERA_MAIN_SENSOR; SensorEnum <= DUAL_CAMERA_SUB_SENSOR; SensorEnum <<= 1)  {  
  65.         LOG_MSG("impSearchSensor search to sub ");  
  66.    #else  
  67.     for (SensorEnum = DUAL_CAMERA_MAIN_SENSOR; SensorEnum < DUAL_CAMERA_SUB_SENSOR; SensorEnum <<= 1)  {  
  68.         LOG_MSG("impSearchSensor search to main ");     
  69.    #endif       
  70.         //skip atv case  
  71.         if ( 0x04 == SensorEnum ) continue;  
  72.         //  
  73.         for (i = 0; i < MAX_NUM_OF_SUPPORT_SENSOR; i++) {  
  74.             //end of driver list  
  75.             if (m_pstSensorInitFunc[i].getCameraDefault == NULL) {  
  76.                 LOG_MSG("m_pstSensorInitFunc[i].getCameraDefault is NULL: %d  ", i);                  
  77.                 break;  
  78.             }  
  79.                 //set sensor driver  
  80.             id[KDIMGSENSOR_INVOKE_DRIVER_0] = (SensorEnum << KDIMGSENSOR_DUAL_SHIFT) | i;  
  81.             LOG_MSG("set sensor driver id =%x ", id[KDIMGSENSOR_INVOKE_DRIVER_0]);   
  82.             err = ioctl(m_fdSensor, KDIMGSENSORIOC_X_SET_DRIVER,&id[KDIMGSENSOR_INVOKE_DRIVER_0] );//--(2)调用kernel层的kdSetDriver函数  
  83.                 if (err < 0) {  
  84.                     LOG_ERR("ERROR:KDCAMERAHWIOC_X_SET_DRIVER ");  
  85.                 }  
  86.   
  87.              
  88.   
  89.                 //err = open();  
  90.                 err = ioctl(m_fdSensor, KDIMGSENSORIOC_T_CHECK_IS_ALIVE);//---(3)上下电camera并读取sensor的ID，如果匹配则成功  
  91.                   
  92.   
  93.                   
  94.                 if (err < 0) {  
  95.                     LOG_MSG("[impSearchSensor] Err-ctrlCode (%s)  ", strerror(errno));//  
  96.                 }  
  97.             //  
  98.             sensorType = this->getCurrentSensorType((SENSOR_DEV_ENUM)SensorEnum);  
  99.             //  
  100.             socketPos = this->getSocketPosition((CAMERA_DUAL_CAMERA_SENSOR_ENUM)SensorEnum);  
  101.                 //check extra ID , from EEPROM maybe  
  102.                 //may need to keep power here  
  103.                 if (NULL != pExIdChkCbf) {  
  104.                     err2 = pExIdChkCbf();  
  105.                     if (err2 < 0) {  
  106.                         LOG_ERR("Error:pExIdChkCbf()  ");  
  107.                     }  
  108.                 }  
  109.   
  110.                 //power off sensor  
  111.                 close();  
  112.   
  113.                 if (err < 0 || err2 < 0) {  
  114.                     LOG_MSG("sensor ID mismatch ");  
  115.                 }  
  116.                 else {  
  117.                     if (SensorEnum == DUAL_CAMERA_MAIN_SENSOR) {  
  118.                 //m_mainSensorIdx = i;  
  119.                 //m_mainSensorId = m_pstSensorInitFunc[m_mainSensorIdx].SensorId;  
  120.                 m_mainSensorDrv.index[m_mainSensorDrv.number] = i;  
  121.                 m_mainSensorDrv.type[m_mainSensorDrv.number] = sensorType;  
  122.                 if ( IMAGE_SENSOR_TYPE_RAW == sensorType && BAD_SENSOR_INDEX == m_mainSensorDrv.firstRawIndex ) {  
  123.                     m_mainSensorDrv.firstRawIndex = i;  
  124.                 }  
  125.                 else if ( IMAGE_SENSOR_TYPE_YUV == sensorType && BAD_SENSOR_INDEX == m_mainSensorDrv.firstYuvIndex ) {  
  126.                     m_mainSensorDrv.firstYuvIndex = i;  
  127.                 }  
  128.                 m_mainSensorDrv.position = socketPos;  
  129.                 m_mainSensorDrv.sensorID = m_pstSensorInitFunc[m_mainSensorDrv.index[m_mainSensorDrv.number]].SensorId;  
  130.                 // LOG_MSG("MAIN sensor m_mainSensorDrv.number=%d, m_mainSensorDrv.index=%d ",m_mainSensorDrv.number,m_mainSensorDrv.index[m_mainSensorDrv.number]);  
  131.                 m_mainSensorDrv.number++;  
  132.                 //  
  133.                 m_pMainSensorInfo = m_pstSensorInitFunc[i].pSensorInfo;  
  134.                 if  ( m_pMainSensorInfo )  
  135.                 {  
  136.                     NSFeature::SensorInfoBase* pSensorInfo = m_pstSensorInitFunc[i].pSensorInfo;  
  137.                     LOG_MSG("found <%#x/%s/%s>", pSensorInfo->GetID(), pSensorInfo->getDrvName(), pSensorInfo->getDrvMacroName());  
  138.                 }  
  139.                 else  
  140.                 {  
  141.                     LOG_WRN("m_pMainSensorInfo==NULL ");  
  142.                 }  
  143.                 LOG_MSG("MAIN sensor found:[%d]/[0x%x]/[%d]/[%d]  ",i,id[KDIMGSENSOR_INVOKE_DRIVER_0],sensorType,socketPos);  
  144.                 //break;  
  145.             }  
  146.             else if (SensorEnum == DUAL_CAMERA_SUB_SENSOR) {  
  147.                 //m_subSensorIdx = i;  
  148.                 //m_subSensorId = m_pstSensorInitFunc[m_subSensorIdx].SensorId;  
  149.                 m_subSensorDrv.index[m_subSensorDrv.number] = i;  
  150.                 m_subSensorDrv.type[m_subSensorDrv.number] = sensorType;  
  151.                 if ( IMAGE_SENSOR_TYPE_RAW == sensorType && BAD_SENSOR_INDEX == m_subSensorDrv.firstRawIndex ) {  
  152.                     m_subSensorDrv.firstRawIndex = i;  
  153.                 }  
  154.                 else if ( IMAGE_SENSOR_TYPE_YUV == sensorType && BAD_SENSOR_INDEX == m_subSensorDrv.firstYuvIndex ) {  
  155.                     m_subSensorDrv.firstYuvIndex = i;  
  156.                 }  
  157.                 m_subSensorDrv.position = socketPos;  
  158.                 m_subSensorDrv.sensorID = m_pstSensorInitFunc[m_subSensorDrv.index[m_subSensorDrv.number]].SensorId;  
  159.                 //LOG_MSG("SUB sensor m_subSensorDrv.number=%d, m_subSensorDrv.index=%d ",m_subSensorDrv.number,m_subSensorDrv.index[m_subSensorDrv.number]);  
  160.                 m_subSensorDrv.number++;  
  161.                 //  
  162.                 m_pSubSensorInfo = m_pstSensorInitFunc[i].pSensorInfo;  
  163.                 if  ( m_pSubSensorInfo )  
  164.                 {  
  165.                     NSFeature::SensorInfoBase* pSensorInfo = m_pstSensorInitFunc[i].pSensorInfo;  
  166.                     LOG_MSG("found <%#x/%s/%s>", pSensorInfo->GetID(), pSensorInfo->getDrvName(), pSensorInfo->getDrvMacroName());  
  167.                 }  
  168.                 else  
  169.                 {  
  170.                     LOG_WRN("m_pSubSensorInfo==NULL ");  
  171.                 }  
  172.                 LOG_MSG("SUB sensor found:[%d]/[0x%x]/[%d]/[%d]  ",i,id[KDIMGSENSOR_INVOKE_DRIVER_0],sensorType,socketPos);  
  173.                 //break;  
  174.             }  
  175.         }//  
  176.           
  177.         }  
  178.     }  
  179.     //close system call may be off sensor power. check first!!!  
  180.     ::close(m_fdSensor);  
  181.     m_fdSensor = -1;  
  182.     //  
  183.     if (BAD_SENSOR_INDEX != m_mainSensorDrv.index[0]) {  
  184.         m_mainSensorId = m_mainSensorDrv.sensorID;  
  185.         //init to choose first  
  186.         m_mainSensorIdx = m_mainSensorDrv.index[0];  
  187.         sensorDevs |= SENSOR_MAIN;  
  188.     }  
  189.   
  190.     if (BAD_SENSOR_INDEX != m_subSensorDrv.index[0]) {  
  191.         m_subSensorId = m_subSensorDrv.sensorID;  
  192.         //init to choose first  
  193.         m_subSensorIdx = m_subSensorDrv.index[0];  
  194.         sensorDevs |= SENSOR_SUB;  
  195.     }  
  196.   
  197.     #ifdef  ATVCHIP_MTK_ENABLE  
  198.       
  199.         sensorDevs |= SENSOR_ATV;  
  200.       
  201.     #endif  
  202.   
  203.   
  204.     if (sensorDevs == SENSOR_NONE) {  
  205.         LOG_ERR( "Error No sensor found!!  ");  
  206.     }  
  207.     //  
  208.     LOG_MSG("SENSOR search end: 0x%x /[0x%x][%d]/[0x%x][%d] ", sensorDevs,  
  209.     m_mainSensorId,m_mainSensorIdx,m_subSensorId,m_subSensorIdx);  
  210.   
  211.     return sensorDevs;  
  212. }//  

(1)、获取hal层sensor列表GetSensorInitFuncList(&m_pstSensorInitFunc);

===>mediatek/custom/common/hal/imgsensor/src/sensorlist.cpp

[cpp] view plaincopy
 
  1. UINT32 GetSensorInitFuncList(MSDK_SENSOR_INIT_FUNCTION_STRUCT **ppSensorList)  
  2. {  
  3.     if (NULL == ppSensorList) {  
  4.         ALOGE("ERROR: NULL pSensorList ");  
  5.         return MHAL_UNKNOWN_ERROR;  
  6.     }  
  7.     *ppSensorList = &SensorList[0];//这里直接调用hal层的sensor列表  
  8.     return MHAL_NO_ERROR;  
  9. } // GetSensorInitFuncList()  

===>mediatek/custom/common/hal/imgsensor/src/sensorlist.cpp

[cpp] view plaincopy
 
  1. MSDK_SENSOR_INIT_FUNCTION_STRUCT SensorList[] =  
  2. {  
  3.     //add by zym  
  4. #if defined(GC2235_MIPI_RAW)  
  5.     RAW_INFO(GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, NULL),   
  6. #endif  
  7. // add by zhouzuoyu  
  8. #if defined(GC2235_KOTECH_MIPI_RAW)  
  9.     RAW_INFO(GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, NULL),   
  10. #endif  
  11. #if defined(OV16825_MIPI_RAW)  
  12.     RAW_INFO(OV16825MIPI_SENSOR_ID, SENSOR_DRVNAME_OV16825_MIPI_RAW,NULL),   
  13. #endif  
  14. #if defined(IMX135_MIPI_RAW)  
  15.         RAW_INFO(IMX135_SENSOR_ID, SENSOR_DRVNAME_IMX135_MIPI_RAW,NULL),   
  16. #endif  
  17. #if defined(OV8830_RAW)  
  18.     RAW_INFO(OV8830_SENSOR_ID, SENSOR_DRVNAME_OV8830_RAW, NULL),  
  19. #endif  
  20.   
  21. /*  ADD sensor driver before this line */  
  22.     {0,{0},NULL, NULL, NULL}//end of list  
  23. };   

(2)、获取kernel层的kdSetDriver函数err = ioctl(m_fdSensor, KDIMGSENSORIOC_X_SET_DRIVER,&id[KDIMGSENSOR_INVOKE_DRIVER_0] );

===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.c

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * kdSetDriver 
  3. ********************************************************************************/  
  4. int kdSetDriver(unsigned int* pDrvIndex)  
  5. {  
  6.     ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT *pSensorList = NULL;  
  7.     u32 drvIdx[KDIMGSENSOR_MAX_INVOKE_DRIVERS] = {0,0};  
  8.     u32 i;  
  9.   
  10.     PK_XLOG_INFO("pDrvIndex:0x%08x/0x%08x  ",pDrvIndex[KDIMGSENSOR_INVOKE_DRIVER_0],pDrvIndex[KDIMGSENSOR_INVOKE_DRIVER_1]);  
  11.     //set driver for MAIN or SUB sensor  
  12.   
  13.     if (0 != kdGetSensorInitFuncList(&pSensorList))//----（2.1）获取kernel层的sensor列表  
  14.     {  
  15.         PK_ERR("ERROR:kdGetSensorInitFuncList() ");  
  16.         return -EIO;  
  17.     }  
  18.   
  19.     for ( i = KDIMGSENSOR_INVOKE_DRIVER_0; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {  
  20.         //  
  21.         spin_lock(&kdsensor_drv_lock);  
  22.         g_bEnableDriver[i] = FALSE;  
  23.         g_invokeSocketIdx[i] = (CAMERA_DUAL_CAMERA_SENSOR_ENUM)((pDrvIndex[i] & KDIMGSENSOR_DUAL_MASK_MSB)>>KDIMGSENSOR_DUAL_SHIFT);  
  24.     spin_unlock(&kdsensor_drv_lock);  
  25.   
  26.         drvIdx[i] = (pDrvIndex[i] & KDIMGSENSOR_DUAL_MASK_LSB);//----（2.2）g_invokeSocketIdx，drvIdx解释  
  27.         //  
  28.         if ( DUAL_CAMERA_NONE_SENSOR == g_invokeSocketIdx[i] ) { continue; }  
  29.   
  30.   
  31.         //ToDo: remove print information  
  32.         PK_XLOG_INFO("[kdSetDriver] i,g_invokeSocketIdx[%d] = %d : ",i,i,drvIdx[i]);  
  33.         PK_XLOG_INFO("[kdSetDriver] i,drvIdx[%d] = %d : ",i,i,drvIdx[i]);  
  34.         //  
  35.         if ( MAX_NUM_OF_SUPPORT_SENSOR > drvIdx[i] ) {  
  36.             if (NULL == pSensorList[drvIdx[i]].SensorInit) {  
  37.                 PK_ERR("ERROR:kdSetDriver() ");  
  38.                 return -EIO;  
  39.             }  
  40.   
  41.             pSensorList[drvIdx[i]].SensorInit(&g_pInvokeSensorFunc[i]);//----（2.3）获取指定sensor的fun函数，例如ov5670的func  
  42.             if (NULL == g_pInvokeSensorFunc[i]) {  
  43.                 PK_ERR("ERROR:NULL g_pSensorFunc[%d] ",i);  
  44.             return -EIO;  
  45.             }  
  46.             //  
  47.             spin_lock(&kdsensor_drv_lock);  
  48.             g_bEnableDriver[i] = TRUE;  
  49.             spin_unlock(&kdsensor_drv_lock);  
  50.             //get sensor name  
  51.             memcpy((char*)g_invokeSensorNameStr[i],(char*)pSensorList[drvIdx[i]].drvname,sizeof(pSensorList[drvIdx[i]].drvname));  
  52.             //return sensor ID  
  53.             //pDrvIndex[0] = (unsigned int)pSensorList[drvIdx].SensorId;  
  54.             PK_XLOG_INFO("[kdSetDriver] :[%d][%d][%d][%s][%d] ",i,g_bEnableDriver[i],g_invokeSocketIdx[i],g_invokeSensorNameStr[i],sizeof(pSensorList[drvIdx[i]].drvname));  
  55.         }  
  56.     }  
  57.     return 0;  
  58. }  

（2.1）获取kernel层的sensor列表kdGetSensorInitFuncList(&pSensorList)

===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.c

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * general camera image sensor kernel driver 
  3. *******************************************************************************/  
  4. UINT32 kdGetSensorInitFuncList(ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT **ppSensorList)  
  5. {  
  6.     if (NULL == ppSensorList)  
  7.     {  
  8.         PK_DBG("[kdGetSensorInitFuncList]ERROR: NULL ppSensorList ");  
  9.         return 1;  
  10.     }  
  11.     *ppSensorList = &kdSensorList[0];  
  12.     return 0;  
  13. } // kdGetSensorInitFuncList()  

===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.h

       hal层和kernel层的sensor列表顺序必须保持一致

[cpp] view plaincopy
 
  1. ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT kdSensorList[MAX_NUM_OF_SUPPORT_SENSOR+1] =  
  2. {  
  3. //add by zym  
  4. #if defined(GC2235_MIPI_RAW)  
  5.     {GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, GC2235MIPISensorInit},   
  6. #endif  
  7.   
  8. // add by zhouzuoyu  
  9. #if defined(GC2235_KOTECH_MIPI_RAW)  
  10.     {GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, GC2235MIPISensorInit},   
  11. #endif  
  12.   
  13. #if defined(OV16825_MIPI_RAW)  
  14.         {OV16825MIPI_SENSOR_ID, SENSOR_DRVNAME_OV16825_MIPI_RAW, OV16825MIPISensorInit},   
  15. #endif  
  16. #if defined(IMX135_MIPI_RAW)  
  17.         {IMX135_SENSOR_ID, SENSOR_DRVNAME_IMX135_MIPI_RAW, IMX135_MIPI_RAW_SensorInit},   
  18. #endif  
  19. #if defined(OV8830_RAW)  
  20.     {OV8830_SENSOR_ID, SENSOR_DRVNAME_OV8830_RAW, OV8830SensorInit},   
  21. #endif  
  22. /*  ADD sensor driver before this line */  
  23.     {0,{0},NULL}, //end of list  
  24. };  
  25. //e_add new sensor driver here<span style="font-size:18px;"><span style="font-size:18px;">         </span>   </span>   <span style="font-size:18px;"><span style="font-size:18px;">  
  26. </span></span>  

（2.2）g_invokeSocketIdx，drvIdx解释

      上层传下来的 id 参数解析成两部分 g_invokeSocketIdx 区分目前正在匹配的是 main 还是sub，drvIdx 是 sensor 列表的序列号 。

（2.3）获取指定sensor的func函数，例如ov5670的func，pSensorList[drvIdx[i]].SensorInit(&g_pInvokeSensorFunc[i]);

         调用的函数是OV5670_MIPI_RAW_SensorInit()。

[cpp] view plaincopy
 
  1. #if defined(OV5670_MIPI_RAW)  
  2.     {OV5670_SENSOR_ID, SENSOR_DRVNAME_OV5670_MIPI_RAW, OV5670_MIPI_RAW_SensorInit},   
  3. #endif  

            

===>mediatek/custom/common/kernel/imgsensor/ov5670_mipi_raw/ov5670mipiraw_Sensor.c

[cpp] view plaincopy
 
  1. SENSOR_FUNCTION_STRUCT  SensorFuncOV5670=  
  2. {  
  3.     OV5670Open,  
  4.     OV5670GetInfo,  
  5.     OV5670GetResolution,  
  6.     OV5670FeatureControl,  
  7.     OV5670Control,  
  8.     OV5670Close  
  9. };  
  10.   
  11. UINT32 OV5670_MIPI_RAW_SensorInit(PSENSOR_FUNCTION_STRUCT *pfFunc)//---调用此函数  
  12. {  
  13.     if (pfFunc!=NULL)  
  14.         *pfFunc=&SensorFuncOV5670;  
  15.   
  16.     return ERROR_NONE;  
  17. }  

          5670的sensorinit实现，主要是未了pfFunc这个函数指针的结构体指针赋值，这样我们就实现了驱动代码的分离，hal层只需要调用sensorlist.c这样一个虚拟设备的驱动，就可以和具体的Sensor Driver驱动通信。这样的做法与platform driver的设计思想差不多，在tp，lcm等驱动中也有体现。

（3）上下电camera并读取ID，err = ioctl(m_fdSensor, KDIMGSENSORIOC_T_CHECK_IS_ALIVE);

===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.c

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * adopt_CAMERA_HW_CheckIsAlive 
  3. ********************************************************************************/  
  4. inline static int adopt_CAMERA_HW_CheckIsAlive(void)  
  5. {  
  6.     UINT32 err = 0;  
  7.     UINT32 err1 = 0;  
  8.     UINT32 i = 0;  
  9.     MUINT32 sensorID = 0;  
  10.     MUINT32 retLen = 0;  
  11.   
  12.   
  13.     KD_IMGSENSOR_PROFILE_INIT();  
  14.     //power on sensor  
  15.     kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr,true, CAMERA_HW_DRVNAME1);//----（3.1）sensor上电  
  16.     //wait for power stable  
  17.     mDELAY(10);  
  18.     KD_IMGSENSOR_PROFILE("kdModulePowerOn");  
  19.   
  20.     if (g_pSensorFunc) {  
  21.         for ( i = KDIMGSENSOR_INVOKE_DRIVER_0 ; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {  
  22.             if(DUAL_CAMERA_NONE_SENSOR != g_invokeSocketIdx[i]){  
  23.                 err = g_pSensorFunc->SensorFeatureControl(g_invokeSocketIdx[i], SENSOR_FEATURE_CHECK_SENSOR_ID, (MUINT8*)&sensorID, &retLen);//---（3.2）获取sensor ID  
  24.                 if (sensorID == 0) {    //not implement this feature ID  
  25.                     PK_DBG(" Not implement!!, use old open function to check ");  
  26.                     err = ERROR_SENSOR_CONNECT_FAIL;  
  27.                 }  
  28.                 else if (sensorID == 0xFFFFFFFF) {    //fail to open the sensor  
  29.                     PK_DBG(" No Sensor Found");  
  30.                     err = ERROR_SENSOR_CONNECT_FAIL;  
  31.                 }  
  32.                 else {  
  33.   
  34.                     PK_DBG(" Sensor found ID = 0x%x ", sensorID);  
  35.                     err = ERROR_NONE;  
  36.                 }  
  37.                 if(ERROR_NONE != err)  
  38.                 {  
  39.                     PK_DBG("ERROR:adopt_CAMERA_HW_CheckIsAlive(), No imgsensor alive  ");  
  40.                 }  
  41.             }  
  42.         }  
  43.     }  
  44.     else {  
  45.         PK_DBG("ERROR:NULL g_pSensorFunc ");  
  46.     }  
  47.   
  48.     //reset sensor state after power off  
  49.     err1 = g_pSensorFunc->SensorClose();  
  50.     if(ERROR_NONE != err1) {  
  51.         PK_DBG("SensorClose  ");  
  52.     }  
  53.     //  
  54.     kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr, false, CAMERA_HW_DRVNAME1);      
  55.     //  
  56.     KD_IMGSENSOR_PROFILE("CheckIsAlive");  
  57.   
  58.     return err?-EIO:err;  
  59. }   /* adopt_CAMERA_HW_Open() */  


(3.1)Sensor 上电， kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr,true, CAMERA_HW_DRVNAME1);

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * kdModulePowerOn 
  3. ********************************************************************************/  
  4. int  
  5. kdModulePowerOn(  
  6. CAMERA_DUAL_CAMERA_SENSOR_ENUM socketIdx[KDIMGSENSOR_MAX_INVOKE_DRIVERS],  
  7. char sensorNameStr[KDIMGSENSOR_MAX_INVOKE_DRIVERS][32],  
  8. BOOL On,  
  9. char* mode_name )  
  10. {  
  11. MINT32 ret = ERROR_NONE;  
  12. u32 i = 0;  
  13.   
  14.     for ( i = KDIMGSENSOR_INVOKE_DRIVER_0 ; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {  
  15.         if ( g_bEnableDriver[i] ) {  
  16.             //PK_XLOG_INFO("[%s][%d][%d][%s][%s] ",__FUNCTION__,g_bEnableDriver[i],socketIdx[i],sensorNameStr[i],mode_name);  
  17.             ret = kdCISModulePowerOn(socketIdx[i],sensorNameStr[i],On,mode_name);//实际上电的func  
  18.             if ( ERROR_NONE != ret ) {  
  19.                 PK_ERR("[%s]",__FUNCTION__);  
  20.                 return ret;  
  21.             }  
  22.         }  
  23.     }  
  24.     return ERROR_NONE;  
  25. }  


===>mediatek/custom/huaqin82_slwt_2s_td/kernel/camera/camera/kd_camera_hw.c

[cpp] view plaincopy
 
  1. int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx, char *currSensorName, BOOL On, char* mode_name)  
  2. {  
  3.     PK_DBG("[camera] **kdCISModulePowerOn:SensorIdx:%d,pinSetIdx:%d",SensorIdx,pinSetIdx);  
  4.     //dump_stack();  
  5.     if (DUAL_CAMERA_MAIN_SENSOR == SensorIdx){  
  6.     if (currSensorName &&   
  7.        ((0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))  
  8.        ||(0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName))  
  9.        ||(0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName))  
  10.           ||(0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))  
  11.         ||(0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName))  
  12.         ||(0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName))  
  13.       ||(0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName))  
  14.        ||(0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName))  
  15.         || (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))  
  16.         || (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))  
  17.        ||(0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName))  
  18.         ||(0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))  
  19.               ||(0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName))  
  20.         ||(0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))  
  21.         ||(0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV, currSensorName))  
  22.         || (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV, currSensorName))  
  23.         ||(0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW, currSensorName))  
  24.         ||(0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName))  
  25.         ||(0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName))  
  26.         //|| to add other main camera here  
  27.        ))  
  28.             pinSetIdx = 0;  
  29.     else  
  30.     {  
  31.         PK_DBG("[ryf-main]kdCISModulePowerOn get in---  sensorIdx not compare with sensor name: %s ", currSensorName);  
  32.         //if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName)))  
  33.         //{  
  34.         //      pinSetIdx = 1;  
  35.         //}  
  36.         //else{  
  37.             goto _kdCISModulePowerOn_exit_;  
  38.         //}  
  39.     }  
  40.     }  
  41.     else if (DUAL_CAMERA_SUB_SENSOR == SensorIdx) {  
  42.     if (currSensorName &&   
  43.         ((0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName))  
  44.         || (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName))  
  45.         || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW, currSensorName))  
  46.           || (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName))  
  47.           || (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName))     
  48.          || (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName))   
  49.           || (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName))   
  50.         || (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))  
  51.         || (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))  
  52.         ||(0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))  
  53.         ||(0 == strcmp(SENSOR_DRVNAME_GC0312_YUV, currSensorName))  
  54.         ||(0 == strcmp(SENSOR_DRVNAME_HI704_YUV, currSensorName))  
  55.               //||(0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV, currSensorName))  
  56.         //|| to add other sub camera here  
  57.        ))  
  58.             pinSetIdx = 1;  
  59.     else  
  60.     {  
  61.         //if (currSensorName &&  
  62.            //((0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))  
  63.             //|| to add other main camera here  
  64.            //))  
  65.         //{  
  66.         //  pinSetIdx = 0;  
  67.         //}  
  68.         PK_DBG("{ryf-sub}kdCISModulePowerOn get in---  sensorIdx not compare with sensro:%s ",currSensorName);  
  69.         goto _kdCISModulePowerOn_exit_;  
  70.     }  
  71.     }  
  72.     else if (DUAL_CAMERA_MAIN_2_SENSOR == SensorIdx) {  
  73.        // pinSetIdx = 2;  
  74.     }  
  75.   
  76.     PK_DBG("kdCISModulePowerOn:SensorIdx:%d,pinSetIdx:%d",SensorIdx,pinSetIdx);  
  77.     Rst_PDN_Init();  
  78.   
  79.     //power ON  
  80.     if (On)   
  81.     {  
  82.      PK_DBG("kdCISModulePowerOn -on:currSensorName=%s ",currSensorName);  
  83.         if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))) {  
  84.             PK_DBG("is ov5648mipi on ");  
  85.             if (0 == pinSetIdx) {  
  86.                 if (TRUE != kd_ov5648_main_poweron(mode_name))  
  87.                     goto _kdCISModulePowerOn_exit_;  
  88.             } else if (1 == pinSetIdx) {  
  89.                 if (TRUE != kd_ov5648_sub_poweron(mode_name))  
  90.                     goto _kdCISModulePowerOn_exit_;  
  91.             }  
  92.         }   
  93.     else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName)))             
  94.         {  
  95.         PK_DBG("is s5k4e1ga on  ");  
  96.             if(TRUE != kd_s5k4e1gamipi_poweron(mode_name))  
  97.                  goto _kdCISModulePowerOn_exit_;  
  98.         }   
  99.     else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName)))            
  100.         {  
  101.         PK_DBG("is hi544 on  ");  
  102.             if(TRUE != kd_hi544raw_poweron(mode_name))  
  103.                  goto _kdCISModulePowerOn_exit_;  
  104.         }   
  105.        else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName)))            
  106.         {  
  107.          PK_DBG("is gc2235 on ");  
  108.             if(TRUE != kd_gc2235mipiraw_poweron(mode_name))  
  109.                  goto _kdCISModulePowerOn_exit_;  
  110.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))) {  
  111.             PK_DBG("is gc2235_raw on ");  
  112.               
  113.             if (TRUE != kd_gc2235raw_poweron(mode_name))  
  114.                  goto _kdCISModulePowerOn_exit_;  
  115.         }    
  116. /*  else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI253_YUV,currSensorName))) 
  117.         { 
  118.          PK_DBG("is hi253 on "); 
  119.             if(TRUE != kd_hi253yuv_poweron(mode_name)) 
  120.                  goto _kdCISModulePowerOn_exit_; 
  121.         }*/  
  122.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName))) {    
  123.         PK_DBG("is ov88251 on  ");   
  124.         if(TRUE != kd_ov88251mipiraw_poweron(mode_name))      
  125.                 goto _kdCISModulePowerOn_exit_;  
  126.         }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName))) {   
  127.         PK_DBG("is ov88252 on  ");   
  128.         if(TRUE != kd_ov88252mipiraw_poweron(mode_name))      
  129.                 goto _kdCISModulePowerOn_exit_;  
  130.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))) {  
  131.             PK_DBG("is ov8858 on  ");  
  132.             kd_a5142mipiraw_sub_poweron(mode_name);  
  133.             kd_a5142mipiraw_sub_powerdown(mode_name);  
  134.             if(TRUE != kd_ov8858mipiraw_poweron(mode_name))   
  135.                 goto _kdCISModulePowerOn_exit_;  
  136.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW,currSensorName))) {  
  137.             PK_DBG("is s5k4h5yx on  ");  
  138.             kd_a5142mipiraw_sub_poweron(mode_name);  
  139.             kd_a5142mipiraw_sub_powerdown(mode_name);  
  140.             if (TRUE != kd_s5k4h5yxmipiraw_poweron(mode_name))    
  141.                 goto _kdCISModulePowerOn_exit_;  
  142.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))) {  
  143.             PK_DBG("is t4k35 on  ");     
  144.             if(TRUE != kd_t4k35mipiraw_poweron(mode_name))    
  145.                 goto _kdCISModulePowerOn_exit_;  
  146.         } else if (currSensorName && ((0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))   
  147.         || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName)))) {  
  148.             if(pinSetIdx==0)  
  149.             {  
  150.                 if(TRUE != kd_s5k3h7ymipiraw_poweron(mode_name))  
  151.                     goto _kdCISModulePowerOn_exit_;  
  152.             }  
  153.             else  
  154.             {  
  155.                 if(TRUE != kd_s5k3h72ymipiraw_poweron(mode_name))  
  156.                     goto _kdCISModulePowerOn_exit_;  
  157.             }  
  158.         } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName))) {  
  159.          PK_DBG("is gc2035 on ");  
  160.             if(TRUE != kd_gc2035_poweron(mode_name))  
  161.                  goto _kdCISModulePowerOn_exit_;  
  162.         }   
  163.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName)))  
  164.         {  
  165.             if(TRUE != kd_ov5648a_poweron(mode_name))  
  166.                  goto _kdCISModulePowerOn_exit_;  
  167.         }  
  168.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName)))  
  169.         {  
  170.             if(TRUE != kd_ov5670_poweron(mode_name))  
  171.                  goto _kdCISModulePowerOn_exit_;  
  172.         }  
  173.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName)))  
  174.         {  
  175.             if(TRUE != kd_hi551_poweron(mode_name))  
  176.                  goto _kdCISModulePowerOn_exit_;  
  177.         }  
  178.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName)))  
  179.         {  
  180.             if(TRUE != kd_ov5648b_poweron(mode_name))  
  181.                  goto _kdCISModulePowerOn_exit_;  
  182.         } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))) //lili add  
  183.         {  
  184.             if(TRUE != kd_ov5648_main_poweron(mode_name))  
  185.                  goto _kdCISModulePowerOn_exit_;  
  186.         } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName))) {  
  187.          PK_DBG("is s5k3h72ymipi on ");  
  188.             if(TRUE != kd_s5k3h72ymipiraw_poweron(mode_name))  
  189.                  goto _kdCISModulePowerOn_exit_;  
  190.         } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName)))              
  191.                 {  
  192.                    PK_DBG("is gc0329 on ");  
  193.                        if(TRUE != kd_gc0329_poweron(mode_name))  
  194.                                 goto _kdCISModulePowerOn_exit_;  
  195.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))) {  
  196.             if (0 == pinSetIdx) {  
  197.                 PK_DBG("is A5142 main on  ");  
  198.                 if(TRUE != kd_a5142mipiraw_main_poweron(mode_name))  
  199.                     goto _kdCISModulePowerOn_exit_;  
  200.             } else {  
  201.                 PK_DBG("is A5142 sub on  ");  
  202.                 if(TRUE != kd_a5142mipiraw_sub_poweron(mode_name))  
  203.                     goto _kdCISModulePowerOn_exit_;  
  204.             }  
  205.               
  206.            }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0312_YUV,currSensorName)))            
  207.                 {  
  208.                    PK_DBG("is gc0312 on ");    
  209.                        if(TRUE != kd_gc0312_poweron(mode_name))  
  210.                                 goto _kdCISModulePowerOn_exit_;  
  211.            }   
  212.            else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI704_YUV,currSensorName)))              
  213.                 {  
  214.                    PK_DBG("is hi704 on ");    
  215.                        if(TRUE != kd_hi704yuv_poweron(mode_name))  
  216.                                 goto _kdCISModulePowerOn_exit_;  
  217.            }   
  218.                else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV,currSensorName)))            
  219.                 {  
  220.                    PK_DBG("is gc0310 on ");  
  221.                        if(TRUE != kd_gc0310_poweron(mode_name))  
  222.                                 goto _kdCISModulePowerOn_exit_;  
  223.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV,currSensorName))) {  
  224.             PK_DBG("is gc2145 on ");  
  225.   
  226.             if (TRUE != kd_gc2145_poweron(mode_name))  
  227.                 goto _kdCISModulePowerOn_exit_;  
  228.         }  
  229.         else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName)))  
  230.         {     
  231.             PK_DBG("is hi258 on  ");   
  232.             if(TRUE != kd_hi258mipiraw_poweron(mode_name))  
  233.                 goto _kdCISModulePowerOn_exit_;  
  234.         }  
  235.          else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName))) {  
  236.             PK_DBG("is ov2680 on  ");    
  237.             if(TRUE != kd_ov2680mipiraw_poweron(mode_name))   
  238.                 goto _kdCISModulePowerOn_exit_;  
  239.         }  
  240.     else   
  241.     {  
  242.         PK_DBG("kdCISModulePowerOn get in---  other , please add the power on code!!!!!! ");  
  243.         goto _kdCISModulePowerOn_exit_;  
  244.         }  
  245.   }  
  246.   else {//power OFF  
  247.   
  248.     PK_DBG("kdCISModulePowerOn -off:currSensorName=%s ",currSensorName);  
  249.   
  250.   
  251.      if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName)))           
  252.         {  
  253.             PK_DBG("is ov5648_mipi_raw down ");  
  254.             if (0 == pinSetIdx) {  
  255.                 if(TRUE != kd_ov5648_main_powerdown(mode_name))  
  256.                     goto _kdCISModulePowerOn_exit_;  
  257.             } else if (1 == pinSetIdx) {  
  258.                 if(TRUE != kd_ov5648_sub_powerdown(mode_name))  
  259.                     goto _kdCISModulePowerOn_exit_;  
  260.             }  
  261.         } else  if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName)))              
  262.         {  
  263.          PK_DBG("is s5k4e1ga down ");  
  264.             if(TRUE != kd_s5k4e1gamipi_powerdown(mode_name))  
  265.                  goto _kdCISModulePowerOn_exit_;  
  266.         }  
  267.         else  if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName)))           
  268.         {  
  269.          PK_DBG("is hi544 down ");  
  270.             if(TRUE != kd_hi544raw_powerdown(mode_name))  
  271.                  goto _kdCISModulePowerOn_exit_;  
  272.         }  
  273.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName)))  
  274.         {  
  275.             PK_DBG("is ov88251 down ");  
  276.              if(TRUE != kd_ov88251mipiraw_powerdown(mode_name))  
  277.               goto _kdCISModulePowerOn_exit_;     
  278.           
  279.         }  
  280.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName)))  
  281.         {  
  282.             PK_DBG("is ov5670 down ");  
  283.              if(TRUE != kd_ov5670mipiraw_powerdown(mode_name))  
  284.               goto _kdCISModulePowerOn_exit_;     
  285.           
  286.         }  
  287.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName)))  
  288.         {  
  289.             PK_DBG("is hi551 down ");  
  290.              if(TRUE != kd_hi551mipiraw_powerdown(mode_name))  
  291.               goto _kdCISModulePowerOn_exit_;     
  292.           
  293.         }  
  294.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName)))  
  295.         {  
  296.             PK_DBG("is ov88252 down ");  
  297.              if(TRUE != kd_ov88252mipiraw_powerdown(mode_name))  
  298.               goto _kdCISModulePowerOn_exit_;             
  299.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))) {  
  300.             PK_DBG("is ov8858 down ");  
  301.             if(TRUE != kd_ov8858mipiraw_powerdown(mode_name))  
  302.                 goto _kdCISModulePowerOn_exit_;  
  303.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW, currSensorName))) {  
  304.             PK_DBG("is s5k4h5yx down ");  
  305.             if (TRUE != kd_s5k4h5yxmipiraw_powerdown(mode_name))  
  306.                 goto _kdCISModulePowerOn_exit_;  
  307.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))) {  
  308.             PK_DBG("is t4k35 down ");  
  309.             if(TRUE != kd_t4k35mipiraw_powerdown(mode_name))  
  310.                 goto _kdCISModulePowerOn_exit_;  
  311.         }  
  312.     else  if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName)))              
  313.         {  
  314.          PK_DBG("is gc2235 down ");  
  315.             if(TRUE != kd_gc2235mipiraw_powerdown(mode_name))  
  316.                  goto _kdCISModulePowerOn_exit_;  
  317.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))) {  
  318.             PK_DBG("is gc2235 down ");  
  319.               
  320.             if (TRUE != kd_gc2235raw_powerdown(mode_name))  
  321.                  goto _kdCISModulePowerOn_exit_;  
  322.         }  
  323. /*  else  if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI253_YUV,currSensorName))) 
  324.         { 
  325.          PK_DBG("is hi253 down "); 
  326.             if(TRUE != kd_hi253yuv_powerdown(mode_name)) 
  327.                  goto _kdCISModulePowerOn_exit_; 
  328.         }*/   
  329.         else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))) {  
  330.             if (0 == pinSetIdx) {  
  331.                 PK_DBG("is A5142 main down  ");  
  332.                 if (TRUE != kd_a5142mipiraw_main_powerdown(mode_name))  
  333.                 goto _kdCISModulePowerOn_exit_;  
  334.             } else {  
  335.                 PK_DBG("is A5142 sub down  ");  
  336.                 if (TRUE != kd_a5142mipiraw_sub_powerdown(mode_name))  
  337.                 goto _kdCISModulePowerOn_exit_;  
  338.             }  
  339.         } else if (currSensorName && ((0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))   
  340.         || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName))))      
  341.         {  
  342.                     PK_DBG("is s5k3h7 down ");  
  343.                 if(pinSetIdx==0)  
  344.                         {  
  345.                  if(TRUE != kd_s5k3h7ymipiraw_powerdown(mode_name))  
  346.                   goto _kdCISModulePowerOn_exit_;  
  347.                 }  
  348.                 else {  
  349.                 if(TRUE != kd_s5k3h72ymipiraw_powerdown(mode_name))  
  350.                           goto _kdCISModulePowerOn_exit_;  
  351.                 }  
  352.   
  353.         }  
  354.           else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName)))              
  355.         {  
  356.          PK_DBG("is gc2035 down ");  
  357.             if(TRUE != kd_gc2035_powerdown(mode_name))  
  358.                  goto _kdCISModulePowerOn_exit_;  
  359.         }  
  360.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName)))             
  361.         {  
  362.          PK_DBG("is s5k3h72y_mipi_raw down ");  
  363.             if(TRUE != kd_s5k3h72ymipiraw_powerdown(mode_name))  
  364.                  goto _kdCISModulePowerOn_exit_;  
  365.         }  
  366.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName)))  
  367.         {  
  368.             if(TRUE != kd_ov5648a_powerdown(mode_name))  
  369.                  goto _kdCISModulePowerOn_exit_;  
  370.         }  
  371.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName)))  
  372.         {  
  373.             if(TRUE != kd_ov5648b_powerdown(mode_name))  
  374.                  goto _kdCISModulePowerOn_exit_;  
  375.         }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))) //lili add  
  376.         {  
  377.             if(TRUE != kd_ov5648_main_powerdown(mode_name))  
  378.                  goto _kdCISModulePowerOn_exit_;  
  379.         }  
  380.       else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName)))              
  381.        {  
  382.                 PK_DBG("is gc0329 down ");  
  383.                     if(TRUE != kd_gc0329yuv_powerdown(mode_name))  
  384.                             goto _kdCISModulePowerOn_exit_;  
  385.         }   
  386.        else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0312_YUV,currSensorName)))             
  387.        {  
  388.                 PK_DBG("is gc0312 down ");  
  389.                     if(TRUE != kd_gc0312_powerdown(mode_name))  
  390.                             goto _kdCISModulePowerOn_exit_;  
  391.         }   
  392.           else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI704_YUV,currSensorName)))           
  393.        {  
  394.                 PK_DBG("is hi704 down ");  
  395.                     if(TRUE != kd_hi704yuv_powerdown(mode_name))  
  396.                             goto _kdCISModulePowerOn_exit_;  
  397.         }  
  398.           else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV,currSensorName)))             
  399.        {  
  400.                 PK_DBG("is gc0310 down ");  
  401.                     if(TRUE != kd_gc0310_powerdown(mode_name))  
  402.                             goto _kdCISModulePowerOn_exit_;  
  403.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV,currSensorName))) {  
  404.             PK_DBG("is gc2145 down ");  
  405.   
  406.             if (TRUE != kd_gc2145_powerdown(mode_name))  
  407.                 goto _kdCISModulePowerOn_exit_;  
  408.         }   
  409.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName)))  
  410.         {  
  411.             PK_DBG("is hi258 down ");  
  412.             if(TRUE != kd_hi258mipiraw_powerdown(mode_name))  
  413.                 goto _kdCISModulePowerOn_exit_;  
  414.     }  
  415.         else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName)))  
  416.          {  
  417.             PK_DBG("is ov2680 down ");  
  418.             if(TRUE != kd_ov2680mipiraw_powerdown(mode_name))  
  419.                 goto _kdCISModulePowerOn_exit_;  
  420.     }   
  421.     else   
  422.     {  
  423.         PK_DBG("kdCISModulePowerDown get in---  other , please add the power down code!!!!!! ");  
  424.         goto _kdCISModulePowerOn_exit_;  
  425.         }  
  426.   
  427.   }  
  428.     return 0;  
  429.   
  430. _kdCISModulePowerOn_exit_:  
  431.     return -EIO;  
  432. }  
  433. EXPORT_SYMBOL(kdCISModulePowerOn);  

以ov5670为例，其上电code如下：

[cpp] view plaincopy
 
  1. static int kd_ov5670_poweron( char *mode_name)  
  2. {  
  3.     int ret;  
  4.         printk("kd_ov5670_poweron1 start.. ");  
  5.   
  6.         ret = kd_poweron_main_devices(VOL_1800, VOL_2800, VOL_1200, VOL_2800, mode_name,0);//给camera上三路电  
  7.      PK_DBG("kd_ov88251mipiraw_poweron start.. ");  
  8.         mdelay(10);// wait power to be stable    
  9.         //disable_inactive_sensor();//disable inactive sensor  
  10.         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!!  ");}  
  11.         mdelay(10);  
  12.         if(mt_set_gpio_out(pinSet[0][IDX_PS_CMPDN],pinSet[0][IDX_PS_CMPDN+IDX_PS_ON])){PK_DBG("[CAMERA LENS] set gpio failed!!  ");}  
  13.         mdelay(1);  
  14.       
  15.     if(mt_set_gpio_out(pinSet[0][IDX_PS_CMRST],pinSet[0][IDX_PS_CMRST+IDX_PS_ON])){PK_DBG("[CAMERA SENSOR] set gpio failed!!  ");}  
  16.     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!!  ");}  
  17.     mdelay(10);  
  18.     if(mt_set_gpio_out(pinSet[0][IDX_PS_CMRST],pinSet[0][IDX_PS_CMRST+IDX_PS_ON])){PK_DBG("[CAMERA SENSOR] set gpio failed!!  ");}  
  19.     mdelay(5);  
  20. poweronerr:  
  21.     return ret;  
  22. }  


(3.2)获取sensor ID，err = g_pSensorFunc->SensorFeatureControl(g_invokeSocketIdx[i], SENSOR_FEATURE_CHECK_SENSOR_ID, (MUINT8*)&sensorID, &retLen);

       此函数调用具体sensor的func，例如ov5670，则调用的

[cpp] view plaincopy
 
  1. OV5670FeatureControl  

===>mediatek/custom/common/kernel/imgsensor/ov5670_mipi_raw

[cpp] view plaincopy
 
  1. UINT32 OV5670FeatureControl(MSDK_SENSOR_FEATURE_ENUM FeatureId,  
  2.                                                                 UINT8 *pFeaturePara,UINT32 *pFeatureParaLen)  
  3. {  
  4.     UINT16 *pFeatureReturnPara16=(UINT16 *) pFeaturePara;  
  5.     UINT16 *pFeatureData16=(UINT16 *) pFeaturePara;  
  6.     UINT32 *pFeatureReturnPara32=(UINT32 *) pFeaturePara;  
  7.     UINT32 *pFeatureData32=(UINT32 *) pFeaturePara;  
  8.     UINT32 SensorRegNumber;  
  9.     UINT32 i;  
  10.     PNVRAM_SENSOR_DATA_STRUCT pSensorDefaultData=(PNVRAM_SENSOR_DATA_STRUCT) pFeaturePara;  
  11.     MSDK_SENSOR_CONFIG_STRUCT *pSensorConfigData=(MSDK_SENSOR_CONFIG_STRUCT *) pFeaturePara;  
  12.     MSDK_SENSOR_REG_INFO_STRUCT *pSensorRegData=(MSDK_SENSOR_REG_INFO_STRUCT *) pFeaturePara;  
  13.     MSDK_SENSOR_GROUP_INFO_STRUCT *pSensorGroupInfo=(MSDK_SENSOR_GROUP_INFO_STRUCT *) pFeaturePara;  
  14.     MSDK_SENSOR_ITEM_INFO_STRUCT *pSensorItemInfo=(MSDK_SENSOR_ITEM_INFO_STRUCT *) pFeaturePara;  
  15.     MSDK_SENSOR_ENG_INFO_STRUCT *pSensorEngInfo=(MSDK_SENSOR_ENG_INFO_STRUCT *) pFeaturePara;  
  16.   
  17.     switch (FeatureId)  
  18.     {  
  19.         case SENSOR_FEATURE_GET_RESOLUTION:  
  20.             *pFeatureReturnPara16++= OV5670_IMAGE_SENSOR_FULL_WIDTH;  
  21.             *pFeatureReturnPara16= OV5670_IMAGE_SENSOR_FULL_HEIGHT;  
  22.             *pFeatureParaLen=4;  
  23.             break;  
  24.         case SENSOR_FEATURE_GET_PERIOD:  
  25.                                 *pFeatureReturnPara16++= OV5670_FeatureControl_PERIOD_PixelNum;  
  26.                                 *pFeatureReturnPara16= OV5670_FeatureControl_PERIOD_LineNum;  
  27.                                 *pFeatureParaLen=4;  
  28.                                 break;  
  29.         case SENSOR_FEATURE_GET_PIXEL_CLOCK_FREQ:  
  30.                         switch(OV5670CurrentScenarioId)  
  31.                         {  
  32.                                 case MSDK_SCENARIO_ID_CAMERA_PREVIEW:  
  33.                                         *pFeatureReturnPara32 = OV5670_PREVIEW_PCLK;  
  34.                                         *pFeatureParaLen=4;  
  35.                                         break;  
  36.                                 case MSDK_SCENARIO_ID_VIDEO_PREVIEW:  
  37.                                         *pFeatureReturnPara32 = OV5670_VIDEO_PCLK;  
  38.                                         *pFeatureParaLen=4;  
  39.                                         break;  
  40.                                 case MSDK_SCENARIO_ID_CAMERA_CAPTURE_JPEG:  
  41.                                 case MSDK_SCENARIO_ID_CAMERA_ZSD:  
  42.                                         *pFeatureReturnPara32 = OV5670_CAPTURE_PCLK;  
  43.                                         *pFeatureParaLen=4;  
  44.                                         break;  
  45.                                 default:  
  46.                                         *pFeatureReturnPara32 = OV5670_PREVIEW_PCLK;  
  47.                                         *pFeatureParaLen=4;  
  48.                                         break;  
  49.                         }  
  50.                     break;  
  51.   
  52.         case SENSOR_FEATURE_SET_ESHUTTER:  
  53.             OV5670_SetShutter(*pFeatureData16);  
  54.             break;  
  55.         case SENSOR_FEATURE_SET_NIGHTMODE:  
  56.             OV5670_NightMode((BOOL) *pFeatureData16);  
  57.             break;  
  58.         case SENSOR_FEATURE_SET_GAIN:  
  59.            OV5670_SetGain((UINT16) *pFeatureData16);  
  60.             break;  
  61.         case SENSOR_FEATURE_SET_FLASHLIGHT:  
  62.             break;  
  63.         case SENSOR_FEATURE_SET_ISP_MASTER_CLOCK_FREQ:  
  64.             //OV5670_isp_master_clock=*pFeatureData32;  
  65.             break;  
  66.         case SENSOR_FEATURE_SET_REGISTER:  
  67.             OV5670_write_cmos_sensor(pSensorRegData->RegAddr, pSensorRegData->RegData);  
  68.             break;  
  69.         case SENSOR_FEATURE_GET_REGISTER:  
  70.             pSensorRegData->RegData = OV5670_read_cmos_sensor(pSensorRegData->RegAddr);  
  71.             break;  
  72.         case SENSOR_FEATURE_SET_CCT_REGISTER:  
  73.             SensorRegNumber=FACTORY_END_ADDR;  
  74.             for (i=0;i<SensorRegNumber;i++)  
  75.             {  
  76.                 spin_lock(&ov5670mipiraw_drv_lock);  
  77.                 OV5670SensorCCT[i].Addr=*pFeatureData32++;  
  78.                 OV5670SensorCCT[i].Para=*pFeatureData32++;  
  79.                                 spin_unlock(&ov5670mipiraw_drv_lock);  
  80.             }  
  81.             break;  
  82.         case SENSOR_FEATURE_GET_CCT_REGISTER:  
  83.             SensorRegNumber=FACTORY_END_ADDR;  
  84.             if (*pFeatureParaLen<(SensorRegNumber*sizeof(SENSOR_REG_STRUCT)+4))  
  85.                 return FALSE;  
  86.             *pFeatureData32++=SensorRegNumber;  
  87.             for (i=0;i<SensorRegNumber;i++)  
  88.             {  
  89.                 *pFeatureData32++=OV5670SensorCCT[i].Addr;  
  90.                 *pFeatureData32++=OV5670SensorCCT[i].Para;  
  91.             }  
  92.             break;  
  93.         case SENSOR_FEATURE_SET_ENG_REGISTER:  
  94.             SensorRegNumber=ENGINEER_END;  
  95.             for (i=0;i<SensorRegNumber;i++)  
  96.             {  
  97.                 spin_lock(&ov5670mipiraw_drv_lock);  
  98.                 OV5670SensorReg[i].Addr=*pFeatureData32++;  
  99.                 OV5670SensorReg[i].Para=*pFeatureData32++;  
  100.                                 spin_unlock(&ov5670mipiraw_drv_lock);  
  101.             }  
  102.             break;  
  103.         case SENSOR_FEATURE_GET_ENG_REGISTER:  
  104.             SensorRegNumber=ENGINEER_END;  
  105.             if (*pFeatureParaLen<(SensorRegNumber*sizeof(SENSOR_REG_STRUCT)+4))  
  106.                 return FALSE;  
  107.             *pFeatureData32++=SensorRegNumber;  
  108.             for (i=0;i<SensorRegNumber;i++)  
  109.             {  
  110.                 *pFeatureData32++=OV5670SensorReg[i].Addr;  
  111.                 *pFeatureData32++=OV5670SensorReg[i].Para;  
  112.             }  
  113.             break;  
  114.         case SENSOR_FEATURE_GET_REGISTER_DEFAULT:  
  115.             if (*pFeatureParaLen>=sizeof(NVRAM_SENSOR_DATA_STRUCT))  
  116.             {  
  117.                 pSensorDefaultData->Version=NVRAM_CAMERA_SENSOR_FILE_VERSION;  
  118.                 pSensorDefaultData->SensorId=OV5670_SENSOR_ID;  
  119.                 memcpy(pSensorDefaultData->SensorEngReg, OV5670SensorReg, sizeof(SENSOR_REG_STRUCT)*ENGINEER_END);  
  120.                 memcpy(pSensorDefaultData->SensorCCTReg, OV5670SensorCCT, sizeof(SENSOR_REG_STRUCT)*FACTORY_END_ADDR);  
  121.             }  
  122.             else  
  123.                 return FALSE;  
  124.             *pFeatureParaLen=sizeof(NVRAM_SENSOR_DATA_STRUCT);  
  125.             break;  
  126.         case SENSOR_FEATURE_GET_CONFIG_PARA:  
  127.             memcpy(pSensorConfigData, &OV5670SensorConfigData, sizeof(MSDK_SENSOR_CONFIG_STRUCT));  
  128.             *pFeatureParaLen=sizeof(MSDK_SENSOR_CONFIG_STRUCT);  
  129.             break;  
  130.         case SENSOR_FEATURE_CAMERA_PARA_TO_SENSOR:  
  131.             OV5670_camera_para_to_sensor();  
  132.             break;  
  133.   
  134.         case SENSOR_FEATURE_SENSOR_TO_CAMERA_PARA:  
  135.             OV5670_sensor_to_camera_para();  
  136.             break;  
  137.         case SENSOR_FEATURE_GET_GROUP_COUNT:  
  138.             *pFeatureReturnPara32++=OV5670_get_sensor_group_count();  
  139.             *pFeatureParaLen=4;  
  140.             break;  
  141.         case SENSOR_FEATURE_GET_GROUP_INFO:  
  142.             OV5670_get_sensor_group_info(pSensorGroupInfo->GroupIdx, pSensorGroupInfo->GroupNamePtr, &pSensorGroupInfo->ItemCount);  
  143.             *pFeatureParaLen=sizeof(MSDK_SENSOR_GROUP_INFO_STRUCT);  
  144.             break;  
  145.         case SENSOR_FEATURE_GET_ITEM_INFO:  
  146.             OV5670_get_sensor_item_info(pSensorItemInfo->GroupIdx,pSensorItemInfo->ItemIdx, pSensorItemInfo);  
  147.             *pFeatureParaLen=sizeof(MSDK_SENSOR_ITEM_INFO_STRUCT);  
  148.             break;  
  149.   
  150.         case SENSOR_FEATURE_SET_ITEM_INFO:  
  151.             OV5670_set_sensor_item_info(pSensorItemInfo->GroupIdx, pSensorItemInfo->ItemIdx, pSensorItemInfo->ItemValue);  
  152.             *pFeatureParaLen=sizeof(MSDK_SENSOR_ITEM_INFO_STRUCT);  
  153.             break;  
  154.   
  155.         case SENSOR_FEATURE_GET_ENG_INFO:  
  156.             pSensorEngInfo->SensorId = 129;  
  157.             pSensorEngInfo->SensorType = CMOS_SENSOR;  
  158.             pSensorEngInfo->SensorOutputDataFormat=SENSOR_OUTPUT_FORMAT_RAW_Gb;  
  159.             *pFeatureParaLen=sizeof(MSDK_SENSOR_ENG_INFO_STRUCT);  
  160.             break;  
  161.         case SENSOR_FEATURE_GET_LENS_DRIVER_ID:  
  162.             // get the lens driver ID from EEPROM or just return LENS_DRIVER_ID_DO_NOT_CARE  
  163.             // if EEPROM does not exist in camera module.  
  164.             *pFeatureReturnPara32=LENS_DRIVER_ID_DO_NOT_CARE;  
  165.             *pFeatureParaLen=4;  
  166.             break;  
  167.   
  168.         case SENSOR_FEATURE_INITIALIZE_AF:  
  169.             break;  
  170.         case SENSOR_FEATURE_CONSTANT_AF:  
  171.             break;  
  172.         case SENSOR_FEATURE_MOVE_FOCUS_LENS:  
  173.             break;  
  174.         case SENSOR_FEATURE_SET_VIDEO_MODE:  
  175.             OV5670SetVideoMode(*pFeatureData16);  
  176.             break;  
  177.         case SENSOR_FEATURE_CHECK_SENSOR_ID://-------------调用此处读取ID  
  178.             OV5670GetSensorID(pFeatureReturnPara32);  
  179.             break;  
  180.         case SENSOR_FEATURE_SET_AUTO_FLICKER_MODE:  
  181.             OV5670SetAutoFlickerMode((BOOL)*pFeatureData16, *(pFeatureData16+1));  
  182.                 break;  
  183.                 case SENSOR_FEATURE_SET_MAX_FRAME_RATE_BY_SCENARIO:  
  184.                         OV5670MIPISetMaxFramerateByScenario((MSDK_SCENARIO_ID_ENUM)*pFeatureData32, *(pFeatureData32+1));  
  185.                         break;  
  186.                 case SENSOR_FEATURE_GET_DEFAULT_FRAME_RATE_BY_SCENARIO:  
  187.                         OV5670MIPIGetDefaultFramerateByScenario((MSDK_SCENARIO_ID_ENUM)*pFeatureData32, (MUINT32 *)(*(pFeatureData32+1)));  
  188.                         break;  
  189.                 case SENSOR_FEATURE_SET_TEST_PATTERN:  
  190.                         OV5670SetTestPatternMode((BOOL)*pFeatureData16);  
  191.                         break;  
  192.                 case SENSOR_FEATURE_GET_TEST_PATTERN_CHECKSUM_VALUE://for factory mode auto testing  
  193.                         *pFeatureReturnPara32=OV5670_TEST_PATTERN_CHECKSUM;  
  194.                         *pFeatureParaLen=4;  
  195.                      break;  
  196.         default:  
  197.             break;  
  198.     }  
  199.     return ERROR_NONE;  
  200. }  
[cpp] view plaincopy
 
  1. UINT32 OV5670GetSensorID(UINT32 *sensorID)  
  2. {  
  3.     int  retry = 2;  
  4.   
  5.         OV5670DB("OV5670GetSensorID enter :  ");  
  6.     mdelay(5);  
  7.   
  8.     do {  
  9.         *sensorID = (OV5670_read_cmos_sensor(0x300B)<<8)|OV5670_read_cmos_sensor(0x300C);  
  10.         if (*sensorID == OV5670_SENSOR_ID)  
  11.                 {  
  12.                         OV5670DB("Sensor ID = 0x%04x ", *sensorID);  
  13.                 break;  
  14.                 }  
  15.         OV5670DB("Read Sensor ID Fail = 0x%04x ", *sensorID);  
  16.         retry--;  
  17.     } while (retry > 0);  
  18.   
  19.     if (*sensorID != OV5670_SENSOR_ID) {  
  20.                 OV5670DB("Read Sensor ID Fail = 0x%04x ", *sensorID);  
  21.   
  22.                 /* 
  23.         *sensorID = OV5670_SENSOR_ID; 
  24.         return ERROR_SENSOR_CONNECT_FAIL; 
  25.         */  
  26.          *sensorID = 0xFFFFFFFF;  
  27.      return ERROR_SENSOR_CONNECT_FAIL;  
  28.     }  
  29.     return ERROR_NONE;  
  30. }  

          以上是ov5670获取ID的函数。

一、MTK平台Camera框架

         MTK平台的Camera的架构见下图，

     这里主要介绍kernel部分和HAL层部分。

    1、Kernel 部分主要有两块:

           1.1、image sensordriver,负责具体型号的 sensor 的 id 检测,上电，以及在preview、capture、初始化、3A等等功能设定时的寄存器配置。

           1.2、isp driver，通过DMA将sensor数据流上传。

        2、HAL层部分主要有三部分组成：

           2.1、imageio，主要负责数据buffer上传的pipe。

          2.2、drv，包含imgsensor和isp的hal层控制。

          2.3、feature io，包含各种3A等性能配置。

                  

二、Camera打开流程分析

         Camera开启流程图如下：

        主要发生在两个时间点：

    1、开机时：camera完成了sensor框架初始化，id检测并匹配sensor，以及上下电操作。

    2、打开Camera应用时：camera会有上电，完成sensor的寄存器初始化配置，向上层传递基本参数和配置信息，以及preview和capture模式循环。

      

1、开机初始化过程

         由于一开始不知道上电camera初始化从哪开始，我们可以借助抓取的mtk mobile log去分析。先看hal层log开始处：

[plain] view plaincopy
 
  1. 12-24 10:02:07.601   148   148 D MtkCam/module: [instantiate_camera_module]  
  2. 12-24 10:02:07.601   148   148 D MtkCam/Utils/Property: [clear] pid/tid=148/148  
  3. 12-24 10:02:07.601   148   148 I CameraService: Loaded "MediaTek Camera Module" camera module  
  4. 12-24 10:02:07.601   148   148 D MtkCam/MtkCamUtils: [CamDevMetaInfoMap::clear] pid/tid=148/148  
  5. 12-24 10:02:07.601   148   148 D SensorHal: [getInstance][SensorHalImp] getInstance  
  6. 12-24 10:02:07.601   148   148 D SensorHal: [createImp][createImp]: 0  
  7. 12-24 10:02:07.601   148   148 D SeninfDrvImp: [getInstance][getInstance]  
  8. 12-24 10:02:07.601   148   148 D SeninfDrvImp: [SeninfDrvImp][SeninfDrvImp]  
  9. 12-24 10:02:07.601   148   148 D SeninfDrvImp: [init][init]: 0  

        通过sourceinsight搜索发现开始是从CamDeviceManagerImp.cpp函数的enumDeviceLocked()开始。该函数的源代码如下：

===>mediatek/platform/mt6582/hardware/mtkcam/devicemgr/CamDeviceManagerImp.cpp

[cpp] view plaincopy
 
  1. /****************************************************************************** 
  2.  * 
  3.  ******************************************************************************/  
  4. int32_t  
  5. CamDeviceManagerImp::  
  6. enumDeviceLocked()  
  7. {  
  8.     Utils::CamProfile _profile(__FUNCTION__, "CamDeviceManagerImp");  
  9.     //  
  10.     status_t status = OK;  
  11.     int32_t i4DeviceNum = 0;  
  12.     //  
  13.     mEnumMap.clear();  
  14. //------------------------------------------------------------------------------  
  15. #if '1'==MTKCAM_HAVE_SENSOR_HAL  
  16.   
  17.     mEnumMap.clear();  
  18.     DevMetaInfo::clear();  
  19.     //  
  20.     int32_t isFakeOrientation = 0;  
  21.     int32_t i4DevSetupOrientation = 0;  
  22.     camera_info camInfo;  
  23.     camInfo.device_version = CAMERA_DEVICE_API_VERSION_1_0;  
  24.     camInfo.static_camera_characteristics = NULL;  
  25.     //  
  26.     SensorHal* pSensorHal = SensorHal::createInstance();//创建sensor对象  
  27.     if  ( ! pSensorHal )  
  28.     {  
  29.         MY_LOGE("pSensorHal == NULL");  
  30.         return 0;  
  31.     }  
  32.     //  
  33.     int32_t const iSensorsList = pSensorHal->searchSensor();//此函数是入口，主要查找匹配的硬件sensor  
  34.     //  
  35.     //  
  36.     if  ( (iSensorsList & SENSOR_DEV_MAIN_3D) == SENSOR_DEV_MAIN_3D )  
  37.     {  
  38.         MY_LOGI("Stereo 3D Camera found");  
  39. #warning "[TODO] Stereo 3D Camera"  
  40.     }  
  41.     //  
  42.     if  ( (iSensorsList & SENSOR_DEV_MAIN) == SENSOR_DEV_MAIN )  
  43.     {  
  44.         int32_t const deviceId = i4DeviceNum;  
  45.         //  
  46.         halSensorDev_e const eHalSensorDev = SENSOR_DEV_MAIN;  
  47.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_FAKE_ORIENTATION, (int)&isFakeOrientation);  
  48.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_ORIENTATION_ANGLE, (int)&i4DevSetupOrientation);  
  49.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_FACING_DIRECTION, (int)&camInfo.facing);  
  50.         camInfo.orientation = i4DevSetupOrientation;  
  51.         if  ( isFakeOrientation )  
  52.         {  
  53.             camInfo.orientation = (0==camInfo.facing) ? 90 : 270;  
  54.             MY_LOGW("Fake orientation:%d instead of %d, facing=%d HalSensorDev=%#x", camInfo.orientation, i4DevSetupOrientation, camInfo.facing, eHalSensorDev);  
  55.         }  
  56.         DevMetaInfo::add(deviceId, camInfo, i4DevSetupOrientation, eDevId_ImgSensor, eHalSensorDev);  
  57.         //  
  58.         sp<EnumInfo> pInfo = new EnumInfo;  
  59.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  60.         pInfo->pMetadata            = NULL;  
  61.         pInfo->iFacing              = camInfo.facing;  
  62.         pInfo->iWantedOrientation   = camInfo.orientation;  
  63.         pInfo->iSetupOrientation    = i4DevSetupOrientation;  
  64.         mEnumMap.add(deviceId, pInfo);  
  65.         //  
  66.         i4DeviceNum++;  
  67.     }  
  68.     //  
  69.     if  ( (iSensorsList & SENSOR_DEV_SUB) == SENSOR_DEV_SUB )  
  70.     {  
  71.         int32_t const deviceId = i4DeviceNum;  
  72.         //  
  73.         halSensorDev_e const eHalSensorDev = SENSOR_DEV_SUB;  
  74.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_FAKE_ORIENTATION, (int)&isFakeOrientation);  
  75.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_ORIENTATION_ANGLE, (int)&i4DevSetupOrientation);  
  76.         pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_FACING_DIRECTION, (int)&camInfo.facing);  
  77.         camInfo.orientation = i4DevSetupOrientation;  
  78.         if  ( isFakeOrientation )  
  79.         {  
  80.             camInfo.orientation = (0==camInfo.facing) ? 90 : 270;  
  81.             MY_LOGW("Fake orientation:%d instead of %d, facing=%d HalSensorDev=%#x", camInfo.orientation, i4DevSetupOrientation, camInfo.facing, eHalSensorDev);  
  82.         }  
  83.         DevMetaInfo::add(deviceId, camInfo, i4DevSetupOrientation, eDevId_ImgSensor, eHalSensorDev);  
  84.         //  
  85.         sp<EnumInfo> pInfo = new EnumInfo;  
  86.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  87.         pInfo->pMetadata            = NULL;  
  88.         pInfo->iFacing              = camInfo.facing;  
  89.         pInfo->iWantedOrientation   = camInfo.orientation;  
  90.         pInfo->iSetupOrientation    = i4DevSetupOrientation;  
  91.         mEnumMap.add(deviceId, pInfo);  
  92.         //  
  93.         i4DeviceNum++;  
  94.     }  
  95.     //  
  96. //    if  ( (iSensorsList & SENSOR_DEV_ATV) == SENSOR_DEV_ATV )  
  97.     {  
  98.         int32_t const deviceId = 0xFF;  
  99.         //  
  100.         halSensorDev_e const eHalSensorDev = SENSOR_DEV_ATV;  
  101.         camInfo.facing = 0;  
  102.         camInfo.orientation = 0;  
  103.         DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_AtvSensor, eHalSensorDev);  
  104.         //  
  105.         sp<EnumInfo> pInfo = new EnumInfo;  
  106.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  107.         pInfo->pMetadata            = NULL;  
  108.         pInfo->iFacing              = camInfo.facing;  
  109.         pInfo->iWantedOrientation   = camInfo.orientation;  
  110.         pInfo->iSetupOrientation    = i4DevSetupOrientation;  
  111.         mEnumMap.add(deviceId, pInfo);  
  112.         //  
  113. //        i4DeviceNum++;  
  114.     }  
  115.     //  
  116.     //  
  117.     if  ( pSensorHal )  
  118.     {  
  119.         pSensorHal->destroyInstance();  
  120.         pSensorHal = NULL;  
  121.     }  
  122.     //  
  123.     MY_LOGI("iSensorsList=0x%08X, i4DeviceNum=%d", iSensorsList, i4DeviceNum);  
  124.     for (size_t i = 0; i < mEnumMap.size(); i++)  
  125.     {  
  126.         int32_t const deviceId = mEnumMap.keyAt(i);  
  127.         sp<EnumInfo> pInfo = mEnumMap.valueAt(i);  
  128.         uint32_t const uDeviceVersion   = pInfo->uDeviceVersion;  
  129.         camera_metadata const*pMetadata = pInfo->pMetadata;  
  130.         int32_t const iFacing           = pInfo->iFacing;  
  131.         int32_t const iWantedOrientation= pInfo->iWantedOrientation;  
  132.         int32_t const iSetupOrientation = pInfo->iSetupOrientation;  
  133.         MY_LOGI(  
  134.             "[0x%02x] orientation(wanted/setup)=(%d/%d) facing:%d metadata:%p DeviceVersion:0x%x",   
  135.             deviceId, iWantedOrientation, iSetupOrientation,   
  136.             iFacing, pMetadata, uDeviceVersion  
  137.         );  
  138.     }  
  139.   
  140. #else   //----------------------------------------------------------------------  
  141.   
  142.     #warning "[WARN] Simulation for CamDeviceManagerImp::enumDeviceLocked()"  
  143.   
  144.     mEnumMap.clear();  
  145.     DevMetaInfo::clear();  
  146.     {  
  147.         int32_t const deviceId = 0;  
  148.         //  
  149.         camera_info camInfo;  
  150.         camInfo.device_version  = CAMERA_DEVICE_API_VERSION_1_0;  
  151.         camInfo.static_camera_characteristics = NULL;  
  152.         camInfo.facing      = 0;  
  153.         camInfo.orientation = 90;  
  154.         DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_ImgSensor, 0x01/*SENSOR_DEV_MAIN*/);  
  155.         //  
  156.         sp<EnumInfo> pInfo = new EnumInfo;  
  157.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  158.         pInfo->pMetadata            = NULL;  
  159.         pInfo->iFacing              = 0;  
  160.         pInfo->iWantedOrientation   = 90;  
  161.         pInfo->iSetupOrientation    = 90;  
  162.         mEnumMap.add(deviceId, pInfo);  
  163.     }  
  164.     //  
  165.     {  
  166.         int32_t const deviceId = 0xFF;  
  167.         //  
  168.         camera_info camInfo;  
  169.         camInfo.device_version  = CAMERA_DEVICE_API_VERSION_1_0;  
  170.         camInfo.static_camera_characteristics = NULL;  
  171.         camInfo.facing      = 0;  
  172.         camInfo.orientation = 0;  
  173.         DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_AtvSensor, 0x04/*SENSOR_DEV_ATV*/);  
  174.         //  
  175.         sp<EnumInfo> pInfo = new EnumInfo;  
  176.         pInfo->uDeviceVersion       = CAMERA_DEVICE_API_VERSION_1_0;  
  177.         pInfo->pMetadata            = NULL;  
  178.         pInfo->iFacing              = 0;  
  179.         pInfo->iWantedOrientation   = 0;  
  180.         pInfo->iSetupOrientation    = 0;  
  181.         mEnumMap.add(deviceId, pInfo);  
  182.     }  
  183.     //  
  184.     i4DeviceNum = 1;  
  185.   
  186. #endif  
  187. //------------------------------------------------------------------------------  
  188.     //  
  189.     _profile.print("");  
  190.     return  i4DeviceNum;  
  191. }  

       

      函数pSensorHal->searchSensor()将调用SensorDrv::searchSensor(NULL)函数，该函数再调用ImgSensor_drv.cpp文件中中的ImgSensorDrv::impSearchSensor函数。

===>mediatek/platform/mt6582/hardware/mtkcam/core/drv/imgsensor/ImgSensor_drv.cpp

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * 
  3. ********************************************************************************/  
  4.   
  5. MINT32   
  6. ImgSensorDrv::impSearchSensor(pfExIdChk pExIdChkCbf)  
  7. {  
  8.     MUINT32 SensorEnum = (MUINT32) DUAL_CAMERA_MAIN_SENSOR;  
  9.     MUINT32 i,id[KDIMGSENSOR_MAX_INVOKE_DRIVERS] = {0,0};  
  10.     MBOOL SensorConnect=TRUE;  
  11.     UCHAR cBuf[64];  
  12.     MINT32 err = SENSOR_NO_ERROR;  
  13.     MINT32 err2 = SENSOR_NO_ERROR;  
  14.     ACDK_SENSOR_INFO_STRUCT SensorInfo;  
  15.     ACDK_SENSOR_CONFIG_STRUCT SensorConfigData;  
  16.     ACDK_SENSOR_RESOLUTION_INFO_STRUCT SensorResolution;  
  17.     MINT32 sensorDevs = SENSOR_NONE;  
  18.     IMAGE_SENSOR_TYPE sensorType = IMAGE_SENSOR_TYPE_UNKNOWN;  
  19.     IMGSENSOR_SOCKET_POSITION_ENUM socketPos = IMGSENSOR_SOCKET_POS_NONE;  
  20.   
  21.   
  22.     //! If imp sensor search process already done before,   
  23.     //! only need to return the sensorDevs, not need to   
  24.     //! search again.   
  25.     if (SENSOR_DOES_NOT_EXIST != m_mainSensorId) {  
  26.         //been processed.  
  27.         LOG_MSG("[impSearchSensor] Already processed  ");   
  28.         if (BAD_SENSOR_INDEX != m_mainSensorIdx) {  
  29.             sensorDevs |= SENSOR_MAIN;  
  30.         }  
  31.   
  32.         if (BAD_SENSOR_INDEX != m_subSensorIdx) {  
  33.             sensorDevs |= SENSOR_SUB;  
  34.         }  
  35.   
  36.         #ifdef  ATVCHIP_MTK_ENABLE  
  37.   
  38.             sensorDevs |= SENSOR_ATV;  
  39.   
  40.         #endif  
  41.   
  42.   
  43.         return sensorDevs;   
  44.     }  
  45.       
  46.     GetSensorInitFuncList(&m_pstSensorInitFunc);//----(1)获取hal层的sensor列表  
  47.   
  48.     LOG_MSG("SENSOR search start  ");  
  49.   
  50.     if (-1 != m_fdSensor) {  
  51.         ::close(m_fdSensor);  
  52.         m_fdSensor = -1;  
  53.     }  
  54.     sprintf(cBuf,"/dev/%s",CAMERA_HW_DEVNAME);  
  55.     m_fdSensor = ::open(cBuf, O_RDWR);  
  56.     if (m_fdSensor < 0) {  
  57.          LOG_ERR("[impSearchSensor]: error opening %s: %s  ", cBuf, strerror(errno));   
  58.         return sensorDevs;  
  59.     }  
  60.     LOG_MSG("[impSearchSensor] m_fdSensor = %d   ", m_fdSensor);  
  61.   
  62.     // search main/main_2/sub 3 sockets  
  63.    #ifdef MTK_SUB_IMGSENSOR   
  64.     for (SensorEnum = DUAL_CAMERA_MAIN_SENSOR; SensorEnum <= DUAL_CAMERA_SUB_SENSOR; SensorEnum <<= 1)  {  
  65.         LOG_MSG("impSearchSensor search to sub ");  
  66.    #else  
  67.     for (SensorEnum = DUAL_CAMERA_MAIN_SENSOR; SensorEnum < DUAL_CAMERA_SUB_SENSOR; SensorEnum <<= 1)  {  
  68.         LOG_MSG("impSearchSensor search to main ");     
  69.    #endif       
  70.         //skip atv case  
  71.         if ( 0x04 == SensorEnum ) continue;  
  72.         //  
  73.         for (i = 0; i < MAX_NUM_OF_SUPPORT_SENSOR; i++) {  
  74.             //end of driver list  
  75.             if (m_pstSensorInitFunc[i].getCameraDefault == NULL) {  
  76.                 LOG_MSG("m_pstSensorInitFunc[i].getCameraDefault is NULL: %d  ", i);                  
  77.                 break;  
  78.             }  
  79.                 //set sensor driver  
  80.             id[KDIMGSENSOR_INVOKE_DRIVER_0] = (SensorEnum << KDIMGSENSOR_DUAL_SHIFT) | i;  
  81.             LOG_MSG("set sensor driver id =%x ", id[KDIMGSENSOR_INVOKE_DRIVER_0]);   
  82.             err = ioctl(m_fdSensor, KDIMGSENSORIOC_X_SET_DRIVER,&id[KDIMGSENSOR_INVOKE_DRIVER_0] );//--(2)调用kernel层的kdSetDriver函数  
  83.                 if (err < 0) {  
  84.                     LOG_ERR("ERROR:KDCAMERAHWIOC_X_SET_DRIVER ");  
  85.                 }  
  86.   
  87.              
  88.   
  89.                 //err = open();  
  90.                 err = ioctl(m_fdSensor, KDIMGSENSORIOC_T_CHECK_IS_ALIVE);//---(3)上下电camera并读取sensor的ID，如果匹配则成功  
  91.                   
  92.   
  93.                   
  94.                 if (err < 0) {  
  95.                     LOG_MSG("[impSearchSensor] Err-ctrlCode (%s)  ", strerror(errno));//  
  96.                 }  
  97.             //  
  98.             sensorType = this->getCurrentSensorType((SENSOR_DEV_ENUM)SensorEnum);  
  99.             //  
  100.             socketPos = this->getSocketPosition((CAMERA_DUAL_CAMERA_SENSOR_ENUM)SensorEnum);  
  101.                 //check extra ID , from EEPROM maybe  
  102.                 //may need to keep power here  
  103.                 if (NULL != pExIdChkCbf) {  
  104.                     err2 = pExIdChkCbf();  
  105.                     if (err2 < 0) {  
  106.                         LOG_ERR("Error:pExIdChkCbf()  ");  
  107.                     }  
  108.                 }  
  109.   
  110.                 //power off sensor  
  111.                 close();  
  112.   
  113.                 if (err < 0 || err2 < 0) {  
  114.                     LOG_MSG("sensor ID mismatch ");  
  115.                 }  
  116.                 else {  
  117.                     if (SensorEnum == DUAL_CAMERA_MAIN_SENSOR) {  
  118.                 //m_mainSensorIdx = i;  
  119.                 //m_mainSensorId = m_pstSensorInitFunc[m_mainSensorIdx].SensorId;  
  120.                 m_mainSensorDrv.index[m_mainSensorDrv.number] = i;  
  121.                 m_mainSensorDrv.type[m_mainSensorDrv.number] = sensorType;  
  122.                 if ( IMAGE_SENSOR_TYPE_RAW == sensorType && BAD_SENSOR_INDEX == m_mainSensorDrv.firstRawIndex ) {  
  123.                     m_mainSensorDrv.firstRawIndex = i;  
  124.                 }  
  125.                 else if ( IMAGE_SENSOR_TYPE_YUV == sensorType && BAD_SENSOR_INDEX == m_mainSensorDrv.firstYuvIndex ) {  
  126.                     m_mainSensorDrv.firstYuvIndex = i;  
  127.                 }  
  128.                 m_mainSensorDrv.position = socketPos;  
  129.                 m_mainSensorDrv.sensorID = m_pstSensorInitFunc[m_mainSensorDrv.index[m_mainSensorDrv.number]].SensorId;  
  130.                 // LOG_MSG("MAIN sensor m_mainSensorDrv.number=%d, m_mainSensorDrv.index=%d ",m_mainSensorDrv.number,m_mainSensorDrv.index[m_mainSensorDrv.number]);  
  131.                 m_mainSensorDrv.number++;  
  132.                 //  
  133.                 m_pMainSensorInfo = m_pstSensorInitFunc[i].pSensorInfo;  
  134.                 if  ( m_pMainSensorInfo )  
  135.                 {  
  136.                     NSFeature::SensorInfoBase* pSensorInfo = m_pstSensorInitFunc[i].pSensorInfo;  
  137.                     LOG_MSG("found <%#x/%s/%s>", pSensorInfo->GetID(), pSensorInfo->getDrvName(), pSensorInfo->getDrvMacroName());  
  138.                 }  
  139.                 else  
  140.                 {  
  141.                     LOG_WRN("m_pMainSensorInfo==NULL ");  
  142.                 }  
  143.                 LOG_MSG("MAIN sensor found:[%d]/[0x%x]/[%d]/[%d]  ",i,id[KDIMGSENSOR_INVOKE_DRIVER_0],sensorType,socketPos);  
  144.                 //break;  
  145.             }  
  146.             else if (SensorEnum == DUAL_CAMERA_SUB_SENSOR) {  
  147.                 //m_subSensorIdx = i;  
  148.                 //m_subSensorId = m_pstSensorInitFunc[m_subSensorIdx].SensorId;  
  149.                 m_subSensorDrv.index[m_subSensorDrv.number] = i;  
  150.                 m_subSensorDrv.type[m_subSensorDrv.number] = sensorType;  
  151.                 if ( IMAGE_SENSOR_TYPE_RAW == sensorType && BAD_SENSOR_INDEX == m_subSensorDrv.firstRawIndex ) {  
  152.                     m_subSensorDrv.firstRawIndex = i;  
  153.                 }  
  154.                 else if ( IMAGE_SENSOR_TYPE_YUV == sensorType && BAD_SENSOR_INDEX == m_subSensorDrv.firstYuvIndex ) {  
  155.                     m_subSensorDrv.firstYuvIndex = i;  
  156.                 }  
  157.                 m_subSensorDrv.position = socketPos;  
  158.                 m_subSensorDrv.sensorID = m_pstSensorInitFunc[m_subSensorDrv.index[m_subSensorDrv.number]].SensorId;  
  159.                 //LOG_MSG("SUB sensor m_subSensorDrv.number=%d, m_subSensorDrv.index=%d ",m_subSensorDrv.number,m_subSensorDrv.index[m_subSensorDrv.number]);  
  160.                 m_subSensorDrv.number++;  
  161.                 //  
  162.                 m_pSubSensorInfo = m_pstSensorInitFunc[i].pSensorInfo;  
  163.                 if  ( m_pSubSensorInfo )  
  164.                 {  
  165.                     NSFeature::SensorInfoBase* pSensorInfo = m_pstSensorInitFunc[i].pSensorInfo;  
  166.                     LOG_MSG("found <%#x/%s/%s>", pSensorInfo->GetID(), pSensorInfo->getDrvName(), pSensorInfo->getDrvMacroName());  
  167.                 }  
  168.                 else  
  169.                 {  
  170.                     LOG_WRN("m_pSubSensorInfo==NULL ");  
  171.                 }  
  172.                 LOG_MSG("SUB sensor found:[%d]/[0x%x]/[%d]/[%d]  ",i,id[KDIMGSENSOR_INVOKE_DRIVER_0],sensorType,socketPos);  
  173.                 //break;  
  174.             }  
  175.         }//  
  176.           
  177.         }  
  178.     }  
  179.     //close system call may be off sensor power. check first!!!  
  180.     ::close(m_fdSensor);  
  181.     m_fdSensor = -1;  
  182.     //  
  183.     if (BAD_SENSOR_INDEX != m_mainSensorDrv.index[0]) {  
  184.         m_mainSensorId = m_mainSensorDrv.sensorID;  
  185.         //init to choose first  
  186.         m_mainSensorIdx = m_mainSensorDrv.index[0];  
  187.         sensorDevs |= SENSOR_MAIN;  
  188.     }  
  189.   
  190.     if (BAD_SENSOR_INDEX != m_subSensorDrv.index[0]) {  
  191.         m_subSensorId = m_subSensorDrv.sensorID;  
  192.         //init to choose first  
  193.         m_subSensorIdx = m_subSensorDrv.index[0];  
  194.         sensorDevs |= SENSOR_SUB;  
  195.     }  
  196.   
  197.     #ifdef  ATVCHIP_MTK_ENABLE  
  198.       
  199.         sensorDevs |= SENSOR_ATV;  
  200.       
  201.     #endif  
  202.   
  203.   
  204.     if (sensorDevs == SENSOR_NONE) {  
  205.         LOG_ERR( "Error No sensor found!!  ");  
  206.     }  
  207.     //  
  208.     LOG_MSG("SENSOR search end: 0x%x /[0x%x][%d]/[0x%x][%d] ", sensorDevs,  
  209.     m_mainSensorId,m_mainSensorIdx,m_subSensorId,m_subSensorIdx);  
  210.   
  211.     return sensorDevs;  
  212. }//  

(1)、获取hal层sensor列表GetSensorInitFuncList(&m_pstSensorInitFunc);

===>mediatek/custom/common/hal/imgsensor/src/sensorlist.cpp

[cpp] view plaincopy
 
  1. UINT32 GetSensorInitFuncList(MSDK_SENSOR_INIT_FUNCTION_STRUCT **ppSensorList)  
  2. {  
  3.     if (NULL == ppSensorList) {  
  4.         ALOGE("ERROR: NULL pSensorList ");  
  5.         return MHAL_UNKNOWN_ERROR;  
  6.     }  
  7.     *ppSensorList = &SensorList[0];//这里直接调用hal层的sensor列表  
  8.     return MHAL_NO_ERROR;  
  9. } // GetSensorInitFuncList()  

===>mediatek/custom/common/hal/imgsensor/src/sensorlist.cpp

[cpp] view plaincopy
 
  1. MSDK_SENSOR_INIT_FUNCTION_STRUCT SensorList[] =  
  2. {  
  3.     //add by zym  
  4. #if defined(GC2235_MIPI_RAW)  
  5.     RAW_INFO(GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, NULL),   
  6. #endif  
  7. // add by zhouzuoyu  
  8. #if defined(GC2235_KOTECH_MIPI_RAW)  
  9.     RAW_INFO(GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, NULL),   
  10. #endif  
  11. #if defined(OV16825_MIPI_RAW)  
  12.     RAW_INFO(OV16825MIPI_SENSOR_ID, SENSOR_DRVNAME_OV16825_MIPI_RAW,NULL),   
  13. #endif  
  14. #if defined(IMX135_MIPI_RAW)  
  15.         RAW_INFO(IMX135_SENSOR_ID, SENSOR_DRVNAME_IMX135_MIPI_RAW,NULL),   
  16. #endif  
  17. #if defined(OV8830_RAW)  
  18.     RAW_INFO(OV8830_SENSOR_ID, SENSOR_DRVNAME_OV8830_RAW, NULL),  
  19. #endif  
  20.   
  21. /*  ADD sensor driver before this line */  
  22.     {0,{0},NULL, NULL, NULL}//end of list  
  23. };   

(2)、获取kernel层的kdSetDriver函数err = ioctl(m_fdSensor, KDIMGSENSORIOC_X_SET_DRIVER,&id[KDIMGSENSOR_INVOKE_DRIVER_0] );

===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.c

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * kdSetDriver 
  3. ********************************************************************************/  
  4. int kdSetDriver(unsigned int* pDrvIndex)  
  5. {  
  6.     ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT *pSensorList = NULL;  
  7.     u32 drvIdx[KDIMGSENSOR_MAX_INVOKE_DRIVERS] = {0,0};  
  8.     u32 i;  
  9.   
  10.     PK_XLOG_INFO("pDrvIndex:0x%08x/0x%08x  ",pDrvIndex[KDIMGSENSOR_INVOKE_DRIVER_0],pDrvIndex[KDIMGSENSOR_INVOKE_DRIVER_1]);  
  11.     //set driver for MAIN or SUB sensor  
  12.   
  13.     if (0 != kdGetSensorInitFuncList(&pSensorList))//----（2.1）获取kernel层的sensor列表  
  14.     {  
  15.         PK_ERR("ERROR:kdGetSensorInitFuncList() ");  
  16.         return -EIO;  
  17.     }  
  18.   
  19.     for ( i = KDIMGSENSOR_INVOKE_DRIVER_0; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {  
  20.         //  
  21.         spin_lock(&kdsensor_drv_lock);  
  22.         g_bEnableDriver[i] = FALSE;  
  23.         g_invokeSocketIdx[i] = (CAMERA_DUAL_CAMERA_SENSOR_ENUM)((pDrvIndex[i] & KDIMGSENSOR_DUAL_MASK_MSB)>>KDIMGSENSOR_DUAL_SHIFT);  
  24.     spin_unlock(&kdsensor_drv_lock);  
  25.   
  26.         drvIdx[i] = (pDrvIndex[i] & KDIMGSENSOR_DUAL_MASK_LSB);//----（2.2）g_invokeSocketIdx，drvIdx解释  
  27.         //  
  28.         if ( DUAL_CAMERA_NONE_SENSOR == g_invokeSocketIdx[i] ) { continue; }  
  29.   
  30.   
  31.         //ToDo: remove print information  
  32.         PK_XLOG_INFO("[kdSetDriver] i,g_invokeSocketIdx[%d] = %d : ",i,i,drvIdx[i]);  
  33.         PK_XLOG_INFO("[kdSetDriver] i,drvIdx[%d] = %d : ",i,i,drvIdx[i]);  
  34.         //  
  35.         if ( MAX_NUM_OF_SUPPORT_SENSOR > drvIdx[i] ) {  
  36.             if (NULL == pSensorList[drvIdx[i]].SensorInit) {  
  37.                 PK_ERR("ERROR:kdSetDriver() ");  
  38.                 return -EIO;  
  39.             }  
  40.   
  41.             pSensorList[drvIdx[i]].SensorInit(&g_pInvokeSensorFunc[i]);//----（2.3）获取指定sensor的fun函数，例如ov5670的func  
  42.             if (NULL == g_pInvokeSensorFunc[i]) {  
  43.                 PK_ERR("ERROR:NULL g_pSensorFunc[%d] ",i);  
  44.             return -EIO;  
  45.             }  
  46.             //  
  47.             spin_lock(&kdsensor_drv_lock);  
  48.             g_bEnableDriver[i] = TRUE;  
  49.             spin_unlock(&kdsensor_drv_lock);  
  50.             //get sensor name  
  51.             memcpy((char*)g_invokeSensorNameStr[i],(char*)pSensorList[drvIdx[i]].drvname,sizeof(pSensorList[drvIdx[i]].drvname));  
  52.             //return sensor ID  
  53.             //pDrvIndex[0] = (unsigned int)pSensorList[drvIdx].SensorId;  
  54.             PK_XLOG_INFO("[kdSetDriver] :[%d][%d][%d][%s][%d] ",i,g_bEnableDriver[i],g_invokeSocketIdx[i],g_invokeSensorNameStr[i],sizeof(pSensorList[drvIdx[i]].drvname));  
  55.         }  
  56.     }  
  57.     return 0;  
  58. }  

（2.1）获取kernel层的sensor列表kdGetSensorInitFuncList(&pSensorList)

===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.c

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * general camera image sensor kernel driver 
  3. *******************************************************************************/  
  4. UINT32 kdGetSensorInitFuncList(ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT **ppSensorList)  
  5. {  
  6.     if (NULL == ppSensorList)  
  7.     {  
  8.         PK_DBG("[kdGetSensorInitFuncList]ERROR: NULL ppSensorList ");  
  9.         return 1;  
  10.     }  
  11.     *ppSensorList = &kdSensorList[0];  
  12.     return 0;  
  13. } // kdGetSensorInitFuncList()  

===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.h

       hal层和kernel层的sensor列表顺序必须保持一致

[cpp] view plaincopy
 
  1. ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT kdSensorList[MAX_NUM_OF_SUPPORT_SENSOR+1] =  
  2. {  
  3. //add by zym  
  4. #if defined(GC2235_MIPI_RAW)  
  5.     {GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, GC2235MIPISensorInit},   
  6. #endif  
  7.   
  8. // add by zhouzuoyu  
  9. #if defined(GC2235_KOTECH_MIPI_RAW)  
  10.     {GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, GC2235MIPISensorInit},   
  11. #endif  
  12.   
  13. #if defined(OV16825_MIPI_RAW)  
  14.         {OV16825MIPI_SENSOR_ID, SENSOR_DRVNAME_OV16825_MIPI_RAW, OV16825MIPISensorInit},   
  15. #endif  
  16. #if defined(IMX135_MIPI_RAW)  
  17.         {IMX135_SENSOR_ID, SENSOR_DRVNAME_IMX135_MIPI_RAW, IMX135_MIPI_RAW_SensorInit},   
  18. #endif  
  19. #if defined(OV8830_RAW)  
  20.     {OV8830_SENSOR_ID, SENSOR_DRVNAME_OV8830_RAW, OV8830SensorInit},   
  21. #endif  
  22. /*  ADD sensor driver before this line */  
  23.     {0,{0},NULL}, //end of list  
  24. };  
  25. //e_add new sensor driver here<span style="font-size:18px;"><span style="font-size:18px;">         </span>   </span>   <span style="font-size:18px;"><span style="font-size:18px;">  
  26. </span></span>  

（2.2）g_invokeSocketIdx，drvIdx解释

      上层传下来的 id 参数解析成两部分 g_invokeSocketIdx 区分目前正在匹配的是 main 还是sub，drvIdx 是 sensor 列表的序列号 。

（2.3）获取指定sensor的func函数，例如ov5670的func，pSensorList[drvIdx[i]].SensorInit(&g_pInvokeSensorFunc[i]);

         调用的函数是OV5670_MIPI_RAW_SensorInit()。

[cpp] view plaincopy
 
  1. #if defined(OV5670_MIPI_RAW)  
  2.     {OV5670_SENSOR_ID, SENSOR_DRVNAME_OV5670_MIPI_RAW, OV5670_MIPI_RAW_SensorInit},   
  3. #endif  

            

===>mediatek/custom/common/kernel/imgsensor/ov5670_mipi_raw/ov5670mipiraw_Sensor.c

[cpp] view plaincopy
 
  1. SENSOR_FUNCTION_STRUCT  SensorFuncOV5670=  
  2. {  
  3.     OV5670Open,  
  4.     OV5670GetInfo,  
  5.     OV5670GetResolution,  
  6.     OV5670FeatureControl,  
  7.     OV5670Control,  
  8.     OV5670Close  
  9. };  
  10.   
  11. UINT32 OV5670_MIPI_RAW_SensorInit(PSENSOR_FUNCTION_STRUCT *pfFunc)//---调用此函数  
  12. {  
  13.     if (pfFunc!=NULL)  
  14.         *pfFunc=&SensorFuncOV5670;  
  15.   
  16.     return ERROR_NONE;  
  17. }  

          5670的sensorinit实现，主要是未了pfFunc这个函数指针的结构体指针赋值，这样我们就实现了驱动代码的分离，hal层只需要调用sensorlist.c这样一个虚拟设备的驱动，就可以和具体的Sensor Driver驱动通信。这样的做法与platform driver的设计思想差不多，在tp，lcm等驱动中也有体现。

（3）上下电camera并读取ID，err = ioctl(m_fdSensor, KDIMGSENSORIOC_T_CHECK_IS_ALIVE);

===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.c

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * adopt_CAMERA_HW_CheckIsAlive 
  3. ********************************************************************************/  
  4. inline static int adopt_CAMERA_HW_CheckIsAlive(void)  
  5. {  
  6.     UINT32 err = 0;  
  7.     UINT32 err1 = 0;  
  8.     UINT32 i = 0;  
  9.     MUINT32 sensorID = 0;  
  10.     MUINT32 retLen = 0;  
  11.   
  12.   
  13.     KD_IMGSENSOR_PROFILE_INIT();  
  14.     //power on sensor  
  15.     kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr,true, CAMERA_HW_DRVNAME1);//----（3.1）sensor上电  
  16.     //wait for power stable  
  17.     mDELAY(10);  
  18.     KD_IMGSENSOR_PROFILE("kdModulePowerOn");  
  19.   
  20.     if (g_pSensorFunc) {  
  21.         for ( i = KDIMGSENSOR_INVOKE_DRIVER_0 ; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {  
  22.             if(DUAL_CAMERA_NONE_SENSOR != g_invokeSocketIdx[i]){  
  23.                 err = g_pSensorFunc->SensorFeatureControl(g_invokeSocketIdx[i], SENSOR_FEATURE_CHECK_SENSOR_ID, (MUINT8*)&sensorID, &retLen);//---（3.2）获取sensor ID  
  24.                 if (sensorID == 0) {    //not implement this feature ID  
  25.                     PK_DBG(" Not implement!!, use old open function to check ");  
  26.                     err = ERROR_SENSOR_CONNECT_FAIL;  
  27.                 }  
  28.                 else if (sensorID == 0xFFFFFFFF) {    //fail to open the sensor  
  29.                     PK_DBG(" No Sensor Found");  
  30.                     err = ERROR_SENSOR_CONNECT_FAIL;  
  31.                 }  
  32.                 else {  
  33.   
  34.                     PK_DBG(" Sensor found ID = 0x%x ", sensorID);  
  35.                     err = ERROR_NONE;  
  36.                 }  
  37.                 if(ERROR_NONE != err)  
  38.                 {  
  39.                     PK_DBG("ERROR:adopt_CAMERA_HW_CheckIsAlive(), No imgsensor alive  ");  
  40.                 }  
  41.             }  
  42.         }  
  43.     }  
  44.     else {  
  45.         PK_DBG("ERROR:NULL g_pSensorFunc ");  
  46.     }  
  47.   
  48.     //reset sensor state after power off  
  49.     err1 = g_pSensorFunc->SensorClose();  
  50.     if(ERROR_NONE != err1) {  
  51.         PK_DBG("SensorClose  ");  
  52.     }  
  53.     //  
  54.     kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr, false, CAMERA_HW_DRVNAME1);      
  55.     //  
  56.     KD_IMGSENSOR_PROFILE("CheckIsAlive");  
  57.   
  58.     return err?-EIO:err;  
  59. }   /* adopt_CAMERA_HW_Open() */  


(3.1)Sensor 上电， kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr,true, CAMERA_HW_DRVNAME1);

[cpp] view plaincopy
 
  1. /******************************************************************************* 
  2. * kdModulePowerOn 
  3. ********************************************************************************/  
  4. int  
  5. kdModulePowerOn(  
  6. CAMERA_DUAL_CAMERA_SENSOR_ENUM socketIdx[KDIMGSENSOR_MAX_INVOKE_DRIVERS],  
  7. char sensorNameStr[KDIMGSENSOR_MAX_INVOKE_DRIVERS][32],  
  8. BOOL On,  
  9. char* mode_name )  
  10. {  
  11. MINT32 ret = ERROR_NONE;  
  12. u32 i = 0;  
  13.   
  14.     for ( i = KDIMGSENSOR_INVOKE_DRIVER_0 ; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {  
  15.         if ( g_bEnableDriver[i] ) {  
  16.             //PK_XLOG_INFO("[%s][%d][%d][%s][%s] ",__FUNCTION__,g_bEnableDriver[i],socketIdx[i],sensorNameStr[i],mode_name);  
  17.             ret = kdCISModulePowerOn(socketIdx[i],sensorNameStr[i],On,mode_name);//实际上电的func  
  18.             if ( ERROR_NONE != ret ) {  
  19.                 PK_ERR("[%s]",__FUNCTION__);  
  20.                 return ret;  
  21.             }  
  22.         }  
  23.     }  
  24.     return ERROR_NONE;  
  25. }  


===>mediatek/custom/huaqin82_slwt_2s_td/kernel/camera/camera/kd_camera_hw.c

[cpp] view plaincopy
 
  1. int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx, char *currSensorName, BOOL On, char* mode_name)  
  2. {  
  3.     PK_DBG("[camera] **kdCISModulePowerOn:SensorIdx:%d,pinSetIdx:%d",SensorIdx,pinSetIdx);  
  4.     //dump_stack();  
  5.     if (DUAL_CAMERA_MAIN_SENSOR == SensorIdx){  
  6.     if (currSensorName &&   
  7.        ((0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))  
  8.        ||(0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName))  
  9.        ||(0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName))  
  10.           ||(0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))  
  11.         ||(0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName))  
  12.         ||(0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName))  
  13.       ||(0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName))  
  14.        ||(0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName))  
  15.         || (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))  
  16.         || (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))  
  17.        ||(0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName))  
  18.         ||(0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))  
  19.               ||(0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName))  
  20.         ||(0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))  
  21.         ||(0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV, currSensorName))  
  22.         || (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV, currSensorName))  
  23.         ||(0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW, currSensorName))  
  24.         ||(0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName))  
  25.         ||(0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName))  
  26.         //|| to add other main camera here  
  27.        ))  
  28.             pinSetIdx = 0;  
  29.     else  
  30.     {  
  31.         PK_DBG("[ryf-main]kdCISModulePowerOn get in---  sensorIdx not compare with sensor name: %s ", currSensorName);  
  32.         //if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName)))  
  33.         //{  
  34.         //      pinSetIdx = 1;  
  35.         //}  
  36.         //else{  
  37.             goto _kdCISModulePowerOn_exit_;  
  38.         //}  
  39.     }  
  40.     }  
  41.     else if (DUAL_CAMERA_SUB_SENSOR == SensorIdx) {  
  42.     if (currSensorName &&   
  43.         ((0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName))  
  44.         || (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName))  
  45.         || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW, currSensorName))  
  46.           || (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName))  
  47.           || (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName))     
  48.          || (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName))   
  49.           || (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName))   
  50.         || (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))  
  51.         || (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))  
  52.         ||(0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))  
  53.         ||(0 == strcmp(SENSOR_DRVNAME_GC0312_YUV, currSensorName))  
  54.         ||(0 == strcmp(SENSOR_DRVNAME_HI704_YUV, currSensorName))  
  55.               //||(0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV, currSensorName))  
  56.         //|| to add other sub camera here  
  57.        ))  
  58.             pinSetIdx = 1;  
  59.     else  
  60.     {  
  61.         //if (currSensorName &&  
  62.            //((0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))  
  63.             //|| to add other main camera here  
  64.            //))  
  65.         //{  
  66.         //  pinSetIdx = 0;  
  67.         //}  
  68.         PK_DBG("{ryf-sub}kdCISModulePowerOn get in---  sensorIdx not compare with sensro:%s ",currSensorName);  
  69.         goto _kdCISModulePowerOn_exit_;  
  70.     }  
  71.     }  
  72.     else if (DUAL_CAMERA_MAIN_2_SENSOR == SensorIdx) {  
  73.        // pinSetIdx = 2;  
  74.     }  
  75.   
  76.     PK_DBG("kdCISModulePowerOn:SensorIdx:%d,pinSetIdx:%d",SensorIdx,pinSetIdx);  
  77.     Rst_PDN_Init();  
  78.   
  79.     //power ON  
  80.     if (On)   
  81.     {  
  82.      PK_DBG("kdCISModulePowerOn -on:currSensorName=%s ",currSensorName);  
  83.         if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))) {  
  84.             PK_DBG("is ov5648mipi on ");  
  85.             if (0 == pinSetIdx) {  
  86.                 if (TRUE != kd_ov5648_main_poweron(mode_name))  
  87.                     goto _kdCISModulePowerOn_exit_;  
  88.             } else if (1 == pinSetIdx) {  
  89.                 if (TRUE != kd_ov5648_sub_poweron(mode_name))  
  90.                     goto _kdCISModulePowerOn_exit_;  
  91.             }  
  92.         }   
  93.     else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName)))             
  94.         {  
  95.         PK_DBG("is s5k4e1ga on  ");  
  96.             if(TRUE != kd_s5k4e1gamipi_poweron(mode_name))  
  97.                  goto _kdCISModulePowerOn_exit_;  
  98.         }   
  99.     else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName)))            
  100.         {  
  101.         PK_DBG("is hi544 on  ");  
  102.             if(TRUE != kd_hi544raw_poweron(mode_name))  
  103.                  goto _kdCISModulePowerOn_exit_;  
  104.         }   
  105.        else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName)))            
  106.         {  
  107.          PK_DBG("is gc2235 on ");  
  108.             if(TRUE != kd_gc2235mipiraw_poweron(mode_name))  
  109.                  goto _kdCISModulePowerOn_exit_;  
  110.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))) {  
  111.             PK_DBG("is gc2235_raw on ");  
  112.               
  113.             if (TRUE != kd_gc2235raw_poweron(mode_name))  
  114.                  goto _kdCISModulePowerOn_exit_;  
  115.         }    
  116. /*  else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI253_YUV,currSensorName))) 
  117.         { 
  118.          PK_DBG("is hi253 on "); 
  119.             if(TRUE != kd_hi253yuv_poweron(mode_name)) 
  120.                  goto _kdCISModulePowerOn_exit_; 
  121.         }*/  
  122.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName))) {    
  123.         PK_DBG("is ov88251 on  ");   
  124.         if(TRUE != kd_ov88251mipiraw_poweron(mode_name))      
  125.                 goto _kdCISModulePowerOn_exit_;  
  126.         }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName))) {   
  127.         PK_DBG("is ov88252 on  ");   
  128.         if(TRUE != kd_ov88252mipiraw_poweron(mode_name))      
  129.                 goto _kdCISModulePowerOn_exit_;  
  130.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))) {  
  131.             PK_DBG("is ov8858 on  ");  
  132.             kd_a5142mipiraw_sub_poweron(mode_name);  
  133.             kd_a5142mipiraw_sub_powerdown(mode_name);  
  134.             if(TRUE != kd_ov8858mipiraw_poweron(mode_name))   
  135.                 goto _kdCISModulePowerOn_exit_;  
  136.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW,currSensorName))) {  
  137.             PK_DBG("is s5k4h5yx on  ");  
  138.             kd_a5142mipiraw_sub_poweron(mode_name);  
  139.             kd_a5142mipiraw_sub_powerdown(mode_name);  
  140.             if (TRUE != kd_s5k4h5yxmipiraw_poweron(mode_name))    
  141.                 goto _kdCISModulePowerOn_exit_;  
  142.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))) {  
  143.             PK_DBG("is t4k35 on  ");     
  144.             if(TRUE != kd_t4k35mipiraw_poweron(mode_name))    
  145.                 goto _kdCISModulePowerOn_exit_;  
  146.         } else if (currSensorName && ((0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))   
  147.         || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName)))) {  
  148.             if(pinSetIdx==0)  
  149.             {  
  150.                 if(TRUE != kd_s5k3h7ymipiraw_poweron(mode_name))  
  151.                     goto _kdCISModulePowerOn_exit_;  
  152.             }  
  153.             else  
  154.             {  
  155.                 if(TRUE != kd_s5k3h72ymipiraw_poweron(mode_name))  
  156.                     goto _kdCISModulePowerOn_exit_;  
  157.             }  
  158.         } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName))) {  
  159.          PK_DBG("is gc2035 on ");  
  160.             if(TRUE != kd_gc2035_poweron(mode_name))  
  161.                  goto _kdCISModulePowerOn_exit_;  
  162.         }   
  163.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName)))  
  164.         {  
  165.             if(TRUE != kd_ov5648a_poweron(mode_name))  
  166.                  goto _kdCISModulePowerOn_exit_;  
  167.         }  
  168.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName)))  
  169.         {  
  170.             if(TRUE != kd_ov5670_poweron(mode_name))  
  171.                  goto _kdCISModulePowerOn_exit_;  
  172.         }  
  173.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName)))  
  174.         {  
  175.             if(TRUE != kd_hi551_poweron(mode_name))  
  176.                  goto _kdCISModulePowerOn_exit_;  
  177.         }  
  178.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName)))  
  179.         {  
  180.             if(TRUE != kd_ov5648b_poweron(mode_name))  
  181.                  goto _kdCISModulePowerOn_exit_;  
  182.         } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))) //lili add  
  183.         {  
  184.             if(TRUE != kd_ov5648_main_poweron(mode_name))  
  185.                  goto _kdCISModulePowerOn_exit_;  
  186.         } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName))) {  
  187.          PK_DBG("is s5k3h72ymipi on ");  
  188.             if(TRUE != kd_s5k3h72ymipiraw_poweron(mode_name))  
  189.                  goto _kdCISModulePowerOn_exit_;  
  190.         } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName)))              
  191.                 {  
  192.                    PK_DBG("is gc0329 on ");  
  193.                        if(TRUE != kd_gc0329_poweron(mode_name))  
  194.                                 goto _kdCISModulePowerOn_exit_;  
  195.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))) {  
  196.             if (0 == pinSetIdx) {  
  197.                 PK_DBG("is A5142 main on  ");  
  198.                 if(TRUE != kd_a5142mipiraw_main_poweron(mode_name))  
  199.                     goto _kdCISModulePowerOn_exit_;  
  200.             } else {  
  201.                 PK_DBG("is A5142 sub on  ");  
  202.                 if(TRUE != kd_a5142mipiraw_sub_poweron(mode_name))  
  203.                     goto _kdCISModulePowerOn_exit_;  
  204.             }  
  205.               
  206.            }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0312_YUV,currSensorName)))            
  207.                 {  
  208.                    PK_DBG("is gc0312 on ");    
  209.                        if(TRUE != kd_gc0312_poweron(mode_name))  
  210.                                 goto _kdCISModulePowerOn_exit_;  
  211.            }   
  212.            else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI704_YUV,currSensorName)))              
  213.                 {  
  214.                    PK_DBG("is hi704 on ");    
  215.                        if(TRUE != kd_hi704yuv_poweron(mode_name))  
  216.                                 goto _kdCISModulePowerOn_exit_;  
  217.            }   
  218.                else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV,currSensorName)))            
  219.                 {  
  220.                    PK_DBG("is gc0310 on ");  
  221.                        if(TRUE != kd_gc0310_poweron(mode_name))  
  222.                                 goto _kdCISModulePowerOn_exit_;  
  223.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV,currSensorName))) {  
  224.             PK_DBG("is gc2145 on ");  
  225.   
  226.             if (TRUE != kd_gc2145_poweron(mode_name))  
  227.                 goto _kdCISModulePowerOn_exit_;  
  228.         }  
  229.         else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName)))  
  230.         {     
  231.             PK_DBG("is hi258 on  ");   
  232.             if(TRUE != kd_hi258mipiraw_poweron(mode_name))  
  233.                 goto _kdCISModulePowerOn_exit_;  
  234.         }  
  235.          else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName))) {  
  236.             PK_DBG("is ov2680 on  ");    
  237.             if(TRUE != kd_ov2680mipiraw_poweron(mode_name))   
  238.                 goto _kdCISModulePowerOn_exit_;  
  239.         }  
  240.     else   
  241.     {  
  242.         PK_DBG("kdCISModulePowerOn get in---  other , please add the power on code!!!!!! ");  
  243.         goto _kdCISModulePowerOn_exit_;  
  244.         }  
  245.   }  
  246.   else {//power OFF  
  247.   
  248.     PK_DBG("kdCISModulePowerOn -off:currSensorName=%s ",currSensorName);  
  249.   
  250.   
  251.      if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName)))           
  252.         {  
  253.             PK_DBG("is ov5648_mipi_raw down ");  
  254.             if (0 == pinSetIdx) {  
  255.                 if(TRUE != kd_ov5648_main_powerdown(mode_name))  
  256.                     goto _kdCISModulePowerOn_exit_;  
  257.             } else if (1 == pinSetIdx) {  
  258.                 if(TRUE != kd_ov5648_sub_powerdown(mode_name))  
  259.                     goto _kdCISModulePowerOn_exit_;  
  260.             }  
  261.         } else  if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName)))              
  262.         {  
  263.          PK_DBG("is s5k4e1ga down ");  
  264.             if(TRUE != kd_s5k4e1gamipi_powerdown(mode_name))  
  265.                  goto _kdCISModulePowerOn_exit_;  
  266.         }  
  267.         else  if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName)))           
  268.         {  
  269.          PK_DBG("is hi544 down ");  
  270.             if(TRUE != kd_hi544raw_powerdown(mode_name))  
  271.                  goto _kdCISModulePowerOn_exit_;  
  272.         }  
  273.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName)))  
  274.         {  
  275.             PK_DBG("is ov88251 down ");  
  276.              if(TRUE != kd_ov88251mipiraw_powerdown(mode_name))  
  277.               goto _kdCISModulePowerOn_exit_;     
  278.           
  279.         }  
  280.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName)))  
  281.         {  
  282.             PK_DBG("is ov5670 down ");  
  283.              if(TRUE != kd_ov5670mipiraw_powerdown(mode_name))  
  284.               goto _kdCISModulePowerOn_exit_;     
  285.           
  286.         }  
  287.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName)))  
  288.         {  
  289.             PK_DBG("is hi551 down ");  
  290.              if(TRUE != kd_hi551mipiraw_powerdown(mode_name))  
  291.               goto _kdCISModulePowerOn_exit_;     
  292.           
  293.         }  
  294.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName)))  
  295.         {  
  296.             PK_DBG("is ov88252 down ");  
  297.              if(TRUE != kd_ov88252mipiraw_powerdown(mode_name))  
  298.               goto _kdCISModulePowerOn_exit_;             
  299.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))) {  
  300.             PK_DBG("is ov8858 down ");  
  301.             if(TRUE != kd_ov8858mipiraw_powerdown(mode_name))  
  302.                 goto _kdCISModulePowerOn_exit_;  
  303.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW, currSensorName))) {  
  304.             PK_DBG("is s5k4h5yx down ");  
  305.             if (TRUE != kd_s5k4h5yxmipiraw_powerdown(mode_name))  
  306.                 goto _kdCISModulePowerOn_exit_;  
  307.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))) {  
  308.             PK_DBG("is t4k35 down ");  
  309.             if(TRUE != kd_t4k35mipiraw_powerdown(mode_name))  
  310.                 goto _kdCISModulePowerOn_exit_;  
  311.         }  
  312.     else  if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName)))              
  313.         {  
  314.          PK_DBG("is gc2235 down ");  
  315.             if(TRUE != kd_gc2235mipiraw_powerdown(mode_name))  
  316.                  goto _kdCISModulePowerOn_exit_;  
  317.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))) {  
  318.             PK_DBG("is gc2235 down ");  
  319.               
  320.             if (TRUE != kd_gc2235raw_powerdown(mode_name))  
  321.                  goto _kdCISModulePowerOn_exit_;  
  322.         }  
  323. /*  else  if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI253_YUV,currSensorName))) 
  324.         { 
  325.          PK_DBG("is hi253 down "); 
  326.             if(TRUE != kd_hi253yuv_powerdown(mode_name)) 
  327.                  goto _kdCISModulePowerOn_exit_; 
  328.         }*/   
  329.         else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))) {  
  330.             if (0 == pinSetIdx) {  
  331.                 PK_DBG("is A5142 main down  ");  
  332.                 if (TRUE != kd_a5142mipiraw_main_powerdown(mode_name))  
  333.                 goto _kdCISModulePowerOn_exit_;  
  334.             } else {  
  335.                 PK_DBG("is A5142 sub down  ");  
  336.                 if (TRUE != kd_a5142mipiraw_sub_powerdown(mode_name))  
  337.                 goto _kdCISModulePowerOn_exit_;  
  338.             }  
  339.         } else if (currSensorName && ((0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))   
  340.         || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName))))      
  341.         {  
  342.                     PK_DBG("is s5k3h7 down ");  
  343.                 if(pinSetIdx==0)  
  344.                         {  
  345.                  if(TRUE != kd_s5k3h7ymipiraw_powerdown(mode_name))  
  346.                   goto _kdCISModulePowerOn_exit_;  
  347.                 }  
  348.                 else {  
  349.                 if(TRUE != kd_s5k3h72ymipiraw_powerdown(mode_name))  
  350.                           goto _kdCISModulePowerOn_exit_;  
  351.                 }  
  352.   
  353.         }  
  354.           else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName)))              
  355.         {  
  356.          PK_DBG("is gc2035 down ");  
  357.             if(TRUE != kd_gc2035_powerdown(mode_name))  
  358.                  goto _kdCISModulePowerOn_exit_;  
  359.         }  
  360.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName)))             
  361.         {  
  362.          PK_DBG("is s5k3h72y_mipi_raw down ");  
  363.             if(TRUE != kd_s5k3h72ymipiraw_powerdown(mode_name))  
  364.                  goto _kdCISModulePowerOn_exit_;  
  365.         }  
  366.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName)))  
  367.         {  
  368.             if(TRUE != kd_ov5648a_powerdown(mode_name))  
  369.                  goto _kdCISModulePowerOn_exit_;  
  370.         }  
  371.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName)))  
  372.         {  
  373.             if(TRUE != kd_ov5648b_powerdown(mode_name))  
  374.                  goto _kdCISModulePowerOn_exit_;  
  375.         }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))) //lili add  
  376.         {  
  377.             if(TRUE != kd_ov5648_main_powerdown(mode_name))  
  378.                  goto _kdCISModulePowerOn_exit_;  
  379.         }  
  380.       else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName)))              
  381.        {  
  382.                 PK_DBG("is gc0329 down ");  
  383.                     if(TRUE != kd_gc0329yuv_powerdown(mode_name))  
  384.                             goto _kdCISModulePowerOn_exit_;  
  385.         }   
  386.        else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0312_YUV,currSensorName)))             
  387.        {  
  388.                 PK_DBG("is gc0312 down ");  
  389.                     if(TRUE != kd_gc0312_powerdown(mode_name))  
  390.                             goto _kdCISModulePowerOn_exit_;  
  391.         }   
  392.           else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI704_YUV,currSensorName)))           
  393.        {  
  394.                 PK_DBG("is hi704 down ");  
  395.                     if(TRUE != kd_hi704yuv_powerdown(mode_name))  
  396.                             goto _kdCISModulePowerOn_exit_;  
  397.         }  
  398.           else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV,currSensorName)))             
  399.        {  
  400.                 PK_DBG("is gc0310 down ");  
  401.                     if(TRUE != kd_gc0310_powerdown(mode_name))  
  402.                             goto _kdCISModulePowerOn_exit_;  
  403.         } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV,currSensorName))) {  
  404.             PK_DBG("is gc2145 down ");  
  405.   
  406.             if (TRUE != kd_gc2145_powerdown(mode_name))  
  407.                 goto _kdCISModulePowerOn_exit_;  
  408.         }   
  409.         else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName)))  
  410.         {  
  411.             PK_DBG("is hi258 down ");  
  412.             if(TRUE != kd_hi258mipiraw_powerdown(mode_name))  
  413.                 goto _kdCISModulePowerOn_exit_;  
  414.     }  
  415.         else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName)))  
  416.          {  
  417.             PK_DBG("is ov2680 down ");  
  418.             if(TRUE != kd_ov2680mipiraw_powerdown(mode_name))  
  419.                 goto _kdCISModulePowerOn_exit_;  
  420.     }   
  421.     else   
  422.     {  
  423.         PK_DBG("kdCISModulePowerDown get in---  other , please add the power down code!!!!!! ");  
  424.         goto _kdCISModulePowerOn_exit_;  
  425.         }  
  426.   
  427.   }  
  428.     return 0;  
  429.   
  430. _kdCISModulePowerOn_exit_:  
  431.     return -EIO;  
  432. }  
  433. EXPORT_SYMBOL(kdCISModulePowerOn);  

以ov5670为例，其上电code如下：

[cpp] view plaincopy
 
  1. static int kd_ov5670_poweron( char *mode_name)  
  2. {  
  3.     int ret;  
  4.         printk("kd_ov5670_poweron1 start.. ");  
  5.   
  6.         ret = kd_poweron_main_devices(VOL_1800, VOL_2800, VOL_1200, VOL_2800, mode_name,0);//给camera上三路电  
  7.      PK_DBG("kd_ov88251mipiraw_poweron start.. ");  
  8.         mdelay(10);// wait power to be stable    
  9.         //disable_inactive_sensor();//disable inactive sensor  
  10.         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!!  ");}  
  11.         mdelay(10);  
  12.         if(mt_set_gpio_out(pinSet[0][IDX_PS_CMPDN],pinSet[0][IDX_PS_CMPDN+IDX_PS_ON])){PK_DBG("[CAMERA LENS] set gpio failed!!  ");}  
  13.         mdelay(1);  
  14.       
  15.     if(mt_set_gpio_out(pinSet[0][IDX_PS_CMRST],pinSet[0][IDX_PS_CMRST+IDX_PS_ON])){PK_DBG("[CAMERA SENSOR] set gpio failed!!  ");}  
  16.     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!!  ");}  
  17.     mdelay(10);  
  18.     if(mt_set_gpio_out(pinSet[0][IDX_PS_CMRST],pinSet[0][IDX_PS_CMRST+IDX_PS_ON])){PK_DBG("[CAMERA SENSOR] set gpio failed!!  ");}  
  19.     mdelay(5);  
  20. poweronerr:  
  21.     return ret;  
  22. }  


(3.2)获取sensor ID，err = g_pSensorFunc->SensorFeatureControl(g_invokeSocketIdx[i], SENSOR_FEATURE_CHECK_SENSOR_ID, (MUINT8*)&sensorID, &retLen);

       此函数调用具体sensor的func，例如ov5670，则调用的

[cpp] view plaincopy
 
  1. OV5670FeatureControl  

===>mediatek/custom/common/kernel/imgsensor/ov5670_mipi_raw

[cpp] view plaincopy
 
  1. UINT32 OV5670FeatureControl(MSDK_SENSOR_FEATURE_ENUM FeatureId,  
  2.                                                                 UINT8 *pFeaturePara,UINT32 *pFeatureParaLen)  
  3. {  
  4.     UINT16 *pFeatureReturnPara16=(UINT16 *) pFeaturePara;  
  5.     UINT16 *pFeatureData16=(UINT16 *) pFeaturePara;  
  6.     UINT32 *pFeatureReturnPara32=(UINT32 *) pFeaturePara;  
  7.     UINT32 *pFeatureData32=(UINT32 *) pFeaturePara;  
  8.     UINT32 SensorRegNumber;  
  9.     UINT32 i;  
  10.     PNVRAM_SENSOR_DATA_STRUCT pSensorDefaultData=(PNVRAM_SENSOR_DATA_STRUCT) pFeaturePara;  
  11.     MSDK_SENSOR_CONFIG_STRUCT *pSensorConfigData=(MSDK_SENSOR_CONFIG_STRUCT *) pFeaturePara;  
  12.     MSDK_SENSOR_REG_INFO_STRUCT *pSensorRegData=(MSDK_SENSOR_REG_INFO_STRUCT *) pFeaturePara;  
  13.     MSDK_SENSOR_GROUP_INFO_STRUCT *pSensorGroupInfo=(MSDK_SENSOR_GROUP_INFO_STRUCT *) pFeaturePara;  
  14.     MSDK_SENSOR_ITEM_INFO_STRUCT *pSensorItemInfo=(MSDK_SENSOR_ITEM_INFO_STRUCT *) pFeaturePara;  
  15.     MSDK_SENSOR_ENG_INFO_STRUCT *pSensorEngInfo=(MSDK_SENSOR_ENG_INFO_STRUCT *) pFeaturePara;  
  16.   
  17.     switch (FeatureId)  
  18.     {  
  19.         case SENSOR_FEATURE_GET_RESOLUTION:  
  20.             *pFeatureReturnPara16++= OV5670_IMAGE_SENSOR_FULL_WIDTH;  
  21.             *pFeatureReturnPara16= OV5670_IMAGE_SENSOR_FULL_HEIGHT;  
  22.             *pFeatureParaLen=4;  
  23.             break;  
  24.         case SENSOR_FEATURE_GET_PERIOD:  
  25.                                 *pFeatureReturnPara16++= OV5670_FeatureControl_PERIOD_PixelNum;  
  26.                                 *pFeatureReturnPara16= OV5670_FeatureControl_PERIOD_LineNum;  
  27.                                 *pFeatureParaLen=4;  
  28.                                 break;  
  29.         case SENSOR_FEATURE_GET_PIXEL_CLOCK_FREQ:  
  30.                         switch(OV5670CurrentScenarioId)  
  31.                         {  
  32.                                 case MSDK_SCENARIO_ID_CAMERA_PREVIEW:  
  33.                                         *pFeatureReturnPara32 = OV5670_PREVIEW_PCLK;  
  34.                                         *pFeatureParaLen=4;  
  35.                                         break;  
  36.                                 case MSDK_SCENARIO_ID_VIDEO_PREVIEW:  
  37.                                         *pFeatureReturnPara32 = OV5670_VIDEO_PCLK;  
  38.                                         *pFeatureParaLen=4;  
  39.                                         break;  
  40.                                 case MSDK_SCENARIO_ID_CAMERA_CAPTURE_JPEG:  
  41.                                 case MSDK_SCENARIO_ID_CAMERA_ZSD:  
  42.                                         *pFeatureReturnPara32 = OV5670_CAPTURE_PCLK;  
  43.                                         *pFeatureParaLen=4;  
  44.                                         break;  
  45.                                 default:  
  46.                                         *pFeatureReturnPara32 = OV5670_PREVIEW_PCLK;  
  47.                                         *pFeatureParaLen=4;  
  48.                                         break;  
  49.                         }  
  50.                     break;  
  51.   
  52.         case SENSOR_FEATURE_SET_ESHUTTER:  
  53.             OV5670_SetShutter(*pFeatureData16);  
  54.             break;  
  55.         case SENSOR_FEATURE_SET_NIGHTMODE:  
  56.             OV5670_NightMode((BOOL) *pFeatureData16);  
  57.             break;  
  58.         case SENSOR_FEATURE_SET_GAIN:  
  59.            OV5670_SetGain((UINT16) *pFeatureData16);  
  60.             break;  
  61.         case SENSOR_FEATURE_SET_FLASHLIGHT:  
  62.             break;  
  63.         case SENSOR_FEATURE_SET_ISP_MASTER_CLOCK_FREQ:  
  64.             //OV5670_isp_master_clock=*pFeatureData32;  
  65.             break;  
  66.         case SENSOR_FEATURE_SET_REGISTER:  
  67.             OV5670_write_cmos_sensor(pSensorRegData->RegAddr, pSensorRegData->RegData);  
  68.             break;  
  69.         case SENSOR_FEATURE_GET_REGISTER:  
  70.             pSensorRegData->RegData = OV5670_read_cmos_sensor(pSensorRegData->RegAddr);  
  71.             break;  
  72.         case SENSOR_FEATURE_SET_CCT_REGISTER:  
  73.             SensorRegNumber=FACTORY_END_ADDR;  
  74.             for (i=0;i<SensorRegNumber;i++)  
  75.             {  
  76.                 spin_lock(&ov5670mipiraw_drv_lock);  
  77.                 OV5670SensorCCT[i].Addr=*pFeatureData32++;  
  78.                 OV5670SensorCCT[i].Para=*pFeatureData32++;  
  79.                                 spin_unlock(&ov5670mipiraw_drv_lock);  
  80.             }  
  81.             break;  
  82.         case SENSOR_FEATURE_GET_CCT_REGISTER:  
  83.             SensorRegNumber=FACTORY_END_ADDR;  
  84.             if (*pFeatureParaLen<(SensorRegNumber*sizeof(SENSOR_REG_STRUCT)+4))  
  85.                 return FALSE;  
  86.             *pFeatureData32++=SensorRegNumber;  
  87.             for (i=0;i<SensorRegNumber;i++)  
  88.             {  
  89.                 *pFeatureData32++=OV5670SensorCCT[i].Addr;  
  90.                 *pFeatureData32++=OV5670SensorCCT[i].Para;  
  91.             }  
  92.             break;  
  93.         case SENSOR_FEATURE_SET_ENG_REGISTER:  
  94.             SensorRegNumber=ENGINEER_END;  
  95.             for (i=0;i<SensorRegNumber;i++)  
  96.             {  
  97.                 spin_lock(&ov5670mipiraw_drv_lock);  
  98.                 OV5670SensorReg[i].Addr=*pFeatureData32++;  
  99.                 OV5670SensorReg[i].Para=*pFeatureData32++;  
  100.                                 spin_unlock(&ov5670mipiraw_drv_lock);  
  101.             }  
  102.             break;  
  103.         case SENSOR_FEATURE_GET_ENG_REGISTER:  
  104.             SensorRegNumber=ENGINEER_END;  
  105.             if (*pFeatureParaLen<(SensorRegNumber*sizeof(SENSOR_REG_STRUCT)+4))  
  106.                 return FALSE;  
  107.             *pFeatureData32++=SensorRegNumber;  
  108.             for (i=0;i<SensorRegNumber;i++)  
  109.             {  
  110.                 *pFeatureData32++=OV5670SensorReg[i].Addr;  
  111.                 *pFeatureData32++=OV5670SensorReg[i].Para;  
  112.             }  
  113.             break;  
  114.         case SENSOR_FEATURE_GET_REGISTER_DEFAULT:  
  115.             if (*pFeatureParaLen>=sizeof(NVRAM_SENSOR_DATA_STRUCT))  
  116.             {  
  117.                 pSensorDefaultData->Version=NVRAM_CAMERA_SENSOR_FILE_VERSION;  
  118.                 pSensorDefaultData->SensorId=OV5670_SENSOR_ID;  
  119.                 memcpy(pSensorDefaultData->SensorEngReg, OV5670SensorReg, sizeof(SENSOR_REG_STRUCT)*ENGINEER_END);  
  120.                 memcpy(pSensorDefaultData->SensorCCTReg, OV5670SensorCCT, sizeof(SENSOR_REG_STRUCT)*FACTORY_END_ADDR);  
  121.             }  
  122.             else  
  123.                 return FALSE;  
  124.             *pFeatureParaLen=sizeof(NVRAM_SENSOR_DATA_STRUCT);  
  125.             break;  
  126.         case SENSOR_FEATURE_GET_CONFIG_PARA:  
  127.             memcpy(pSensorConfigData, &OV5670SensorConfigData, sizeof(MSDK_SENSOR_CONFIG_STRUCT));  
  128.             *pFeatureParaLen=sizeof(MSDK_SENSOR_CONFIG_STRUCT);  
  129.             break;  
  130.         case SENSOR_FEATURE_CAMERA_PARA_TO_SENSOR:  
  131.             OV5670_camera_para_to_sensor();  
  132.             break;  
  133.   
  134.         case SENSOR_FEATURE_SENSOR_TO_CAMERA_PARA:  
  135.             OV5670_sensor_to_camera_para();  
  136.             break;  
  137.         case SENSOR_FEATURE_GET_GROUP_COUNT:  
  138.             *pFeatureReturnPara32++=OV5670_get_sensor_group_count();  
  139.             *pFeatureParaLen=4;  
  140.             break;  
  141.         case SENSOR_FEATURE_GET_GROUP_INFO:  
  142.             OV5670_get_sensor_group_info(pSensorGroupInfo->GroupIdx, pSensorGroupInfo->GroupNamePtr, &pSensorGroupInfo->ItemCount);  
  143.             *pFeatureParaLen=sizeof(MSDK_SENSOR_GROUP_INFO_STRUCT);  
  144.             break;  
  145.         case SENSOR_FEATURE_GET_ITEM_INFO:  
  146.             OV5670_get_sensor_item_info(pSensorItemInfo->GroupIdx,pSensorItemInfo->ItemIdx, pSensorItemInfo);  
  147.             *pFeatureParaLen=sizeof(MSDK_SENSOR_ITEM_INFO_STRUCT);  
  148.             break;  
  149.   
  150.         case SENSOR_FEATURE_SET_ITEM_INFO:  
  151.             OV5670_set_sensor_item_info(pSensorItemInfo->GroupIdx, pSensorItemInfo->ItemIdx, pSensorItemInfo->ItemValue);  
  152.             *pFeatureParaLen=sizeof(MSDK_SENSOR_ITEM_INFO_STRUCT);  
  153.             break;  
  154.   
  155.         case SENSOR_FEATURE_GET_ENG_INFO:  
  156.             pSensorEngInfo->SensorId = 129;  
  157.             pSensorEngInfo->SensorType = CMOS_SENSOR;  
  158.             pSensorEngInfo->SensorOutputDataFormat=SENSOR_OUTPUT_FORMAT_RAW_Gb;  
  159.             *pFeatureParaLen=sizeof(MSDK_SENSOR_ENG_INFO_STRUCT);  
  160.             break;  
  161.         case SENSOR_FEATURE_GET_LENS_DRIVER_ID:  
  162.             // get the lens driver ID from EEPROM or just return LENS_DRIVER_ID_DO_NOT_CARE  
  163.             // if EEPROM does not exist in camera module.  
  164.             *pFeatureReturnPara32=LENS_DRIVER_ID_DO_NOT_CARE;  
  165.             *pFeatureParaLen=4;  
  166.             break;  
  167.   
  168.         case SENSOR_FEATURE_INITIALIZE_AF:  
  169.             break;  
  170.         case SENSOR_FEATURE_CONSTANT_AF:  
  171.             break;  
  172.         case SENSOR_FEATURE_MOVE_FOCUS_LENS:  
  173.             break;  
  174.         case SENSOR_FEATURE_SET_VIDEO_MODE:  
  175.             OV5670SetVideoMode(*pFeatureData16);  
  176.             break;  
  177.         case SENSOR_FEATURE_CHECK_SENSOR_ID://-------------调用此处读取ID  
  178.             OV5670GetSensorID(pFeatureReturnPara32);  
  179.             break;  
  180.         case SENSOR_FEATURE_SET_AUTO_FLICKER_MODE:  
  181.             OV5670SetAutoFlickerMode((BOOL)*pFeatureData16, *(pFeatureData16+1));  
  182.                 break;  
  183.                 case SENSOR_FEATURE_SET_MAX_FRAME_RATE_BY_SCENARIO:  
  184.                         OV5670MIPISetMaxFramerateByScenario((MSDK_SCENARIO_ID_ENUM)*pFeatureData32, *(pFeatureData32+1));  
  185.                         break;  
  186.                 case SENSOR_FEATURE_GET_DEFAULT_FRAME_RATE_BY_SCENARIO:  
  187.                         OV5670MIPIGetDefaultFramerateByScenario((MSDK_SCENARIO_ID_ENUM)*pFeatureData32, (MUINT32 *)(*(pFeatureData32+1)));  
  188.                         break;  
  189.                 case SENSOR_FEATURE_SET_TEST_PATTERN:  
  190.                         OV5670SetTestPatternMode((BOOL)*pFeatureData16);  
  191.                         break;  
  192.                 case SENSOR_FEATURE_GET_TEST_PATTERN_CHECKSUM_VALUE://for factory mode auto testing  
  193.                         *pFeatureReturnPara32=OV5670_TEST_PATTERN_CHECKSUM;  
  194.                         *pFeatureParaLen=4;  
  195.                      break;  
  196.         default:  
  197.             break;  
  198.     }  
  199.     return ERROR_NONE;  
  200. }  
[cpp] view plaincopy
 
  1. UINT32 OV5670GetSensorID(UINT32 *sensorID)  
  2. {  
  3.     int  retry = 2;  
  4.   
  5.         OV5670DB("OV5670GetSensorID enter :  ");  
  6.     mdelay(5);  
  7.   
  8.     do {  
  9.         *sensorID = (OV5670_read_cmos_sensor(0x300B)<<8)|OV5670_read_cmos_sensor(0x300C);  
  10.         if (*sensorID == OV5670_SENSOR_ID)  
  11.                 {  
  12.                         OV5670DB("Sensor ID = 0x%04x ", *sensorID);  
  13.                 break;  
  14.                 }  
  15.         OV5670DB("Read Sensor ID Fail = 0x%04x ", *sensorID);  
  16.         retry--;  
  17.     } while (retry > 0);  
  18.   
  19.     if (*sensorID != OV5670_SENSOR_ID) {  
  20.                 OV5670DB("Read Sensor ID Fail = 0x%04x ", *sensorID);  
  21.   
  22.                 /* 
  23.         *sensorID = OV5670_SENSOR_ID; 
  24.         return ERROR_SENSOR_CONNECT_FAIL; 
  25.         */  
  26.          *sensorID = 0xFFFFFFFF;  
  27.      return ERROR_SENSOR_CONNECT_FAIL;  
  28.     }  
  29.     return ERROR_NONE;  
  30. }  

          以上是ov5670获取ID的函数。

三、开机打开sensor总结           

    • HAL层运行Search sensor这个线程
    • HAL层遍历sensorlist列表并挂载HAL层性能3A等一些参数获取的接口
    • HAL层下达setDriver的cmd，并下传正在遍历的sensorlist列表中的ID
    • Driver层根据这个ID，挂载Driver层sensorlist中对应的Sensorlist中对应的Sensor和具体Sensor底层操作接口
    • HAL层对正确遍历的sensor下达check ID的指令
    • Driver层为对应sensor上电，通过I2C读取预存在寄存器中的sensor id
    • 比较读取结果，不匹配，return error，继续遍历
    • 匹配，HAL层下达其他指令收集sensor信息
    • sensor下电

三、开机打开sensor总结           

    • HAL层运行Search sensor这个线程
    • HAL层遍历sensorlist列表并挂载HAL层性能3A等一些参数获取的接口
    • HAL层下达setDriver的cmd，并下传正在遍历的sensorlist列表中的ID
    • Driver层根据这个ID，挂载Driver层sensorlist中对应的Sensorlist中对应的Sensor和具体Sensor底层操作接口
    • HAL层对正确遍历的sensor下达check ID的指令
    • Driver层为对应sensor上电，通过I2C读取预存在寄存器中的sensor id
    • 比较读取结果，不匹配，return error，继续遍历
    • 匹配，HAL层下达其他指令收集sensor信息
    • sensor下电
【推广】 免费学中医，健康全家人
原文地址：https://www.cnblogs.com/reality-soul/p/4668532.html