MTK Camera 开机启动流程
一、MTK平台Camera框架MTK平台的Camera的架构见下图，
http://img.blog.csdn.net/20150129160045585?watermark/2/text/aHR0cDovL2Jsb2cuY3Nkbi5uZXQvY2hlbjE5ODc0Ng==/font/5a6L5L2T/fontsize/400/fill/I0JBQkFCMA==/dissolve/70/gravity/Center
这里主要介绍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开启流程图如下：http://img.blog.csdn.net/20150129163338193?watermark/2/text/aHR0cDovL2Jsb2cuY3Nkbi5uZXQvY2hlbjE5ODc0Ng==/font/5a6L5L2T/fontsize/400/fill/I0JBQkFCMA==/dissolve/70/gravity/Center 主要发生在两个时间点： 1、开机时：camera完成了sensor框架初始化，id检测并匹配sensor，以及上下电操作。 2、打开Camera应用时：camera会有上电，完成sensor的寄存器初始化配置，向上层传递基本参数和配置信息，以及preview和capture模式循环。
1、开机初始化过程 由于一开始不知道上电camera初始化从哪开始，我们可以借助抓取的mtk mobile log去分析。先看hal层log开始处：
[*]12-24 10:02:07.601 148 148 D MtkCam/module:
[*]12-24 10:02:07.601 148 148 D MtkCam/Utils/Property: pid/tid=148/148
[*]12-24 10:02:07.601 148 148 I CameraService: Loaded "MediaTek Camera Module" camera module
[*]12-24 10:02:07.601 148 148 D MtkCam/MtkCamUtils: pid/tid=148/148
[*]12-24 10:02:07.601 148 148 D SensorHal: getInstance
[*]12-24 10:02:07.601 148 148 D SensorHal: : 0
[*]12-24 10:02:07.601 148 148 D SeninfDrvImp:
[*]12-24 10:02:07.601 148 148 D SeninfDrvImp:
[*]12-24 10:02:07.601 148 148 D SeninfDrvImp: : 0
通过sourceinsight搜索发现开始是从CamDeviceManagerImp.cpp函数的enumDeviceLocked()开始。该函数的源代码如下：===>mediatek/platform/mt6582/hardware/mtkcam/devicemgr/CamDeviceManagerImp.cpp
[*]/******************************************************************************
[*] *
[*] ******************************************************************************/
[*]int32_t
[*]CamDeviceManagerImp::
[*]enumDeviceLocked()
[*]{
[*] Utils::CamProfile _profile(__FUNCTION__, "CamDeviceManagerImp");
[*] //
[*] status_t status = OK;
[*] int32_t i4DeviceNum = 0;
[*] //
[*] mEnumMap.clear();
[*]//------------------------------------------------------------------------------
[*]#if '1'==MTKCAM_HAVE_SENSOR_HAL
[*]
[*] mEnumMap.clear();
[*] DevMetaInfo::clear();
[*] //
[*] int32_t isFakeOrientation = 0;
[*] int32_t i4DevSetupOrientation = 0;
[*] camera_info camInfo;
[*] camInfo.device_version = CAMERA_DEVICE_API_VERSION_1_0;
[*] camInfo.static_camera_characteristics = NULL;
[*] //
[*] SensorHal* pSensorHal = SensorHal::createInstance();//创建sensor对象
[*] if( ! pSensorHal )
[*] {
[*] MY_LOGE("pSensorHal == NULL");
[*] return 0;
[*] }
[*] //
[*] int32_t const iSensorsList = pSensorHal->searchSensor();//此函数是入口，主要查找匹配的硬件sensor
[*] //
[*] //
[*] if( (iSensorsList & SENSOR_DEV_MAIN_3D) == SENSOR_DEV_MAIN_3D )
[*] {
[*] MY_LOGI("Stereo 3D Camera found");
[*]#warning " Stereo 3D Camera"
[*] }
[*] //
[*] if( (iSensorsList & SENSOR_DEV_MAIN) == SENSOR_DEV_MAIN )
[*] {
[*] int32_t const deviceId = i4DeviceNum;
[*] //
[*] halSensorDev_e const eHalSensorDev = SENSOR_DEV_MAIN;
[*] pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_FAKE_ORIENTATION, (int)&isFakeOrientation);
[*] pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_ORIENTATION_ANGLE, (int)&i4DevSetupOrientation);
[*] pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_FACING_DIRECTION, (int)&camInfo.facing);
[*] camInfo.orientation = i4DevSetupOrientation;
[*] if( isFakeOrientation )
[*] {
[*] camInfo.orientation = (0==camInfo.facing) ? 90 : 270;
[*] MY_LOGW("Fake orientation:%d instead of %d, facing=%d HalSensorDev=%#x", camInfo.orientation, i4DevSetupOrientation, camInfo.facing, eHalSensorDev);
[*] }
[*] DevMetaInfo::add(deviceId, camInfo, i4DevSetupOrientation, eDevId_ImgSensor, eHalSensorDev);
[*] //
[*] sp<EnumInfo> pInfo = new EnumInfo;
[*] pInfo->uDeviceVersion = CAMERA_DEVICE_API_VERSION_1_0;
[*] pInfo->pMetadata = NULL;
[*] pInfo->iFacing = camInfo.facing;
[*] pInfo->iWantedOrientation = camInfo.orientation;
[*] pInfo->iSetupOrientation = i4DevSetupOrientation;
[*] mEnumMap.add(deviceId, pInfo);
[*] //
[*] i4DeviceNum++;
[*] }
[*] //
[*] if( (iSensorsList & SENSOR_DEV_SUB) == SENSOR_DEV_SUB )
[*] {
[*] int32_t const deviceId = i4DeviceNum;
[*] //
[*] halSensorDev_e const eHalSensorDev = SENSOR_DEV_SUB;
[*] pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_FAKE_ORIENTATION, (int)&isFakeOrientation);
[*] pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_ORIENTATION_ANGLE, (int)&i4DevSetupOrientation);
[*] pSensorHal->sendCommand(eHalSensorDev, SENSOR_CMD_GET_SENSOR_FACING_DIRECTION, (int)&camInfo.facing);
[*] camInfo.orientation = i4DevSetupOrientation;
[*] if( isFakeOrientation )
[*] {
[*] camInfo.orientation = (0==camInfo.facing) ? 90 : 270;
[*] MY_LOGW("Fake orientation:%d instead of %d, facing=%d HalSensorDev=%#x", camInfo.orientation, i4DevSetupOrientation, camInfo.facing, eHalSensorDev);
[*] }
[*] DevMetaInfo::add(deviceId, camInfo, i4DevSetupOrientation, eDevId_ImgSensor, eHalSensorDev);
[*] //
[*] sp<EnumInfo> pInfo = new EnumInfo;
[*] pInfo->uDeviceVersion = CAMERA_DEVICE_API_VERSION_1_0;
[*] pInfo->pMetadata = NULL;
[*] pInfo->iFacing = camInfo.facing;
[*] pInfo->iWantedOrientation = camInfo.orientation;
[*] pInfo->iSetupOrientation = i4DevSetupOrientation;
[*] mEnumMap.add(deviceId, pInfo);
[*] //
[*] i4DeviceNum++;
[*] }
[*] //
[*]// if( (iSensorsList & SENSOR_DEV_ATV) == SENSOR_DEV_ATV )
[*] {
[*] int32_t const deviceId = 0xFF;
[*] //
[*] halSensorDev_e const eHalSensorDev = SENSOR_DEV_ATV;
[*] camInfo.facing = 0;
[*] camInfo.orientation = 0;
[*] DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_AtvSensor, eHalSensorDev);
[*] //
[*] sp<EnumInfo> pInfo = new EnumInfo;
[*] pInfo->uDeviceVersion = CAMERA_DEVICE_API_VERSION_1_0;
[*] pInfo->pMetadata = NULL;
[*] pInfo->iFacing = camInfo.facing;
[*] pInfo->iWantedOrientation = camInfo.orientation;
[*] pInfo->iSetupOrientation = i4DevSetupOrientation;
[*] mEnumMap.add(deviceId, pInfo);
[*] //
[*]// i4DeviceNum++;
[*] }
[*] //
[*] //
[*] if( pSensorHal )
[*] {
[*] pSensorHal->destroyInstance();
[*] pSensorHal = NULL;
[*] }
[*] //
[*] MY_LOGI("iSensorsList=0x%08X, i4DeviceNum=%d", iSensorsList, i4DeviceNum);
[*] for (size_t i = 0; i < mEnumMap.size(); i++)
[*] {
[*] int32_t const deviceId = mEnumMap.keyAt(i);
[*] sp<EnumInfo> pInfo = mEnumMap.valueAt(i);
[*] uint32_t const uDeviceVersion = pInfo->uDeviceVersion;
[*] camera_metadata const*pMetadata = pInfo->pMetadata;
[*] int32_t const iFacing = pInfo->iFacing;
[*] int32_t const iWantedOrientation= pInfo->iWantedOrientation;
[*] int32_t const iSetupOrientation = pInfo->iSetupOrientation;
[*] MY_LOGI(
[*] " orientation(wanted/setup)=(%d/%d) facing:%d metadata:%p DeviceVersion:0x%x",
[*] deviceId, iWantedOrientation, iSetupOrientation,
[*] iFacing, pMetadata, uDeviceVersion
[*] );
[*] }
[*]
[*]#else //----------------------------------------------------------------------
[*]
[*] #warning " Simulation for CamDeviceManagerImp::enumDeviceLocked()"
[*]
[*] mEnumMap.clear();
[*] DevMetaInfo::clear();
[*] {
[*] int32_t const deviceId = 0;
[*] //
[*] camera_info camInfo;
[*] camInfo.device_version= CAMERA_DEVICE_API_VERSION_1_0;
[*] camInfo.static_camera_characteristics = NULL;
[*] camInfo.facing = 0;
[*] camInfo.orientation = 90;
[*] DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_ImgSensor, 0x01/*SENSOR_DEV_MAIN*/);
[*] //
[*] sp<EnumInfo> pInfo = new EnumInfo;
[*] pInfo->uDeviceVersion = CAMERA_DEVICE_API_VERSION_1_0;
[*] pInfo->pMetadata = NULL;
[*] pInfo->iFacing = 0;
[*] pInfo->iWantedOrientation = 90;
[*] pInfo->iSetupOrientation = 90;
[*] mEnumMap.add(deviceId, pInfo);
[*] }
[*] //
[*] {
[*] int32_t const deviceId = 0xFF;
[*] //
[*] camera_info camInfo;
[*] camInfo.device_version= CAMERA_DEVICE_API_VERSION_1_0;
[*] camInfo.static_camera_characteristics = NULL;
[*] camInfo.facing = 0;
[*] camInfo.orientation = 0;
[*] DevMetaInfo::add(deviceId, camInfo, camInfo.orientation, eDevId_AtvSensor, 0x04/*SENSOR_DEV_ATV*/);
[*] //
[*] sp<EnumInfo> pInfo = new EnumInfo;
[*] pInfo->uDeviceVersion = CAMERA_DEVICE_API_VERSION_1_0;
[*] pInfo->pMetadata = NULL;
[*] pInfo->iFacing = 0;
[*] pInfo->iWantedOrientation = 0;
[*] pInfo->iSetupOrientation = 0;
[*] mEnumMap.add(deviceId, pInfo);
[*] }
[*] //
[*] i4DeviceNum = 1;
[*]
[*]#endif
[*]//------------------------------------------------------------------------------
[*] //
[*] _profile.print("");
[*] returni4DeviceNum;
[*]}
函数pSensorHal->searchSensor()将调用SensorDrv::searchSensor(NULL)函数，该函数再调用ImgSensor_drv.cpp文件中中的ImgSensorDrv::impSearchSensor函数。===>mediatek/platform/mt6582/hardware/mtkcam/core/drv/imgsensor/ImgSensor_drv.cpp
[*]/*******************************************************************************
[*]*
[*]********************************************************************************/
[*]
[*]MINT32
[*]ImgSensorDrv::impSearchSensor(pfExIdChk pExIdChkCbf)
[*]{
[*] MUINT32 SensorEnum = (MUINT32) DUAL_CAMERA_MAIN_SENSOR;
[*] MUINT32 i,id = {0,0};
[*] MBOOL SensorConnect=TRUE;
[*] UCHAR cBuf;
[*] MINT32 err = SENSOR_NO_ERROR;
[*] MINT32 err2 = SENSOR_NO_ERROR;
[*] ACDK_SENSOR_INFO_STRUCT SensorInfo;
[*] ACDK_SENSOR_CONFIG_STRUCT SensorConfigData;
[*] ACDK_SENSOR_RESOLUTION_INFO_STRUCT SensorResolution;
[*] MINT32 sensorDevs = SENSOR_NONE;
[*] IMAGE_SENSOR_TYPE sensorType = IMAGE_SENSOR_TYPE_UNKNOWN;
[*] IMGSENSOR_SOCKET_POSITION_ENUM socketPos = IMGSENSOR_SOCKET_POS_NONE;
[*]
[*]
[*] //! If imp sensor search process already done before,
[*] //! only need to return the sensorDevs, not need to
[*] //! search again.
[*] if (SENSOR_DOES_NOT_EXIST != m_mainSensorId) {
[*] //been processed.
[*] LOG_MSG(" Already processed \n");
[*] if (BAD_SENSOR_INDEX != m_mainSensorIdx) {
[*] sensorDevs |= SENSOR_MAIN;
[*] }
[*]
[*] if (BAD_SENSOR_INDEX != m_subSensorIdx) {
[*] sensorDevs |= SENSOR_SUB;
[*] }
[*]
[*] #ifdefATVCHIP_MTK_ENABLE
[*]
[*] sensorDevs |= SENSOR_ATV;
[*]
[*] #endif
[*]
[*]
[*] return sensorDevs;
[*] }
[*]
[*] GetSensorInitFuncList(&m_pstSensorInitFunc);//----(1)获取hal层的sensor列表
[*]
[*] LOG_MSG("SENSOR search start \n");
[*]
[*] if (-1 != m_fdSensor) {
[*] ::close(m_fdSensor);
[*] m_fdSensor = -1;
[*] }
[*] sprintf(cBuf,"/dev/%s",CAMERA_HW_DEVNAME);
[*] m_fdSensor = : : open(cBuf, O_RDWR);
[*] if (m_fdSensor < 0) {
[*] LOG_ERR(": error opening %s: %s \n", cBuf, strerror(errno));
[*] return sensorDevs;
[*] }
[*] LOG_MSG(" m_fdSensor = %d\n", m_fdSensor);
[*]
[*] // search main/main_2/sub 3 sockets
[*] #ifdef MTK_SUB_IMGSENSOR
[*] for (SensorEnum = DUAL_CAMERA_MAIN_SENSOR; SensorEnum <= DUAL_CAMERA_SUB_SENSOR; SensorEnum <<= 1){
[*] LOG_MSG("impSearchSensor search to sub\n");
[*] #else
[*] for (SensorEnum = DUAL_CAMERA_MAIN_SENSOR; SensorEnum < DUAL_CAMERA_SUB_SENSOR; SensorEnum <<= 1){
[*] LOG_MSG("impSearchSensor search to main\n");
[*] #endif
[*] //skip atv case
[*] if ( 0x04 == SensorEnum ) continue;
[*] //
[*] for (i = 0; i < MAX_NUM_OF_SUPPORT_SENSOR; i++) {
[*] //end of driver list
[*] if (m_pstSensorInitFunc.getCameraDefault == NULL) {
[*] LOG_MSG("m_pstSensorInitFunc.getCameraDefault is NULL: %d \n", i);
[*] break;
[*] }
[*] //set sensor driver
[*] id = (SensorEnum << KDIMGSENSOR_DUAL_SHIFT) | i;
[*] LOG_MSG("set sensor driver id =%x\n", id);
[*] err = ioctl(m_fdSensor, KDIMGSENSORIOC_X_SET_DRIVER,&id );//--(2)调用kernel层的kdSetDriver函数
[*] if (err < 0) {
[*] LOG_ERR("ERROR:KDCAMERAHWIOC_X_SET_DRIVER\n");
[*] }
[*]
[*]
[*]
[*] //err = open();
[*] err = ioctl(m_fdSensor, KDIMGSENSORIOC_T_CHECK_IS_ALIVE);//---(3)上下电camera并读取sensor的ID，如果匹配则成功
[*]
[*]
[*]
[*] if (err < 0) {
[*] LOG_MSG(" Err-ctrlCode (%s) \n", strerror(errno));//
[*] }
[*] //
[*] sensorType = this->getCurrentSensorType((SENSOR_DEV_ENUM)SensorEnum);
[*] //
[*] socketPos = this->getSocketPosition((CAMERA_DUAL_CAMERA_SENSOR_ENUM)SensorEnum);
[*] //check extra ID , from EEPROM maybe
[*] //may need to keep power here
[*] if (NULL != pExIdChkCbf) {
[*] err2 = pExIdChkCbf();
[*] if (err2 < 0) {
[*] LOG_ERR("Error:pExIdChkCbf() \n");
[*] }
[*] }
[*]
[*] //power off sensor
[*] close();
[*]
[*] if (err < 0 || err2 < 0) {
[*] LOG_MSG("sensor ID mismatch\n");
[*] }
[*] else {
[*] if (SensorEnum == DUAL_CAMERA_MAIN_SENSOR) {
[*] //m_mainSensorIdx = i;
[*] //m_mainSensorId = m_pstSensorInitFunc.SensorId;
[*] m_mainSensorDrv.index = i;
[*] m_mainSensorDrv.type = sensorType;
[*] if ( IMAGE_SENSOR_TYPE_RAW == sensorType && BAD_SENSOR_INDEX == m_mainSensorDrv.firstRawIndex ) {
[*] m_mainSensorDrv.firstRawIndex = i;
[*] }
[*] else if ( IMAGE_SENSOR_TYPE_YUV == sensorType && BAD_SENSOR_INDEX == m_mainSensorDrv.firstYuvIndex ) {
[*] m_mainSensorDrv.firstYuvIndex = i;
[*] }
[*] m_mainSensorDrv.position = socketPos;
[*] m_mainSensorDrv.sensorID = m_pstSensorInitFunc].SensorId;
[*] // LOG_MSG("MAIN sensor m_mainSensorDrv.number=%d, m_mainSensorDrv.index=%d\n",m_mainSensorDrv.number,m_mainSensorDrv.index);
[*] m_mainSensorDrv.number++;
[*] //
[*] m_pMainSensorInfo = m_pstSensorInitFunc.pSensorInfo;
[*] if( m_pMainSensorInfo )
[*] {
[*] NSFeature::SensorInfoBase* pSensorInfo = m_pstSensorInitFunc.pSensorInfo;
[*] LOG_MSG("found <%#x/%s/%s>", pSensorInfo->GetID(), pSensorInfo->getDrvName(), pSensorInfo->getDrvMacroName());
[*] }
[*] else
[*] {
[*] LOG_WRN("m_pMainSensorInfo==NULL\n");
[*] }
[*] LOG_MSG("MAIN sensor found:[%d]//[%d]/[%d] \n",i,id,sensorType,socketPos);
[*] //break;
[*] }
[*] else if (SensorEnum == DUAL_CAMERA_SUB_SENSOR) {
[*] //m_subSensorIdx = i;
[*] //m_subSensorId = m_pstSensorInitFunc.SensorId;
[*] m_subSensorDrv.index = i;
[*] m_subSensorDrv.type = sensorType;
[*] if ( IMAGE_SENSOR_TYPE_RAW == sensorType && BAD_SENSOR_INDEX == m_subSensorDrv.firstRawIndex ) {
[*] m_subSensorDrv.firstRawIndex = i;
[*] }
[*] else if ( IMAGE_SENSOR_TYPE_YUV == sensorType && BAD_SENSOR_INDEX == m_subSensorDrv.firstYuvIndex ) {
[*] m_subSensorDrv.firstYuvIndex = i;
[*] }
[*] m_subSensorDrv.position = socketPos;
[*] m_subSensorDrv.sensorID = m_pstSensorInitFunc].SensorId;
[*] //LOG_MSG("SUB sensor m_subSensorDrv.number=%d, m_subSensorDrv.index=%d\n",m_subSensorDrv.number,m_subSensorDrv.index);
[*] m_subSensorDrv.number++;
[*] //
[*] m_pSubSensorInfo = m_pstSensorInitFunc.pSensorInfo;
[*] if( m_pSubSensorInfo )
[*] {
[*] NSFeature::SensorInfoBase* pSensorInfo = m_pstSensorInitFunc.pSensorInfo;
[*] LOG_MSG("found <%#x/%s/%s>", pSensorInfo->GetID(), pSensorInfo->getDrvName(), pSensorInfo->getDrvMacroName());
[*] }
[*] else
[*] {
[*] LOG_WRN("m_pSubSensorInfo==NULL\n");
[*] }
[*] LOG_MSG("SUB sensor found:[%d]//[%d]/[%d] \n",i,id,sensorType,socketPos);
[*] //break;
[*] }
[*] }//
[*]
[*] }
[*] }
[*] //close system call may be off sensor power. check first!!!
[*] ::close(m_fdSensor);
[*] m_fdSensor = -1;
[*] //
[*] if (BAD_SENSOR_INDEX != m_mainSensorDrv.index) {
[*] m_mainSensorId = m_mainSensorDrv.sensorID;
[*] //init to choose first
[*] m_mainSensorIdx = m_mainSensorDrv.index;
[*] sensorDevs |= SENSOR_MAIN;
[*] }
[*]
[*] if (BAD_SENSOR_INDEX != m_subSensorDrv.index) {
[*] m_subSensorId = m_subSensorDrv.sensorID;
[*] //init to choose first
[*] m_subSensorIdx = m_subSensorDrv.index;
[*] sensorDevs |= SENSOR_SUB;
[*] }
[*]
[*] #ifdefATVCHIP_MTK_ENABLE
[*]
[*] sensorDevs |= SENSOR_ATV;
[*]
[*] #endif
[*]
[*]
[*] if (sensorDevs == SENSOR_NONE) {
[*] LOG_ERR( "Error No sensor found!! \n");
[*] }
[*] //
[*] LOG_MSG("SENSOR search end: 0x%x /[%d]/[%d]\n", sensorDevs,
[*] m_mainSensorId,m_mainSensorIdx,m_subSensorId,m_subSensorIdx);
[*]
[*] return sensorDevs;
[*]}//
(1)、获取hal层sensor列表GetSensorInitFuncList(&m_pstSensorInitFunc);===>mediatek/custom/common/hal/imgsensor/src/sensorlist.cpp
[*]UINT32 GetSensorInitFuncList(MSDK_SENSOR_INIT_FUNCTION_STRUCT **ppSensorList)
[*]{
[*] if (NULL == ppSensorList) {
[*] ALOGE("ERROR: NULL pSensorList\n");
[*] return MHAL_UNKNOWN_ERROR;
[*] }
[*] *ppSensorList = &SensorList;//这里直接调用hal层的sensor列表
[*] return MHAL_NO_ERROR;
[*]} // GetSensorInitFuncList()
===>mediatek/custom/common/hal/imgsensor/src/sensorlist.cpp
[*]MSDK_SENSOR_INIT_FUNCTION_STRUCT SensorList[] =
[*]{
[*] //add by zym
[*]#if defined(GC2235_MIPI_RAW)
[*] RAW_INFO(GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, NULL),
[*]#endif
[*]// add by zhouzuoyu
[*]#if defined(GC2235_KOTECH_MIPI_RAW)
[*] RAW_INFO(GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, NULL),
[*]#endif
[*]#if defined(OV16825_MIPI_RAW)
[*] RAW_INFO(OV16825MIPI_SENSOR_ID, SENSOR_DRVNAME_OV16825_MIPI_RAW,NULL),
[*]#endif
[*]#if defined(IMX135_MIPI_RAW)
[*] RAW_INFO(IMX135_SENSOR_ID, SENSOR_DRVNAME_IMX135_MIPI_RAW,NULL),
[*]#endif
[*]#if defined(OV8830_RAW)
[*] RAW_INFO(OV8830_SENSOR_ID, SENSOR_DRVNAME_OV8830_RAW, NULL),
[*]#endif
[*]
[*]/*ADD sensor driver before this line */
[*] {0,{0},NULL, NULL, NULL}//end of list
[*]};
(2)、获取kernel层的kdSetDriver函数err = ioctl(m_fdSensor, KDIMGSENSORIOC_X_SET_DRIVER,&id );===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.c
[*]/*******************************************************************************
[*]* kdSetDriver
[*]********************************************************************************/
[*]int kdSetDriver(unsigned int* pDrvIndex)
[*]{
[*] ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT *pSensorList = NULL;
[*] u32 drvIdx = {0,0};
[*] u32 i;
[*]
[*] PK_XLOG_INFO("pDrvIndex:0x%08x/0x%08x \n",pDrvIndex,pDrvIndex);
[*] //set driver for MAIN or SUB sensor
[*]
[*] if (0 != kdGetSensorInitFuncList(&pSensorList))//----（2.1）获取kernel层的sensor列表
[*] {
[*] PK_ERR("ERROR:kdGetSensorInitFuncList()\n");
[*] return -EIO;
[*] }
[*]
[*] for ( i = KDIMGSENSOR_INVOKE_DRIVER_0; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {
[*] //
[*] spin_lock(&kdsensor_drv_lock);
[*] g_bEnableDriver = FALSE;
[*] g_invokeSocketIdx = (CAMERA_DUAL_CAMERA_SENSOR_ENUM)((pDrvIndex & KDIMGSENSOR_DUAL_MASK_MSB)>>KDIMGSENSOR_DUAL_SHIFT);
[*] spin_unlock(&kdsensor_drv_lock);
[*]
[*] drvIdx = (pDrvIndex & KDIMGSENSOR_DUAL_MASK_LSB);//----（2.2）g_invokeSocketIdx，drvIdx解释
[*] //
[*] if ( DUAL_CAMERA_NONE_SENSOR == g_invokeSocketIdx ) { continue; }
[*]
[*]
[*] //ToDo: remove print information
[*] PK_XLOG_INFO(" i,g_invokeSocketIdx[%d] = %d :\n",i,i,drvIdx);
[*] PK_XLOG_INFO(" i,drvIdx[%d] = %d :\n",i,i,drvIdx);
[*] //
[*] if ( MAX_NUM_OF_SUPPORT_SENSOR > drvIdx ) {
[*] if (NULL == pSensorList.SensorInit) {
[*] PK_ERR("ERROR:kdSetDriver()\n");
[*] return -EIO;
[*] }
[*]
[*] pSensorList.SensorInit(&g_pInvokeSensorFunc);//----（2.3）获取指定sensor的fun函数，例如ov5670的func
[*] if (NULL == g_pInvokeSensorFunc) {
[*] PK_ERR("ERROR:NULL g_pSensorFunc[%d]\n",i);
[*] return -EIO;
[*] }
[*] //
[*] spin_lock(&kdsensor_drv_lock);
[*] g_bEnableDriver = TRUE;
[*] spin_unlock(&kdsensor_drv_lock);
[*] //get sensor name
[*] memcpy((char*)g_invokeSensorNameStr,(char*)pSensorList.drvname,sizeof(pSensorList.drvname));
[*] //return sensor ID
[*] //pDrvIndex = (unsigned int)pSensorList.SensorId;
[*] PK_XLOG_INFO(" :[%d][%d][%d][%s][%d]\n",i,g_bEnableDriver,g_invokeSocketIdx,g_invokeSensorNameStr,sizeof(pSensorList.drvname));
[*] }
[*] }
[*] return 0;
[*]}
（2.1）获取kernel层的sensor列表kdGetSensorInitFuncList(&pSensorList)===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.c
[*]/*******************************************************************************
[*]* general camera image sensor kernel driver
[*]*******************************************************************************/
[*]UINT32 kdGetSensorInitFuncList(ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT **ppSensorList)
[*]{
[*] if (NULL == ppSensorList)
[*] {
[*] PK_DBG("ERROR: NULL ppSensorList\n");
[*] return 1;
[*] }
[*] *ppSensorList = &kdSensorList;
[*] return 0;
[*]} // kdGetSensorInitFuncList()
===>mediatek/custom/mt6582/kernel/imgsensor/src/kd_sensorlist.h
hal层和kernel层的sensor列表顺序必须保持一致
[*]ACDK_KD_SENSOR_INIT_FUNCTION_STRUCT kdSensorList =
[*]{
[*]//add by zym
[*]#if defined(GC2235_MIPI_RAW)
[*] {GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, GC2235MIPISensorInit},
[*]#endif
[*]
[*]// add by zhouzuoyu
[*]#if defined(GC2235_KOTECH_MIPI_RAW)
[*] {GC2235MIPI_SENSOR_ID, SENSOR_DRVNAME_GC2235_MIPI_RAW, GC2235MIPISensorInit},
[*]#endif
[*]
[*]#if defined(OV16825_MIPI_RAW)
[*] {OV16825MIPI_SENSOR_ID, SENSOR_DRVNAME_OV16825_MIPI_RAW, OV16825MIPISensorInit},
[*]#endif
[*]#if defined(IMX135_MIPI_RAW)
[*] {IMX135_SENSOR_ID, SENSOR_DRVNAME_IMX135_MIPI_RAW, IMX135_MIPI_RAW_SensorInit},
[*]#endif
[*]#if defined(OV8830_RAW)
[*] {OV8830_SENSOR_ID, SENSOR_DRVNAME_OV8830_RAW, OV8830SensorInit},
[*]#endif
[*]/*ADD sensor driver before this line */
[*] {0,{0},NULL}, //end of list
[*]};
[*]//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;">
[*]</span></span>
（2.2）g_invokeSocketIdx，drvIdx解释 上层传下来的 id 参数解析成两部分 g_invokeSocketIdx 区分目前正在匹配的是 main 还是sub，drvIdx 是 sensor 列表的序列号 。
（2.3）获取指定sensor的func函数，例如ov5670的func，pSensorList.SensorInit(&g_pInvokeSensorFunc); 调用的函数是OV5670_MIPI_RAW_SensorInit()。
[*]#if defined(OV5670_MIPI_RAW)
[*] {OV5670_SENSOR_ID, SENSOR_DRVNAME_OV5670_MIPI_RAW, OV5670_MIPI_RAW_SensorInit},
[*]#endif
===>mediatek/custom/common/kernel/imgsensor/ov5670_mipi_raw/ov5670mipiraw_Sensor.c
[*]SENSOR_FUNCTION_STRUCTSensorFuncOV5670=
[*]{
[*] OV5670Open,
[*] OV5670GetInfo,
[*] OV5670GetResolution,
[*] OV5670FeatureControl,
[*] OV5670Control,
[*] OV5670Close
[*]};
[*]
[*]UINT32 OV5670_MIPI_RAW_SensorInit(PSENSOR_FUNCTION_STRUCT *pfFunc)//---调用此函数
[*]{
[*] if (pfFunc!=NULL)
[*] *pfFunc=&SensorFuncOV5670;
[*]
[*] return ERROR_NONE;
[*]}
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
[*]/*******************************************************************************
[*]* adopt_CAMERA_HW_CheckIsAlive
[*]********************************************************************************/
[*]inline static int adopt_CAMERA_HW_CheckIsAlive(void)
[*]{
[*] UINT32 err = 0;
[*] UINT32 err1 = 0;
[*] UINT32 i = 0;
[*] MUINT32 sensorID = 0;
[*] MUINT32 retLen = 0;
[*]
[*]
[*] KD_IMGSENSOR_PROFILE_INIT();
[*] //power on sensor
[*] kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr,true, CAMERA_HW_DRVNAME1);//----（3.1）sensor上电
[*] //wait for power stable
[*] mDELAY(10);
[*] KD_IMGSENSOR_PROFILE("kdModulePowerOn");
[*]
[*] if (g_pSensorFunc) {
[*] for ( i = KDIMGSENSOR_INVOKE_DRIVER_0 ; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {
[*] if(DUAL_CAMERA_NONE_SENSOR != g_invokeSocketIdx){
[*] err = g_pSensorFunc->SensorFeatureControl(g_invokeSocketIdx, SENSOR_FEATURE_CHECK_SENSOR_ID, (MUINT8*)&sensorID, &retLen);//---（3.2）获取sensor ID
[*] if (sensorID == 0) { //not implement this feature ID
[*] PK_DBG(" Not implement!!, use old open function to check\n");
[*] err = ERROR_SENSOR_CONNECT_FAIL;
[*] }
[*] else if (sensorID == 0xFFFFFFFF) { //fail to open the sensor
[*] PK_DBG(" No Sensor Found");
[*] err = ERROR_SENSOR_CONNECT_FAIL;
[*] }
[*] else {
[*]
[*] PK_DBG(" Sensor found ID = 0x%x\n", sensorID);
[*] err = ERROR_NONE;
[*] }
[*] if(ERROR_NONE != err)
[*] {
[*] PK_DBG("ERROR:adopt_CAMERA_HW_CheckIsAlive(), No imgsensor alive \n");
[*] }
[*] }
[*] }
[*] }
[*] else {
[*] PK_DBG("ERROR:NULL g_pSensorFunc\n");
[*] }
[*]
[*] //reset sensor state after power off
[*] err1 = g_pSensorFunc->SensorClose();
[*] if(ERROR_NONE != err1) {
[*] PK_DBG("SensorClose \n");
[*] }
[*] //
[*] kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr, false, CAMERA_HW_DRVNAME1);
[*] //
[*] KD_IMGSENSOR_PROFILE("CheckIsAlive");
[*]
[*] return err?-EIO:err;
[*]} /* adopt_CAMERA_HW_Open() */
(3.1)Sensor 上电， kdModulePowerOn((CAMERA_DUAL_CAMERA_SENSOR_ENUM*)g_invokeSocketIdx, g_invokeSensorNameStr,true, CAMERA_HW_DRVNAME1);
[*]/*******************************************************************************
[*]* kdModulePowerOn
[*]********************************************************************************/
[*]int
[*]kdModulePowerOn(
[*]CAMERA_DUAL_CAMERA_SENSOR_ENUM socketIdx,
[*]char sensorNameStr,
[*]BOOL On,
[*]char* mode_name )
[*]{
[*]MINT32 ret = ERROR_NONE;
[*]u32 i = 0;
[*]
[*] for ( i = KDIMGSENSOR_INVOKE_DRIVER_0 ; i < KDIMGSENSOR_MAX_INVOKE_DRIVERS ; i++ ) {
[*] if ( g_bEnableDriver ) {
[*] //PK_XLOG_INFO("[%s][%d][%d][%s][%s]\r\n",__FUNCTION__,g_bEnableDriver,socketIdx,sensorNameStr,mode_name);
[*] ret = kdCISModulePowerOn(socketIdx,sensorNameStr,On,mode_name);//实际上电的func
[*] if ( ERROR_NONE != ret ) {
[*] PK_ERR("[%s]",__FUNCTION__);
[*] return ret;
[*] }
[*] }
[*] }
[*] return ERROR_NONE;
[*]}
===>mediatek/custom/huaqin82_slwt_2s_td/kernel/camera/camera/kd_camera_hw.c
[*]int kdCISModulePowerOn(CAMERA_DUAL_CAMERA_SENSOR_ENUM SensorIdx, char *currSensorName, BOOL On, char* mode_name)
[*]{
[*] PK_DBG(" **kdCISModulePowerOn:SensorIdx:%d,pinSetIdx:%d",SensorIdx,pinSetIdx);
[*] //dump_stack();
[*] if (DUAL_CAMERA_MAIN_SENSOR == SensorIdx){
[*] if (currSensorName &&
[*] ((0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV, currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV, currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW, currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName))
[*] //|| to add other main camera here
[*] ))
[*] pinSetIdx = 0;
[*] else
[*] {
[*] PK_DBG("kdCISModulePowerOn get in---sensorIdx not compare with sensor name: %s\n", currSensorName);
[*] //if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName)))
[*] //{
[*] // pinSetIdx = 1;
[*] //}
[*] //else{
[*] goto _kdCISModulePowerOn_exit_;
[*] //}
[*] }
[*] }
[*] else if (DUAL_CAMERA_SUB_SENSOR == SensorIdx) {
[*] if (currSensorName &&
[*] ((0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW, currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_GC0312_YUV, currSensorName))
[*] ||(0 == strcmp(SENSOR_DRVNAME_HI704_YUV, currSensorName))
[*] //||(0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV, currSensorName))
[*] //|| to add other sub camera here
[*] ))
[*] pinSetIdx = 1;
[*] else
[*] {
[*] //if (currSensorName &&
[*] //((0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))
[*] //|| to add other main camera here
[*] //))
[*] //{
[*] //pinSetIdx = 0;
[*] //}
[*] PK_DBG("{ryf-sub}kdCISModulePowerOn get in---sensorIdx not compare with sensro:%s\n",currSensorName);
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] }
[*] else if (DUAL_CAMERA_MAIN_2_SENSOR == SensorIdx) {
[*] // pinSetIdx = 2;
[*] }
[*]
[*] PK_DBG("kdCISModulePowerOn:SensorIdx:%d,pinSetIdx:%d",SensorIdx,pinSetIdx);
[*] Rst_PDN_Init();
[*]
[*] //power ON
[*] if (On)
[*] {
[*] PK_DBG("kdCISModulePowerOn -on:currSensorName=%s\n",currSensorName);
[*] if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is ov5648mipi on\n");
[*] if (0 == pinSetIdx) {
[*] if (TRUE != kd_ov5648_main_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (1 == pinSetIdx) {
[*] if (TRUE != kd_ov5648_sub_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is s5k4e1ga on \n");
[*] if(TRUE != kd_s5k4e1gamipi_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is hi544 on \n");
[*] if(TRUE != kd_hi544raw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is gc2235 on\n");
[*] if(TRUE != kd_gc2235mipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))) {
[*] PK_DBG("is gc2235_raw on\n");
[*]
[*] if (TRUE != kd_gc2235raw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*]/*else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI253_YUV,currSensorName)))
[*] {
[*] PK_DBG("is hi253 on\n");
[*] if(TRUE != kd_hi253yuv_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }*/
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is ov88251 on \n");
[*] if(TRUE != kd_ov88251mipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is ov88252 on \n");
[*] if(TRUE != kd_ov88252mipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is ov8858 on \n");
[*] kd_a5142mipiraw_sub_poweron(mode_name);
[*] kd_a5142mipiraw_sub_powerdown(mode_name);
[*] if(TRUE != kd_ov8858mipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is s5k4h5yx on \n");
[*] kd_a5142mipiraw_sub_poweron(mode_name);
[*] kd_a5142mipiraw_sub_powerdown(mode_name);
[*] if (TRUE != kd_s5k4h5yxmipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is t4k35 on \n");
[*] if(TRUE != kd_t4k35mipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && ((0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName)))) {
[*] if(pinSetIdx==0)
[*] {
[*] if(TRUE != kd_s5k3h7ymipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else
[*] {
[*] if(TRUE != kd_s5k3h72ymipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName))) {
[*] PK_DBG("is gc2035 on\n");
[*] if(TRUE != kd_gc2035_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName)))
[*] {
[*] if(TRUE != kd_ov5648a_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName)))
[*] {
[*] if(TRUE != kd_ov5670_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName)))
[*] {
[*] if(TRUE != kd_hi551_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName)))
[*] {
[*] if(TRUE != kd_ov5648b_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))) //lili add
[*] {
[*] if(TRUE != kd_ov5648_main_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is s5k3h72ymipi on\n");
[*] if(TRUE != kd_s5k3h72ymipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName)))
[*] {
[*] PK_DBG("is gc0329 on\n");
[*] if(TRUE != kd_gc0329_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))) {
[*] if (0 == pinSetIdx) {
[*] PK_DBG("is A5142 main on \n");
[*] if(TRUE != kd_a5142mipiraw_main_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else {
[*] PK_DBG("is A5142 sub on \n");
[*] if(TRUE != kd_a5142mipiraw_sub_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*]
[*] }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0312_YUV,currSensorName)))
[*] {
[*] PK_DBG("is gc0312 on\n");
[*] if(TRUE != kd_gc0312_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI704_YUV,currSensorName)))
[*] {
[*] PK_DBG("is hi704 on\n");
[*] if(TRUE != kd_hi704yuv_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV,currSensorName)))
[*] {
[*] PK_DBG("is gc0310 on\n");
[*] if(TRUE != kd_gc0310_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV,currSensorName))) {
[*] PK_DBG("is gc2145 on\n");
[*]
[*] if (TRUE != kd_gc2145_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName)))
[*] {
[*] PK_DBG("is hi258 on \n");
[*] if(TRUE != kd_hi258mipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is ov2680 on \n");
[*] if(TRUE != kd_ov2680mipiraw_poweron(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else
[*] {
[*] PK_DBG("kdCISModulePowerOn get in---other , please add the power on code!!!!!!\n");
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*]}
[*]else {//power OFF
[*]
[*] PK_DBG("kdCISModulePowerOn -off:currSensorName=%s\n",currSensorName);
[*]
[*]
[*] if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is ov5648_mipi_raw down\n");
[*] if (0 == pinSetIdx) {
[*] if(TRUE != kd_ov5648_main_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (1 == pinSetIdx) {
[*] if(TRUE != kd_ov5648_sub_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] } elseif(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4E1GA_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is s5k4e1ga down\n");
[*] if(TRUE != kd_s5k4e1gamipi_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] elseif(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI544_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is hi544 down\n");
[*] if(TRUE != kd_hi544raw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88251_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is ov88251 down\n");
[*] if(TRUE != kd_ov88251mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*]
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5670_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is ov5670 down\n");
[*] if(TRUE != kd_ov5670mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*]
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI551_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is hi551 down\n");
[*] if(TRUE != kd_hi551mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*]
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV88252_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is ov88252 down\n");
[*] if(TRUE != kd_ov88252mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV8858_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is ov8858 down\n");
[*] if(TRUE != kd_ov8858mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K4H5YX_MIPI_RAW, currSensorName))) {
[*] PK_DBG("is s5k4h5yx down\n");
[*] if (TRUE != kd_s5k4h5yxmipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_T4K35_MIPI_RAW,currSensorName))) {
[*] PK_DBG("is t4k35 down\n");
[*] if(TRUE != kd_t4k35mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] elseif(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is gc2235 down\n");
[*] if(TRUE != kd_gc2235mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2235_RAW,currSensorName))) {
[*] PK_DBG("is gc2235 down\n");
[*]
[*] if (TRUE != kd_gc2235raw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*]/*elseif(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI253_YUV,currSensorName)))
[*] {
[*] PK_DBG("is hi253 down\n");
[*] if(TRUE != kd_hi253yuv_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }*/
[*] else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_A5142_MIPI_RAW, currSensorName))) {
[*] if (0 == pinSetIdx) {
[*] PK_DBG("is A5142 main down \n");
[*] if (TRUE != kd_a5142mipiraw_main_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else {
[*] PK_DBG("is A5142 sub down \n");
[*] if (TRUE != kd_a5142mipiraw_sub_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] } else if (currSensorName && ((0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_MIPI_RAW,currSensorName))
[*] || (0 == strcmp(SENSOR_DRVNAME_S5K3H7Y_2LANE_MIPI_RAW,currSensorName))))
[*] {
[*] PK_DBG("is s5k3h7 down\n");
[*] if(pinSetIdx==0)
[*] {
[*] if(TRUE != kd_s5k3h7ymipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else {
[*] if(TRUE != kd_s5k3h72ymipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*]
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2035_YUV,currSensorName)))
[*] {
[*] PK_DBG("is gc2035 down\n");
[*] if(TRUE != kd_gc2035_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_S5K3H72Y_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is s5k3h72y_mipi_raw down\n");
[*] if(TRUE != kd_s5k3h72ymipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648A_MIPI_RAW,currSensorName)))
[*] {
[*] if(TRUE != kd_ov5648a_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648B_MIPI_RAW,currSensorName)))
[*] {
[*] if(TRUE != kd_ov5648b_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV5648_LARGEN_MIPI_RAW,currSensorName))) //lili add
[*] {
[*] if(TRUE != kd_ov5648_main_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0329_YUV,currSensorName)))
[*] {
[*] PK_DBG("is gc0329 down\n");
[*] if(TRUE != kd_gc0329yuv_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0312_YUV,currSensorName)))
[*] {
[*] PK_DBG("is gc0312 down\n");
[*] if(TRUE != kd_gc0312_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI704_YUV,currSensorName)))
[*] {
[*] PK_DBG("is hi704 down\n");
[*] if(TRUE != kd_hi704yuv_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC0310_MIPI_YUV,currSensorName)))
[*] {
[*] PK_DBG("is gc0310 down\n");
[*] if(TRUE != kd_gc0310_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] } else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_GC2145_MIPI_YUV,currSensorName))) {
[*] PK_DBG("is gc2145 down\n");
[*]
[*] if (TRUE != kd_gc2145_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if(currSensorName && (0 == strcmp(SENSOR_DRVNAME_HI258MIPI_YUV,currSensorName)))
[*] {
[*] PK_DBG("is hi258 down\n");
[*] if(TRUE != kd_hi258mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else if (currSensorName && (0 == strcmp(SENSOR_DRVNAME_OV2680_MIPI_RAW,currSensorName)))
[*] {
[*] PK_DBG("is ov2680 down\n");
[*] if(TRUE != kd_ov2680mipiraw_powerdown(mode_name))
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*] else
[*] {
[*] PK_DBG("kdCISModulePowerDown get in---other , please add the power down code!!!!!!\n");
[*] goto _kdCISModulePowerOn_exit_;
[*] }
[*]
[*]}
[*] return 0;
[*]
[*]_kdCISModulePowerOn_exit_:
[*] return -EIO;
[*]}
[*]EXPORT_SYMBOL(kdCISModulePowerOn);
以ov5670为例，其上电code如下：
[*]static int kd_ov5670_poweron( char *mode_name)
[*]{
[*] int ret;
[*] printk("kd_ov5670_poweron1 start..\n");
[*]
[*] ret = kd_poweron_main_devices(VOL_1800, VOL_2800, VOL_1200, VOL_2800, mode_name,0);//给camera上三路电
[*] PK_DBG("kd_ov88251mipiraw_poweron start..\n");
[*] mdelay(10);// wait power to be stable
[*] //disable_inactive_sensor();//disable inactive sensor
[*] if(mt_set_gpio_out(pinSet,pinSet)){PK_DBG(" set gpio failed!! \n");}
[*] mdelay(10);
[*] if(mt_set_gpio_out(pinSet,pinSet)){PK_DBG(" set gpio failed!! \n");}
[*] mdelay(1);
[*]
[*] if(mt_set_gpio_out(pinSet,pinSet)){PK_DBG(" set gpio failed!! \n");}
[*] if(mt_set_gpio_out(pinSet,pinSet)){PK_DBG(" set gpio failed!! \n");}
[*] mdelay(10);
[*] if(mt_set_gpio_out(pinSet,pinSet)){PK_DBG(" set gpio failed!! \n");}
[*] mdelay(5);
[*]poweronerr:
[*] return ret;
[*]}
(3.2)获取sensor ID，err = g_pSensorFunc->SensorFeatureControl(g_invokeSocketIdx, SENSOR_FEATURE_CHECK_SENSOR_ID, (MUINT8*)&sensorID, &retLen);
此函数调用具体sensor的func，例如ov5670，则调用的
[*]OV5670FeatureControl
===>mediatek/custom/common/kernel/imgsensor/ov5670_mipi_raw
[*]UINT32 OV5670FeatureControl(MSDK_SENSOR_FEATURE_ENUM FeatureId,
[*] UINT8 *pFeaturePara,UINT32 *pFeatureParaLen)
[*]{
[*] UINT16 *pFeatureReturnPara16=(UINT16 *) pFeaturePara;
[*] UINT16 *pFeatureData16=(UINT16 *) pFeaturePara;
[*] UINT32 *pFeatureReturnPara32=(UINT32 *) pFeaturePara;
[*] UINT32 *pFeatureData32=(UINT32 *) pFeaturePara;
[*] UINT32 SensorRegNumber;
[*] UINT32 i;
[*] PNVRAM_SENSOR_DATA_STRUCT pSensorDefaultData=(PNVRAM_SENSOR_DATA_STRUCT) pFeaturePara;
[*] MSDK_SENSOR_CONFIG_STRUCT *pSensorConfigData=(MSDK_SENSOR_CONFIG_STRUCT *) pFeaturePara;
[*] MSDK_SENSOR_REG_INFO_STRUCT *pSensorRegData=(MSDK_SENSOR_REG_INFO_STRUCT *) pFeaturePara;
[*] MSDK_SENSOR_GROUP_INFO_STRUCT *pSensorGroupInfo=(MSDK_SENSOR_GROUP_INFO_STRUCT *) pFeaturePara;
[*] MSDK_SENSOR_ITEM_INFO_STRUCT *pSensorItemInfo=(MSDK_SENSOR_ITEM_INFO_STRUCT *) pFeaturePara;
[*] MSDK_SENSOR_ENG_INFO_STRUCT *pSensorEngInfo=(MSDK_SENSOR_ENG_INFO_STRUCT *) pFeaturePara;
[*]
[*] switch (FeatureId)
[*] {
[*] case SENSOR_FEATURE_GET_RESOLUTION:
[*] *pFeatureReturnPara16++= OV5670_IMAGE_SENSOR_FULL_WIDTH;
[*] *pFeatureReturnPara16= OV5670_IMAGE_SENSOR_FULL_HEIGHT;
[*] *pFeatureParaLen=4;
[*] break;
[*] case SENSOR_FEATURE_GET_PERIOD:
[*] *pFeatureReturnPara16++= OV5670_FeatureControl_PERIOD_PixelNum;
[*] *pFeatureReturnPara16= OV5670_FeatureControl_PERIOD_LineNum;
[*] *pFeatureParaLen=4;
[*] break;
[*] case SENSOR_FEATURE_GET_PIXEL_CLOCK_FREQ:
[*] switch(OV5670CurrentScenarioId)
[*] {
[*] case MSDK_SCENARIO_ID_CAMERA_PREVIEW:
[*] *pFeatureReturnPara32 = OV5670_PREVIEW_PCLK;
[*] *pFeatureParaLen=4;
[*] break;
[*] case MSDK_SCENARIO_ID_VIDEO_PREVIEW:
[*] *pFeatureReturnPara32 = OV5670_VIDEO_PCLK;
[*] *pFeatureParaLen=4;
[*] break;
[*] case MSDK_SCENARIO_ID_CAMERA_CAPTURE_JPEG:
[*] case MSDK_SCENARIO_ID_CAMERA_ZSD:
[*] *pFeatureReturnPara32 = OV5670_CAPTURE_PCLK;
[*] *pFeatureParaLen=4;
[*] break;
[*] default:
[*] *pFeatureReturnPara32 = OV5670_PREVIEW_PCLK;
[*] *pFeatureParaLen=4;
[*] break;
[*] }
[*] break;
[*]
[*] case SENSOR_FEATURE_SET_ESHUTTER:
[*] OV5670_SetShutter(*pFeatureData16);
[*] break;
[*] case SENSOR_FEATURE_SET_NIGHTMODE:
[*] OV5670_NightMode((BOOL) *pFeatureData16);
[*] break;
[*] case SENSOR_FEATURE_SET_GAIN:
[*] OV5670_SetGain((UINT16) *pFeatureData16);
[*] break;
[*] case SENSOR_FEATURE_SET_FLASHLIGHT:
[*] break;
[*] case SENSOR_FEATURE_SET_ISP_MASTER_CLOCK_FREQ:
[*] //OV5670_isp_master_clock=*pFeatureData32;
[*] break;
[*] case SENSOR_FEATURE_SET_REGISTER:
[*] OV5670_write_cmos_sensor(pSensorRegData->RegAddr, pSensorRegData->RegData);
[*] break;
[*] case SENSOR_FEATURE_GET_REGISTER:
[*] pSensorRegData->RegData = OV5670_read_cmos_sensor(pSensorRegData->RegAddr);
[*] break;
[*] case SENSOR_FEATURE_SET_CCT_REGISTER:
[*] SensorRegNumber=FACTORY_END_ADDR;
[*] for (i=0;i<SensorRegNumber;i++)
[*] {
[*] spin_lock(&ov5670mipiraw_drv_lock);
[*] OV5670SensorCCT.Addr=*pFeatureData32++;
[*] OV5670SensorCCT.Para=*pFeatureData32++;
[*] spin_unlock(&ov5670mipiraw_drv_lock);
[*] }
[*] break;
[*] case SENSOR_FEATURE_GET_CCT_REGISTER:
[*] SensorRegNumber=FACTORY_END_ADDR;
[*] if (*pFeatureParaLen<(SensorRegNumber*sizeof(SENSOR_REG_STRUCT)+4))
[*] return FALSE;
[*] *pFeatureData32++=SensorRegNumber;
[*] for (i=0;i<SensorRegNumber;i++)
[*] {
[*] *pFeatureData32++=OV5670SensorCCT.Addr;
[*] *pFeatureData32++=OV5670SensorCCT.Para;
[*] }
[*] break;
[*] case SENSOR_FEATURE_SET_ENG_REGISTER:
[*] SensorRegNumber=ENGINEER_END;
[*] for (i=0;i<SensorRegNumber;i++)
[*] {
[*] spin_lock(&ov5670mipiraw_drv_lock);
[*] OV5670SensorReg.Addr=*pFeatureData32++;
[*] OV5670SensorReg.Para=*pFeatureData32++;
[*] spin_unlock(&ov5670mipiraw_drv_lock);
[*] }
[*] break;
[*] case SENSOR_FEATURE_GET_ENG_REGISTER:
[*] SensorRegNumber=ENGINEER_END;
[*] if (*pFeatureParaLen<(SensorRegNumber*sizeof(SENSOR_REG_STRUCT)+4))
[*] return FALSE;
[*] *pFeatureData32++=SensorRegNumber;
[*] for (i=0;i<SensorRegNumber;i++)
[*] {
[*] *pFeatureData32++=OV5670SensorReg.Addr;
[*] *pFeatureData32++=OV5670SensorReg.Para;
[*] }
[*] break;
[*] case SENSOR_FEATURE_GET_REGISTER_DEFAULT:
[*] if (*pFeatureParaLen>=sizeof(NVRAM_SENSOR_DATA_STRUCT))
[*] {
[*] pSensorDefaultData->Version=NVRAM_CAMERA_SENSOR_FILE_VERSION;
[*] pSensorDefaultData->SensorId=OV5670_SENSOR_ID;
[*] memcpy(pSensorDefaultData->SensorEngReg, OV5670SensorReg, sizeof(SENSOR_REG_STRUCT)*ENGINEER_END);
[*] memcpy(pSensorDefaultData->SensorCCTReg, OV5670SensorCCT, sizeof(SENSOR_REG_STRUCT)*FACTORY_END_ADDR);
[*] }
[*] else
[*] return FALSE;
[*] *pFeatureParaLen=sizeof(NVRAM_SENSOR_DATA_STRUCT);
[*] break;
[*] case SENSOR_FEATURE_GET_CONFIG_PARA:
[*] memcpy(pSensorConfigData, &OV5670SensorConfigData, sizeof(MSDK_SENSOR_CONFIG_STRUCT));
[*] *pFeatureParaLen=sizeof(MSDK_SENSOR_CONFIG_STRUCT);
[*] break;
[*] case SENSOR_FEATURE_CAMERA_PARA_TO_SENSOR:
[*] OV5670_camera_para_to_sensor();
[*] break;
[*]
[*] case SENSOR_FEATURE_SENSOR_TO_CAMERA_PARA:
[*] OV5670_sensor_to_camera_para();
[*] break;
[*] case SENSOR_FEATURE_GET_GROUP_COUNT:
[*] *pFeatureReturnPara32++=OV5670_get_sensor_group_count();
[*] *pFeatureParaLen=4;
[*] break;
[*] case SENSOR_FEATURE_GET_GROUP_INFO:
[*] OV5670_get_sensor_group_info(pSensorGroupInfo->GroupIdx, pSensorGroupInfo->GroupNamePtr, &pSensorGroupInfo->ItemCount);
[*] *pFeatureParaLen=sizeof(MSDK_SENSOR_GROUP_INFO_STRUCT);
[*] break;
[*] case SENSOR_FEATURE_GET_ITEM_INFO:
[*] OV5670_get_sensor_item_info(pSensorItemInfo->GroupIdx,pSensorItemInfo->ItemIdx, pSensorItemInfo);
[*] *pFeatureParaLen=sizeof(MSDK_SENSOR_ITEM_INFO_STRUCT);
[*] break;
[*]
[*] case SENSOR_FEATURE_SET_ITEM_INFO:
[*] OV5670_set_sensor_item_info(pSensorItemInfo->GroupIdx, pSensorItemInfo->ItemIdx, pSensorItemInfo->ItemValue);
[*] *pFeatureParaLen=sizeof(MSDK_SENSOR_ITEM_INFO_STRUCT);
[*] break;
[*]
[*] case SENSOR_FEATURE_GET_ENG_INFO:
[*] pSensorEngInfo->SensorId = 129;
[*] pSensorEngInfo->SensorType = CMOS_SENSOR;
[*] pSensorEngInfo->SensorOutputDataFormat=SENSOR_OUTPUT_FORMAT_RAW_Gb;
[*] *pFeatureParaLen=sizeof(MSDK_SENSOR_ENG_INFO_STRUCT);
[*] break;
[*] case SENSOR_FEATURE_GET_LENS_DRIVER_ID:
[*] // get the lens driver ID from EEPROM or just return LENS_DRIVER_ID_DO_NOT_CARE
[*] // if EEPROM does not exist in camera module.
[*] *pFeatureReturnPara32=LENS_DRIVER_ID_DO_NOT_CARE;
[*] *pFeatureParaLen=4;
[*] break;
[*]
[*] case SENSOR_FEATURE_INITIALIZE_AF:
[*] break;
[*] case SENSOR_FEATURE_CONSTANT_AF:
[*] break;
[*] case SENSOR_FEATURE_MOVE_FOCUS_LENS:
[*] break;
[*] case SENSOR_FEATURE_SET_VIDEO_MODE:
[*] OV5670SetVideoMode(*pFeatureData16);
[*] break;
[*] case SENSOR_FEATURE_CHECK_SENSOR_ID://-------------调用此处读取ID
[*] OV5670GetSensorID(pFeatureReturnPara32);
[*] break;
[*] case SENSOR_FEATURE_SET_AUTO_FLICKER_MODE:
[*] OV5670SetAutoFlickerMode((BOOL)*pFeatureData16, *(pFeatureData16+1));
[*] break;
[*] case SENSOR_FEATURE_SET_MAX_FRAME_RATE_BY_SCENARIO:
[*] OV5670MIPISetMaxFramerateByScenario((MSDK_SCENARIO_ID_ENUM)*pFeatureData32, *(pFeatureData32+1));
[*] break;
[*] case SENSOR_FEATURE_GET_DEFAULT_FRAME_RATE_BY_SCENARIO:
[*] OV5670MIPIGetDefaultFramerateByScenario((MSDK_SCENARIO_ID_ENUM)*pFeatureData32, (MUINT32 *)(*(pFeatureData32+1)));
[*] break;
[*] case SENSOR_FEATURE_SET_TEST_PATTERN:
[*] OV5670SetTestPatternMode((BOOL)*pFeatureData16);
[*] break;
[*] case SENSOR_FEATURE_GET_TEST_PATTERN_CHECKSUM_VALUE://for factory mode auto testing
[*] *pFeatureReturnPara32=OV5670_TEST_PATTERN_CHECKSUM;
[*] *pFeatureParaLen=4;
[*] break;
[*] default:
[*] break;
[*] }
[*] return ERROR_NONE;
[*]}
[*]UINT32 OV5670GetSensorID(UINT32 *sensorID)
[*]{
[*] intretry = 2;
[*]
[*] OV5670DB("OV5670GetSensorID enter :\n ");
[*] mdelay(5);
[*]
[*] do {
[*] *sensorID = (OV5670_read_cmos_sensor(0x300B)<<8)|OV5670_read_cmos_sensor(0x300C);
[*] if (*sensorID == OV5670_SENSOR_ID)
[*] {
[*] OV5670DB("Sensor ID = 0x%04x\n", *sensorID);
[*] break;
[*] }
[*] OV5670DB("Read Sensor ID Fail = 0x%04x\n", *sensorID);
[*] retry--;
[*] } while (retry > 0);
[*]
[*] if (*sensorID != OV5670_SENSOR_ID) {
[*] OV5670DB("Read Sensor ID Fail = 0x%04x\n", *sensorID);
[*]
[*] /*
[*] *sensorID = OV5670_SENSOR_ID;
[*] return ERROR_SENSOR_CONNECT_FAIL;
[*] */
[*] *sensorID = 0xFFFFFFFF;
[*] return ERROR_SENSOR_CONNECT_FAIL;
[*] }
[*] return ERROR_NONE;
[*]}
以上是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下电
好东西 给力很多 启发性的好东西！！！
页:
[1]