| /* |
| * Copyright (C) 2018 Intel Corporation |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| |
| #define LOG_TAG "SyncManager" |
| |
| #include "SyncManager.h" |
| #include "MediaController.h" |
| #include "MediaEntity.h" |
| #include "LogHelper.h" |
| #include "PerformanceTraces.h" |
| #include "Camera3GFXFormat.h" |
| #include "CaptureUnit.h" |
| |
| namespace cros { |
| namespace intel { |
| |
| #define MAX_SETTINGS_QUEUE_SIZE (SETTINGS_POOL_SIZE / 2) |
| |
| SyncManager::SyncManager(int32_t cameraId, |
| std::shared_ptr<MediaController> mediaCtl, |
| ISofListener *sofListener, |
| ISettingsSyncListener *listener): |
| mCameraId(cameraId), |
| mMediaCtl(mediaCtl), |
| mSofListener(sofListener), |
| mSensorType(SENSOR_TYPE_NONE), |
| mSensorOp(nullptr), |
| mFrameSyncSource(FRAME_SYNC_NA), |
| mCameraThread("SyncManager"), |
| mStarted(false), |
| mExposureDelay(0), |
| mGainDelay(0), |
| mDigiGainOnSensor(false), |
| mCurrentSettingIdentifier(0), |
| mPollErrorTimes(0), |
| mErrCb(nullptr), |
| mUseDiscreteDg(false) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| mCapInfo = getIPU3CameraCapInfo(cameraId); |
| if (!mCameraThread.Start()) { |
| LOGE("Camera thread failed to start"); |
| } |
| } |
| |
| SyncManager::~SyncManager() |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status; |
| |
| status = stop(); |
| if (status != NO_ERROR) { |
| LOGE("Error stopping sync manager during destructor"); |
| } |
| |
| mCameraThread.Stop(); |
| |
| if (mFrameSyncSource != FRAME_SYNC_NA) { |
| // both EOF and SOF are from the ISYS receiver |
| if (mIsysReceiverSubdev != nullptr) |
| mIsysReceiverSubdev->UnsubscribeEvent(mFrameSyncSource); |
| |
| mFrameSyncSource = FRAME_SYNC_NA; |
| } |
| |
| if (mSensorOp != nullptr) |
| mSensorOp = nullptr; |
| |
| mQueuedSettings.clear(); |
| } |
| |
| /** |
| * based on the type of the mediacontroller entity, the correct subdev |
| * will be chosen. Here, are treated 4 entities. |
| * sensor side: pixel array |
| * ISYS side: isys receiver |
| * |
| * \param[IN] entity: pointer to media entity struct |
| * \param[IN] type: type of the subdev |
| * |
| * \return OK on success, BAD_VALUE on error |
| */ |
| status_t SyncManager::setSubdev(std::shared_ptr<MediaEntity> entity, sensorEntityType type) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| |
| std::shared_ptr<cros::V4L2Subdevice> subdev = nullptr; |
| entity->getDevice((std::shared_ptr<cros::V4L2Device>&) subdev); |
| |
| switch (type) { |
| case SUBDEV_PIXEL_ARRAY: |
| if (entity->getType() != SUBDEV_SENSOR) { |
| LOGE("%s is not sensor subdevice", entity->getName()); |
| return BAD_VALUE; |
| } |
| mPixelArraySubdev = subdev; |
| break; |
| case SUBDEV_ISYSRECEIVER: |
| if (entity->getType() != SUBDEV_GENERIC) { |
| LOGE("%s is not Isys receiver subdevice\n", entity->getName()); |
| } |
| mIsysReceiverSubdev = subdev; |
| break; |
| default: |
| LOGE("Entity type (%d) not existing", type); |
| return BAD_VALUE; |
| } |
| return OK; |
| } |
| |
| /** |
| * wrapper to retrieve media entity and set the appropriate subdev |
| * |
| * \param[IN] name given name of the entity |
| * \param[IN] type type of the subdev |
| * |
| * \return OK on success, BAD_VALUE on error |
| */ |
| status_t SyncManager::setMediaEntity(const std::string &name, |
| const sensorEntityType type) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| std::shared_ptr<MediaEntity> mediaEntity = nullptr; |
| std::string entityName; |
| const IPU3CameraCapInfo *cap = getIPU3CameraCapInfo(mCameraId); |
| |
| if (cap == nullptr) { |
| LOGE("Failed to get cameraCapInfo"); |
| return UNKNOWN_ERROR; |
| } |
| |
| //The entity port of ipu3-csi2 is dynamical, |
| //get ipu3-csi2 0 or 1 from pixel entity sink. |
| if (type == SUBDEV_ISYSRECEIVER) { |
| const char* pixelType = "pixel_array"; |
| |
| entityName = cap->getMediaCtlEntityName(pixelType); |
| status = mMediaCtl->getMediaEntity(mediaEntity, entityName.c_str()); |
| if (mediaEntity == nullptr || status != NO_ERROR) { |
| LOGE("Could not retrieve media entity %s", entityName.c_str()); |
| return UNKNOWN_ERROR; |
| } |
| std::vector<string> names; |
| names.clear(); |
| status = mMediaCtl->getSinkNamesForEntity(mediaEntity, names); |
| if (names.size()== 0 || status != NO_ERROR) { |
| LOGE("Could not retrieve sink name of media entity %s", |
| entityName.c_str()); |
| return UNKNOWN_ERROR; |
| } |
| |
| LOG1("camera %d using csi port: %s\n", mCameraId, names[0].c_str()); |
| entityName = names[0]; |
| } else { |
| entityName = cap->getMediaCtlEntityName(name); |
| } |
| |
| LOG1("found entityName: %s\n", entityName.c_str()); |
| if (entityName == "none" && name == "pixel_array") { |
| LOGE("No %s in this Sensor. Should not happen", entityName.c_str()); |
| return UNKNOWN_ERROR; |
| } else if (entityName == "none") { |
| LOG1("No %s in this Sensor. Should not happen", entityName.c_str()); |
| } else { |
| status = mMediaCtl->getMediaEntity(mediaEntity, entityName.c_str()); |
| if (mediaEntity == nullptr || status != NO_ERROR) { |
| LOGE("Could not retrieve media entity %s", entityName.c_str()); |
| return UNKNOWN_ERROR; |
| } |
| status = setSubdev(mediaEntity, type); |
| if (status != OK) { |
| LOGE("Cannot set %s subdev", entityName.c_str()); |
| return status; |
| } |
| } |
| |
| return status; |
| } |
| |
| /** |
| * Enqueue init message to message queue. |
| * |
| * \param[IN] exposureDelay exposure delay |
| * \param[IN] gainDelay gain delay |
| * |
| * \return status of synchronous messaging. |
| */ |
| status_t SyncManager::init(int32_t exposureDelay, int32_t gainDelay) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| MessageInit msg; |
| /** |
| * The delay we want to store is the relative between exposure and gain |
| * Usually exposure time delay is bigger. The model currently |
| * does not support the other case. We have not seen any sensor that |
| * does this. |
| */ |
| if (exposureDelay >= gainDelay) { |
| msg.gainDelay = exposureDelay - gainDelay; |
| } else { |
| LOGE("analog Gain delay bigger than exposure... not supported - BUG"); |
| msg.gainDelay = 0; |
| } |
| msg.exposureDelay = exposureDelay; |
| |
| status_t status = NO_ERROR; |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleInit, base::Unretained(this), |
| base::Passed(std::move(msg))); |
| mCameraThread.PostTaskSync<status_t>(FROM_HERE, closure, &status); |
| return status; |
| } |
| |
| void SyncManager::registerErrorCallback(IErrorCallback *errCb) |
| { |
| LOG1("@%s, errCb:%p", __FUNCTION__, errCb); |
| mErrCb = errCb; |
| } |
| |
| /** |
| * function to init the SyncManager. |
| * set subdev. |
| * create sensor object, pollerthread object. |
| * register sensor events. |
| */ |
| status_t SyncManager::handleInit(MessageInit msg) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| mExposureDelay = msg.exposureDelay; |
| mGainDelay = msg.gainDelay; |
| mDigiGainOnSensor = mCapInfo->digiGainOnSensor(); |
| mSensorType = (SensorType)mCapInfo->sensorType(); |
| |
| // set pixel array |
| status = setMediaEntity("pixel_array", SUBDEV_PIXEL_ARRAY); |
| if (status != NO_ERROR) { |
| LOGE("Cannot set pixel array"); |
| goto exit; |
| } |
| status = createSensorObj(); |
| if (status != NO_ERROR) { |
| LOGE("Failed to create sensor object"); |
| goto exit; |
| } |
| |
| /* WA for using discrete digital gain */ |
| if (mCapInfo->mAgMaxRatio && mCapInfo->mAgMultiplier) { |
| if (mSensorOp->createDiscreteDgMap(&mUseDiscreteDg)) |
| LOG2("%s no discrete DG for this sensor", __FUNCTION__); |
| } |
| |
| mQueuedSettings.clear(); |
| mDelayedAGains.clear(); |
| mDelayedDGains.clear(); |
| |
| exit: |
| return status; |
| } |
| |
| /** |
| * method to check what type of driver the kernel |
| * is using and create sensor object based on it. |
| * at the moment, either SMIA or CRL. |
| * |
| * \return OK if success. |
| */ |
| status_t SyncManager::createSensorObj() |
| { |
| status_t status = OK; |
| |
| if (mPixelArraySubdev == nullptr) { |
| LOGE("Pixel array sub device not set"); |
| return UNKNOWN_ERROR; |
| } |
| |
| mSensorOp = std::make_shared<SensorHwOp>(mPixelArraySubdev); |
| |
| return status; |
| } |
| |
| /** |
| * get sensor mode data after init. |
| * |
| * \param[OUT] desc sensor descriptor data |
| * |
| * \return OK, if sensor mode data retrieval was successful with good values |
| * \return UNKNOWN_ERROR if pixel clock value was bad |
| * \return Other non-OK value depending on error case |
| */ |
| status_t SyncManager::getSensorModeData(ia_aiq_exposure_sensor_descriptor &desc) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| MessageSensorModeData msg; |
| |
| msg.desc = &desc; |
| |
| status_t status = OK; |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleGetSensorModeData, |
| base::Unretained(this), base::Passed(std::move(msg))); |
| mCameraThread.PostTaskSync<status_t>(FROM_HERE, closure, &status); |
| return status; |
| } |
| |
| /** |
| * retrieve mode data (descriptor) from sensor |
| * |
| * \param[in] msg holding pointer to descriptor pointer |
| */ |
| status_t SyncManager::handleGetSensorModeData(MessageSensorModeData msg) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| int integration_step = 0; |
| int integration_max = 0; |
| int pixel = 0; |
| unsigned int vBlank = 0; |
| ia_aiq_exposure_sensor_descriptor *desc; |
| |
| desc = msg.desc; |
| |
| status = mSensorOp->getPixelRate(pixel); |
| if (status != NO_ERROR) { |
| LOGE("Failed to get pixel clock"); |
| return status; |
| } else if (pixel == 0) { |
| LOGE("Bad pixel clock value: %d", pixel); |
| return UNKNOWN_ERROR; |
| } |
| |
| desc->pixel_clock_freq_mhz = (float)pixel / 1000000; |
| unsigned int pixel_periods_per_line = 0, line_periods_per_field = 0; |
| |
| status = mSensorOp->updateMembers(); |
| if (status != NO_ERROR) { |
| LOGE("Failed to update members"); |
| return status; |
| } |
| |
| status = mSensorOp->getMinimumFrameDuration(pixel_periods_per_line, |
| line_periods_per_field); |
| if (status != NO_ERROR) { |
| LOGE("Failed to get frame Durations"); |
| return status; |
| } |
| desc->pixel_periods_per_line = pixel_periods_per_line > USHRT_MAX ? |
| USHRT_MAX: pixel_periods_per_line; |
| desc->line_periods_per_field = line_periods_per_field > USHRT_MAX ? |
| USHRT_MAX: line_periods_per_field; |
| |
| int coarse_int_time_min = -1; |
| status = mSensorOp->getExposureRange(coarse_int_time_min, |
| integration_max, integration_step); |
| if (status != NO_ERROR) { |
| LOGE("Failed to get Exposure Range"); |
| return status; |
| } |
| |
| desc->coarse_integration_time_min = CLIP(coarse_int_time_min, SHRT_MAX, 0); |
| |
| LOG2("%s: Exposure range coarse :min = %d, max = %d, step = %d", |
| __FUNCTION__, |
| desc->coarse_integration_time_min, |
| integration_max, integration_step); |
| |
| desc->coarse_integration_time_max_margin = mCapInfo->getCITMaxMargin(); |
| |
| //INFO: fine integration is not supported by v4l2 |
| desc->fine_integration_time_min = 0; |
| desc->fine_integration_time_max_margin = desc->pixel_periods_per_line; |
| |
| status = mSensorOp->getVBlank(vBlank); |
| desc->line_periods_vertical_blanking = vBlank > USHRT_MAX ? USHRT_MAX: vBlank; |
| |
| LOG2("%s: pixel clock = %f ppl = %d, lpf =%d, int_min = %d, int_max_range %d", |
| __FUNCTION__, |
| desc->pixel_clock_freq_mhz, |
| desc->pixel_periods_per_line, |
| desc->line_periods_per_field, |
| desc->coarse_integration_time_min, |
| desc->coarse_integration_time_max_margin); |
| |
| return status; |
| } |
| |
| /** |
| * enqueue to message queue parameter setting |
| * |
| * \param[in] settings Capture settings |
| * |
| * \return status for enqueueing message |
| */ |
| status_t SyncManager::setParameters(std::shared_ptr<CaptureUnitSettings> settings) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleSetParams, base::Unretained(this), |
| base::Passed(std::move(settings))); |
| mCameraThread.PostTaskAsync<status_t>(FROM_HERE, closure); |
| return OK; |
| } |
| |
| /** |
| * |
| * Queue new settings that will be consumed on next SOF |
| * |
| * \param[in] msg holding settings |
| * |
| * \return OK |
| */ |
| status_t SyncManager::handleSetParams(std::shared_ptr<CaptureUnitSettings> settings) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| LOGP("%s add one hold for %p in mCaptureUnitSettingsPool", __FUNCTION__, settings.get()); |
| mQueuedSettings.push_back(std::move(settings)); |
| |
| if (mQueuedSettings.size() > MAX_SETTINGS_QUEUE_SIZE) { |
| LOGP("%s size>max delete one hold for %p in mCaptureUnitSettingsPool", |
| __FUNCTION__, mQueuedSettings.begin()->get()); |
| mQueuedSettings.erase(mQueuedSettings.begin()); |
| } |
| return OK; |
| } |
| |
| /** |
| * |
| * Set the sensor frame timing calculation width and height |
| * |
| * \param[in] width sensor frame timing calculation width |
| * \param[in] height sensor frame timing calculation height |
| * |
| * \return OK |
| */ |
| status_t SyncManager::setSensorFT(int width, int height) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| MessageSensorFT msg; |
| msg.width = width; |
| msg.height = height; |
| |
| status_t status = OK; |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleSetSensorFT, |
| base::Unretained(this), base::Passed(std::move(msg))); |
| mCameraThread.PostTaskSync<status_t>(FROM_HERE, closure, &status); |
| return status; |
| } |
| |
| status_t SyncManager::handleSetSensorFT(MessageSensorFT msg) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| status_t status = OK; |
| int width = msg.width; |
| int height = msg.height; |
| |
| if (mSensorOp.get() == nullptr) { |
| LOGE("SensorHwOp class not initialized"); |
| return UNKNOWN_ERROR; |
| } |
| |
| status = mSensorOp->setSensorFT(width, height); |
| if (status != NO_ERROR) { |
| LOGE("Failed to set sensor config"); |
| return UNKNOWN_ERROR; |
| } |
| |
| return status; |
| } |
| |
| /** |
| * Process work to do on SOF event detection |
| * |
| * \param[in] msg holding SOF event data. |
| * |
| * |
| * \return status for work done |
| */ |
| status_t SyncManager::handleSOF(MessageFrameEvent msg) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| status_t status = OK; |
| |
| if (!mStarted) { |
| LOGD("SOF[%d] received while closing- ignoring", msg.exp_id); |
| return OK; |
| } |
| // Poll again |
| mPollerThread->pollRequest(0, IPU3_EVENT_POLL_TIMEOUT, |
| (std::vector<std::shared_ptr<cros::V4L2Device>>*) &mDevicesToPoll); |
| |
| if (CC_UNLIKELY(mQueuedSettings.empty())) { |
| LOG2("SOF[%d] Arrived and sensor does not have settings queued", |
| msg.exp_id); |
| // TODO: this will become an error once we fix capture unit to run at |
| // sensor rate. |
| // delete all gain from old previous client request. |
| mDelayedAGains.clear(); |
| mDelayedDGains.clear(); |
| } else { |
| mCurrentSettingIdentifier = mQueuedSettings[0]->settingsIdentifier; |
| ia_aiq_exposure_sensor_parameters &expParams = |
| *mQueuedSettings[0]->aiqResults.aeResults.exposures[0].sensor_exposure; |
| |
| LOG2("Applying settings @exp_id %d in Effect @ %d", |
| msg.exp_id, msg.exp_id + mExposureDelay); |
| |
| status = applySensorParams(expParams); |
| if (status != NO_ERROR) |
| LOGE("Failed to apply sensor parameters."); |
| |
| int mode = mCapInfo->getSensorTestPatternMode(mQueuedSettings[0]->testPatternMode); |
| |
| status = mSensorOp->setTestPattern(mode); |
| CheckError((status != NO_ERROR), status, "@%s, Fail to set test pattern mode = %d [%d]!", |
| __FUNCTION__, mQueuedSettings[0]->testPatternMode, status); |
| |
| /** |
| * Mark the exposure id where this settings should be in effect. |
| * this is used by the control unit to find the correct settings |
| * for stats. |
| * Then remove it from the Q. |
| */ |
| mQueuedSettings[0]->inEffectFrom = msg.exp_id + mExposureDelay; |
| LOGP("%s sof come, delete one hold for %p in mCaptureUnitSettingsPool", |
| __FUNCTION__, mQueuedSettings.begin()->get()); |
| mQueuedSettings.erase(mQueuedSettings.begin()); |
| } |
| return status; |
| } |
| |
| /** |
| * Process work to do on EOF event detection |
| * |
| * \param[in] msg holding EOF event data. |
| * |
| * |
| * \return status for work done |
| */ |
| status_t SyncManager::handleEOF() |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| /** |
| * We are not getting EOF yet, but once we do ... |
| * TODO: In this case we should check the time before we apply the settings |
| * to make sure we apply them after blanking. |
| */ |
| return OK; |
| } |
| |
| /** |
| * Apply current ae results to sensor |
| * |
| * \param[in] expParams sensor exposure parameters to apply |
| * \param[in] noDelay apply directly sensor parameters |
| * \return status of IOCTL to sensor AE settings. |
| */ |
| status_t SyncManager::applySensorParams(ia_aiq_exposure_sensor_parameters &expParams, |
| bool noDelay) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| status_t status = OK; |
| uint16_t aGain, dGain; |
| uint16_t analog_gain_code_global = expParams.analog_gain_code_global; |
| uint16_t digital_gain_global = expParams.digital_gain_global; |
| |
| // Frame duration |
| status |= mSensorOp->setFrameDuration(expParams.line_length_pixels, |
| expParams.frame_length_lines); |
| |
| // Discrete digital gain, seperate total gain = AG x DG |
| if (mUseDiscreteDg && mCapInfo->mAgMaxRatio && mCapInfo->mAgMultiplier) { |
| int ag_product, analog_gain_code, analog_gain_divisor; |
| uint16_t total_gain = expParams.analog_gain_code_global; |
| uint16_t digital_gain = (total_gain + (mCapInfo->mAgMaxRatio * mCapInfo->mAgMultiplier) |
| - 1) / (mCapInfo->mAgMaxRatio * mCapInfo->mAgMultiplier); |
| uint16_t digital_gain_idx; |
| bool ag_fail = false; |
| |
| LOG2("%s total gain:%d, target dg:%d", __FUNCTION__, total_gain, digital_gain); |
| |
| mSensorOp->getDiscreteDg(&digital_gain, &digital_gain_idx); |
| if (digital_gain == 0) { |
| LOGE("%s DG==0, wrong, at least 1", __FUNCTION__); |
| digital_gain = 1; |
| digital_gain_idx = 0; |
| } |
| |
| // total gain = (AG * AgMultiplier) * DG => ag_product * DG |
| ag_product = total_gain / digital_gain; |
| |
| // Set DG idx to digital gain, driver will covert it to DG code |
| digital_gain_global = digital_gain_idx; |
| |
| /* |
| * SMIA: AG = (m0*X + c0)/(m1*X + c1), which X = AG code for reg setting. |
| * => AG*m1*X + AG * c1 = m0 * X + c0 => X= (c0 - AG * c1) / (AG * m1 - m0) |
| * => X = (AgMultiplier * (c0 - AG * c1)) / (AgMultiplier * (AG * m1 - m0)) for the |
| * more precise gain code. |
| */ |
| analog_gain_divisor = (ag_product * mCapInfo->mSMIAm1) - |
| (mCapInfo->mAgMultiplier * mCapInfo->mSMIAm0); |
| if (analog_gain_divisor) { |
| analog_gain_code = ((mCapInfo->mAgMultiplier * mCapInfo->mSMIAc0) - |
| (ag_product * mCapInfo->mSMIAc1)) / analog_gain_divisor; |
| if (analog_gain_code >= 0) |
| analog_gain_code_global = (uint16_t)analog_gain_code; |
| else |
| ag_fail = true; |
| } else { |
| ag_fail = true; |
| } |
| |
| if (ag_fail) |
| LOGE("%s, wrong AG, m0 or m1: %d, %d", __FUNCTION__, |
| mCapInfo->mSMIAm0, mCapInfo->mSMIAm1); |
| |
| LOG2("%s new AG:%d, DG:%d", __FUNCTION__, analog_gain_code_global, digital_gain_global); |
| } |
| |
| // gain |
| mDelayedAGains.push_back(analog_gain_code_global); |
| mDelayedDGains.push_back(digital_gain_global); |
| aGain = mDelayedAGains[0]; |
| dGain = mDelayedDGains[0]; |
| if (mDelayedAGains.size() > mGainDelay) { |
| mDelayedAGains.erase(mDelayedAGains.begin()); |
| mDelayedDGains.erase(mDelayedDGains.begin()); |
| } |
| |
| if (mDigiGainOnSensor == false) |
| dGain = 0; |
| |
| status |= mSensorOp->setGains(noDelay ? expParams.analog_gain_code_global : aGain, |
| noDelay ? expParams.digital_gain_global : dGain); |
| |
| // set exposure at last in order to trigger sensor driver apply all exp settings |
| status |= mSensorOp->setExposure(expParams.coarse_integration_time, |
| expParams.fine_integration_time); |
| |
| return status; |
| } |
| |
| /** |
| * enqueue request to start |
| * |
| * \return value of success for enqueueing message |
| */ |
| status_t SyncManager::start() |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleStart, base::Unretained(this)); |
| mCameraThread.PostTaskSync<status_t>(FROM_HERE, closure, &status); |
| return status; |
| } |
| |
| /** |
| * |
| * Request start of polling to sensor sync events |
| */ |
| status_t SyncManager::handleStart() |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| if (mStarted) { |
| LOGW("SyncManager already started"); |
| return OK; |
| } |
| |
| status = initSynchronization(); |
| if (CC_UNLIKELY(status != NO_ERROR)) { |
| LOGE("Failed to initialize CSI synchronization"); |
| return UNKNOWN_ERROR; |
| } |
| |
| if (!mQueuedSettings.empty()) { |
| ia_aiq_exposure_sensor_parameters &expParams = |
| *mQueuedSettings[0]->aiqResults.aeResults.exposures[0].sensor_exposure; |
| |
| LOG1("Applying FIRST settings"); |
| status = applySensorParams(expParams); |
| if (CC_UNLIKELY(status != NO_ERROR)) { |
| LOGE("Failed to apply sensor parameters."); |
| } |
| |
| /** |
| * Mark the exposure id where this settings should be in effect |
| */ |
| mQueuedSettings[0]->inEffectFrom = 0; |
| mQueuedSettings.erase(mQueuedSettings.begin()); |
| } |
| mStarted = true; |
| mPollErrorTimes = 0; |
| |
| // Start to poll |
| mPollerThread->pollRequest(0, IPU3_EVENT_POLL_TIMEOUT, |
| (std::vector<std::shared_ptr<cros::V4L2Device>>*) &mDevicesToPoll); |
| return OK; |
| } |
| |
| /** |
| * enqueue requeue request for isStarted |
| * |
| * \return value of success for enqueueing message |
| */ |
| status_t SyncManager::isStarted(bool &started) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| MessageIsStarted msg; |
| msg.value = &started; |
| |
| status_t status = OK; |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleIsStarted, |
| base::Unretained(this), base::Passed(std::move(msg))); |
| mCameraThread.PostTaskSync<status_t>(FROM_HERE, closure, &status); |
| return status; |
| } |
| |
| /** |
| * tells if the event is taken into account or not. |
| * |
| * \return OK |
| */ |
| status_t SyncManager::handleIsStarted(MessageIsStarted msg) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| |
| *msg.value = mStarted; |
| |
| return OK; |
| } |
| |
| /** |
| * enqueue request to stop |
| * |
| * \return value of success for enqueueing message |
| */ |
| status_t SyncManager::stop() |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleStop, base::Unretained(this)); |
| mCameraThread.PostTaskSync<status_t>(FROM_HERE, closure, &status); |
| return status; |
| } |
| |
| /** |
| * empty queues and request stop. |
| * |
| * De initializes synchronization mechanism. |
| * |
| * \return OK |
| */ |
| status_t SyncManager::handleStop() |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| |
| if (mStarted) { |
| status = mPollerThread->flush(true); |
| if (status != NO_ERROR) |
| LOGE("could not flush Sensor pollerThread"); |
| mStarted = false; |
| } |
| |
| status = deInitSynchronization(); |
| return status; |
| } |
| |
| /** |
| * enqueue request to flush the queue of polling requests |
| * synchronous call |
| * |
| * \return flush status from Pollerthread. |
| */ |
| status_t SyncManager::flush() |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleFlush, base::Unretained(this)); |
| mCameraThread.PostTaskSync<status_t>(FROM_HERE, closure, &status); |
| return status; |
| } |
| |
| /** |
| * empty queues and request of sensor settings |
| */ |
| status_t SyncManager::handleFlush() |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL1, LOG_TAG); |
| status_t status = OK; |
| |
| if (mPollerThread) |
| status = mPollerThread->flush(true); |
| |
| mQueuedSettings.clear(); |
| |
| return status; |
| } |
| |
| int SyncManager::getCurrentCameraId(void) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| return mCameraId; |
| } |
| |
| /** |
| * gets notification everytime an event is triggered |
| * in the PollerThread SyncManager is subscribed. |
| * |
| * \param[in] pollEventMsg containing information on poll data |
| * |
| * \return status on parsing poll data validity |
| */ |
| status_t SyncManager::notifyPollEvent(PollEventMessage *pollEventMsg) |
| { |
| HAL_TRACE_CALL(CAMERA_DEBUG_LOG_LEVEL2, LOG_TAG); |
| struct v4l2_event event; |
| MessageFrameEvent msg; |
| status_t status = OK; |
| |
| CLEAR(event); |
| if (pollEventMsg == nullptr || pollEventMsg->data.activeDevices == nullptr) |
| return BAD_VALUE; |
| |
| if (pollEventMsg->id == POLL_EVENT_ID_ERROR) { |
| LOGE("Polling Failed for frame id: %d, ret was %d", |
| pollEventMsg->data.reqId, |
| pollEventMsg->data.pollStatus); |
| |
| // Poll again if poll error times is less than the threshold. |
| if (mPollErrorTimes++ < POLL_REQUEST_TRY_TIMES) { |
| status = mPollerThread->pollRequest(0, IPU3_EVENT_POLL_TIMEOUT, |
| (std::vector<std::shared_ptr<cros::V4L2Device>>*) &mDevicesToPoll); |
| return status; |
| } else if (mErrCb) { |
| // return a error message if poll failed happens 5 times in succession |
| mErrCb->deviceError(); |
| return UNKNOWN_ERROR; |
| } |
| } else if (pollEventMsg->data.activeDevices->empty()) { |
| LOG1("%s Polling from Flush: succeeded", __FUNCTION__); |
| // TODO flush actions. |
| } else { |
| //cannot be anything else than event if ending up here. |
| do { |
| mPollErrorTimes = 0; |
| status = mIsysReceiverSubdev->DequeueEvent(&event); |
| if (status < 0) { |
| LOGE("dequeueing event failed"); |
| break; |
| } |
| |
| msg.timestamp.tv_sec = event.timestamp.tv_sec; |
| msg.timestamp.tv_usec = (event.timestamp.tv_nsec / 1000); |
| msg.exp_id = event.u.frame_sync.frame_sequence; |
| msg.reqId = pollEventMsg->data.reqId; |
| if (mFrameSyncSource == FRAME_SYNC_SOF) { |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleSOF, |
| base::Unretained(this), |
| base::Passed(std::move(msg))); |
| mCameraThread.PostTaskAsync<status_t>(FROM_HERE, closure); |
| } else if (mFrameSyncSource == FRAME_SYNC_EOF) { |
| base::Callback<status_t()> closure = |
| base::Bind(&SyncManager::handleEOF, |
| base::Unretained(this)); |
| mCameraThread.PostTaskAsync<status_t>(FROM_HERE, closure); |
| } else { |
| LOGE("Unhandled frame sync source : %d", mFrameSyncSource); |
| } |
| LOG2("%s: EVENT, MessageId: %d, activedev: %lu, reqId: %d, seq: %u, frame sequence: %u", |
| __FUNCTION__, pollEventMsg->id, pollEventMsg->data.activeDevices->size(), |
| pollEventMsg->data.reqId, event.sequence, event.u.frame_sync.frame_sequence); |
| |
| // notify SOF event |
| mSofListener->notifySofEvent(event.u.frame_sync.frame_sequence, event.timestamp); |
| } while (event.pending > 0); |
| } |
| return OK; |
| } |
| |
| /** |
| * Open the sync sub-device (CSI receiver). |
| * Subscribe to SOF events. |
| * Create and initialize the poller thread to poll SOF events from it. |
| * |
| * \return OK |
| * \return UNKNOWN_ERROR If we could not find the CSI receiver sub-device. |
| * \return NO_DATA If we could not allocate the PollerThread |
| */ |
| status_t SyncManager::initSynchronization() |
| { |
| status_t status = OK; |
| mDevicesToPoll.clear(); |
| /* |
| * find the sub-device that represent the csi receiver, open it and keep a |
| * reference in mIsysReceiverSubdev |
| */ |
| status = setMediaEntity("csi_receiver", SUBDEV_ISYSRECEIVER); |
| if (CC_UNLIKELY(status != NO_ERROR)) { |
| LOGE("Cannot find the isys csi-receiver"); |
| return UNKNOWN_ERROR; |
| } |
| |
| if (CC_UNLIKELY(mIsysReceiverSubdev == nullptr)) { |
| LOGE("ISYS Receiver Sub device to poll is nullptr"); |
| return UNKNOWN_ERROR; |
| } |
| |
| /* |
| * SOF is checked first and preferred to EOF, because it provides a better |
| * timing on how to apply the parameters and doesn't include any |
| * calculation. |
| */ |
| status = mIsysReceiverSubdev->SubscribeEvent(FRAME_SYNC_SOF); |
| if (status != NO_ERROR) { |
| LOG1("SOF event not supported on ISYS receiver node, trying EOF"); |
| status = mIsysReceiverSubdev->SubscribeEvent(FRAME_SYNC_EOF); |
| if (status != NO_ERROR) { |
| LOGE("EOF event not existing on ISYS receiver node, FAIL"); |
| return status; |
| } |
| mFrameSyncSource = FRAME_SYNC_EOF; |
| LOG1("%s: Using EOF event", __FUNCTION__); |
| } else { |
| mFrameSyncSource = FRAME_SYNC_SOF; |
| LOG1("%s: Using SOF event", __FUNCTION__); |
| } |
| |
| mDevicesToPoll.push_back(mIsysReceiverSubdev); |
| |
| mPollerThread.reset(new PollerThread("SensorPollerThread")); |
| |
| status = mPollerThread->init((std::vector<std::shared_ptr<cros::V4L2Device>>&)mDevicesToPoll, |
| this, POLLPRI | POLLIN | POLLERR, false); |
| if (status != NO_ERROR) |
| LOGE("Failed to init PollerThread in sync manager"); |
| |
| return status; |
| } |
| |
| /** |
| * |
| * Un-subscribe from the events |
| * Delete the poller thread. |
| * Clear list of devices to poll. |
| * |
| * NOTE: It assumes that the poller thread is stopped. |
| * \return OK |
| */ |
| status_t SyncManager::deInitSynchronization() |
| { |
| if (mIsysReceiverSubdev) { |
| if (mFrameSyncSource != FRAME_SYNC_NA) |
| mIsysReceiverSubdev->UnsubscribeEvent(mFrameSyncSource); |
| mIsysReceiverSubdev->Close(); |
| mIsysReceiverSubdev.reset(); |
| mFrameSyncSource = FRAME_SYNC_NA; |
| } |
| if (mPollerThread) |
| mPollerThread->requestExitAndWait(); |
| mPollerThread.reset(); |
| mDevicesToPoll.clear(); |
| |
| return OK; |
| } |
| } // namespace intel |
| } // namespace cros |
