| /* Copyright (c) 2012-2014 The Linux Foundataion. All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are |
| * met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above |
| * copyright notice, this list of conditions and the following |
| * disclaimer in the documentation and/or other materials provided |
| * with the distribution. |
| * * Neither the name of The Linux Foundation nor the names of its |
| * contributors may be used to endorse or promote products derived |
| * from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED |
| * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS |
| * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE |
| * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN |
| * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| * |
| */ |
| |
| #define LOG_TAG "QCameraStream" |
| |
| #include <utils/Errors.h> |
| #include "QCamera2HWI.h" |
| #include "QCameraStream.h" |
| |
| #define CAMERA_MIN_ALLOCATED_BUFFERS 3 |
| |
| namespace qcamera { |
| |
| /*=========================================================================== |
| * FUNCTION : get_bufs |
| * |
| * DESCRIPTION: static function entry to allocate stream buffers |
| * |
| * PARAMETERS : |
| * @offset : offset info of stream buffers |
| * @num_bufs : number of buffers allocated |
| * @initial_reg_flag: flag to indicate if buffer needs to be registered |
| * at kernel initially |
| * @bufs : output of allocated buffers |
| * @ops_tbl : ptr to buf mapping/unmapping ops |
| * @user_data : user data ptr of ops_tbl |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::get_bufs( |
| cam_frame_len_offset_t *offset, |
| uint8_t *num_bufs, |
| uint8_t **initial_reg_flag, |
| mm_camera_buf_def_t **bufs, |
| mm_camera_map_unmap_ops_tbl_t *ops_tbl, |
| void *user_data) |
| { |
| QCameraStream *stream = reinterpret_cast<QCameraStream *>(user_data); |
| if (!stream) { |
| ALOGE("getBufs invalid stream pointer"); |
| return NO_MEMORY; |
| } |
| return stream->getBufs(offset, num_bufs, initial_reg_flag, bufs, ops_tbl); |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : get_bufs_deffered |
| * |
| * DESCRIPTION: static function entry to allocate deffered stream buffers |
| * |
| * PARAMETERS : |
| * @offset : offset info of stream buffers |
| * @num_bufs : number of buffers allocated |
| * @initial_reg_flag: flag to indicate if buffer needs to be registered |
| * at kernel initially |
| * @bufs : output of allocated buffers |
| * @ops_tbl : ptr to buf mapping/unmapping ops |
| * @user_data : user data ptr of ops_tbl |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::get_bufs_deffered( |
| cam_frame_len_offset_t * /* offset */, |
| uint8_t *num_bufs, |
| uint8_t **initial_reg_flag, |
| mm_camera_buf_def_t **bufs, |
| mm_camera_map_unmap_ops_tbl_t * /* ops_tbl */, |
| void *user_data) |
| { |
| QCameraStream *stream = reinterpret_cast<QCameraStream *>(user_data); |
| if (!stream) { |
| ALOGE("getBufs invalid stream pointer"); |
| return NO_MEMORY; |
| } |
| |
| *initial_reg_flag = stream->mRegFlags; |
| *num_bufs = stream->mNumBufs; |
| *bufs = stream->mBufDefs; |
| return NO_ERROR; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : put_bufs |
| * |
| * DESCRIPTION: static function entry to deallocate stream buffers |
| * |
| * PARAMETERS : |
| * @ops_tbl : ptr to buf mapping/unmapping ops |
| * @user_data : user data ptr of ops_tbl |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::put_bufs( |
| mm_camera_map_unmap_ops_tbl_t *ops_tbl, |
| void *user_data) |
| { |
| QCameraStream *stream = reinterpret_cast<QCameraStream *>(user_data); |
| if (!stream) { |
| ALOGE("putBufs invalid stream pointer"); |
| return NO_MEMORY; |
| } |
| return stream->putBufs(ops_tbl); |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : put_bufs_deffered |
| * |
| * DESCRIPTION: static function entry to deallocate deffered stream buffers |
| * |
| * PARAMETERS : |
| * @ops_tbl : ptr to buf mapping/unmapping ops |
| * @user_data : user data ptr of ops_tbl |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::put_bufs_deffered( |
| mm_camera_map_unmap_ops_tbl_t * /*ops_tbl */, |
| void * /*user_data*/ ) |
| { |
| // No op |
| // Used for handling buffers with deffered allocation. They are freed separately. |
| return NO_ERROR; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : invalidate_buf |
| * |
| * DESCRIPTION: static function entry to invalidate a specific stream buffer |
| * |
| * PARAMETERS : |
| * @index : index of the stream buffer to invalidate |
| * @user_data : user data ptr of ops_tbl |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::invalidate_buf(int index, void *user_data) |
| { |
| QCameraStream *stream = reinterpret_cast<QCameraStream *>(user_data); |
| if (!stream) { |
| ALOGE("invalid stream pointer"); |
| return NO_MEMORY; |
| } |
| if (stream->mStreamInfo->is_secure != SECURE) |
| return stream->invalidateBuf(index); |
| |
| return 0; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : clean_invalidate_buf |
| * |
| * DESCRIPTION: static function entry to clean invalidate a specific stream buffer |
| * |
| * PARAMETERS : |
| * @index : index of the stream buffer to clean invalidate |
| * @user_data : user data ptr of ops_tbl |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::clean_invalidate_buf(int index, void *user_data) |
| { |
| QCameraStream *stream = reinterpret_cast<QCameraStream *>(user_data); |
| if (!stream) { |
| ALOGE("invalid stream pointer"); |
| return NO_MEMORY; |
| } |
| |
| if (stream->mStreamInfo->is_secure != SECURE) |
| return stream->cleanInvalidateBuf(index); |
| |
| return 0; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : QCameraStream |
| * |
| * DESCRIPTION: constructor of QCameraStream |
| * |
| * PARAMETERS : |
| * @allocator : memory allocator obj |
| * @camHandle : camera handle |
| * @chId : channel handle |
| * @camOps : ptr to camera ops table |
| * @paddingInfo: ptr to padding info |
| * |
| * RETURN : None |
| *==========================================================================*/ |
| QCameraStream::QCameraStream(QCameraAllocator &allocator, |
| uint32_t camHandle, |
| uint32_t chId, |
| mm_camera_ops_t *camOps, |
| cam_padding_info_t *paddingInfo, |
| bool deffered) : |
| mDumpFrame(0), |
| mDumpMetaFrame(0), |
| mDumpSkipCnt(0), |
| mCamHandle(camHandle), |
| mChannelHandle(chId), |
| mHandle(0), |
| mCamOps(camOps), |
| mStreamInfo(NULL), |
| mNumBufs(0), |
| mNumBufsNeedAlloc(0), |
| mDataCB(NULL), |
| mUserData(NULL), |
| mDataQ(releaseFrameData, this), |
| mStreamInfoBuf(NULL), |
| mStreamBufs(NULL), |
| mAllocator(allocator), |
| mBufDefs(NULL), |
| mStreamBufsAcquired(false), |
| m_bActive(false), |
| mDynBufAlloc(false), |
| mBufAllocPid(0), |
| mDefferedAllocation(deffered), |
| wait_for_cond(false) |
| { |
| mMemVtbl.user_data = this; |
| if ( !deffered ) { |
| mMemVtbl.get_bufs = get_bufs; |
| mMemVtbl.put_bufs = put_bufs; |
| } else { |
| mMemVtbl.get_bufs = get_bufs_deffered; |
| mMemVtbl.put_bufs = put_bufs_deffered; |
| } |
| mMemVtbl.invalidate_buf = invalidate_buf; |
| mMemVtbl.clean_invalidate_buf = clean_invalidate_buf; |
| memset(&mFrameLenOffset, 0, sizeof(mFrameLenOffset)); |
| memcpy(&mPaddingInfo, paddingInfo, sizeof(cam_padding_info_t)); |
| memset(&mCropInfo, 0, sizeof(cam_rect_t)); |
| memset(&m_MemOpsTbl, 0, sizeof(mm_camera_map_unmap_ops_tbl_t)); |
| memset(&m_OutputCrop, 0, sizeof(cam_stream_parm_buffer_t)); |
| memset(&m_ImgProp, 0, sizeof(cam_stream_parm_buffer_t)); |
| pthread_mutex_init(&mCropLock, NULL); |
| pthread_mutex_init(&mParameterLock, NULL); |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : ~QCameraStream |
| * |
| * DESCRIPTION: deconstructor of QCameraStream |
| * |
| * PARAMETERS : None |
| * |
| * RETURN : None |
| *==========================================================================*/ |
| QCameraStream::~QCameraStream() |
| { |
| pthread_mutex_destroy(&mCropLock); |
| pthread_mutex_destroy(&mParameterLock); |
| |
| if (mDefferedAllocation) { |
| mStreamBufsAcquired = false; |
| releaseBuffs(); |
| } |
| |
| unmapStreamInfoBuf(); |
| releaseStreamInfoBuf(); |
| |
| // delete stream |
| if (mHandle > 0) { |
| mCamOps->delete_stream(mCamHandle, mChannelHandle, mHandle); |
| mHandle = 0; |
| } |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : unmapStreamInfoBuf |
| * |
| * DESCRIPTION: Unmap stream info buffer |
| * |
| * PARAMETERS : |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::unmapStreamInfoBuf() |
| { |
| int rc = NO_ERROR; |
| |
| if (mStreamInfoBuf != NULL) { |
| rc = mCamOps->unmap_stream_buf(mCamHandle, |
| mChannelHandle, |
| mHandle, |
| CAM_MAPPING_BUF_TYPE_STREAM_INFO, |
| 0, |
| -1); |
| |
| if (rc < 0) { |
| ALOGE("Failed to unmap stream info buffer"); |
| } |
| } |
| |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : releaseStreamInfoBuf |
| * |
| * DESCRIPTION: Release stream info buffer |
| * |
| * PARAMETERS : |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::releaseStreamInfoBuf() |
| { |
| int rc = NO_ERROR; |
| |
| if (mStreamInfoBuf != NULL) { |
| mStreamInfoBuf->deallocate(); |
| delete mStreamInfoBuf; |
| mStreamInfoBuf = NULL; |
| } |
| |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : deleteStream |
| * |
| * DESCRIPTION: Deletes a camera stream |
| * |
| * PARAMETERS : None |
| * |
| * RETURN : None |
| *==========================================================================*/ |
| void QCameraStream::deleteStream() |
| { |
| if (mHandle > 0) { |
| acquireStreamBufs(); |
| releaseBuffs(); |
| unmapStreamInfoBuf(); |
| mCamOps->delete_stream(mCamHandle, mChannelHandle, mHandle); |
| } |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : init |
| * |
| * DESCRIPTION: initialize stream obj |
| * |
| * PARAMETERS : |
| * @streamInfoBuf: ptr to buf that contains stream info |
| * @stream_cb : stream data notify callback. Can be NULL if not needed |
| * @userdata : user data ptr |
| * @bDynallocBuf : flag to indicate if buffer allocation can be in 2 steps |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::init(QCameraHeapMemory *streamInfoBuf, |
| uint8_t minNumBuffers, |
| stream_cb_routine stream_cb, |
| void *userdata, |
| bool bDynallocBuf) |
| { |
| int32_t rc = OK; |
| |
| mHandle = mCamOps->add_stream(mCamHandle, mChannelHandle); |
| if (!mHandle) { |
| ALOGE("add_stream failed"); |
| rc = UNKNOWN_ERROR; |
| goto done; |
| } |
| |
| // assign and map stream info memory |
| mStreamInfoBuf = streamInfoBuf; |
| mStreamInfo = reinterpret_cast<cam_stream_info_t *>(mStreamInfoBuf->getPtr(0)); |
| mNumBufs = minNumBuffers; |
| |
| rc = mCamOps->map_stream_buf(mCamHandle, |
| mChannelHandle, mHandle, CAM_MAPPING_BUF_TYPE_STREAM_INFO, |
| 0, -1, mStreamInfoBuf->getFd(0), mStreamInfoBuf->getSize(0)); |
| if (rc < 0) { |
| ALOGE("Failed to map stream info buffer"); |
| goto err1; |
| } |
| |
| // Calculate buffer size for deffered allocation |
| if (mDefferedAllocation) { |
| rc = calcOffset(mStreamInfo); |
| if (rc < 0) { |
| ALOGE("%s : Failed to calculate stream offset", __func__); |
| goto err1; |
| } |
| } else { |
| rc = configStream(); |
| if (rc < 0) { |
| ALOGE("%s : Failed to config stream ", __func__); |
| goto err1; |
| } |
| } |
| |
| mDataCB = stream_cb; |
| mUserData = userdata; |
| mDynBufAlloc = bDynallocBuf; |
| return 0; |
| |
| err1: |
| mCamOps->delete_stream(mCamHandle, mChannelHandle, mHandle); |
| mHandle = 0; |
| mStreamInfoBuf = NULL; |
| mStreamInfo = NULL; |
| mNumBufs = 0; |
| done: |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : calcOffset |
| * |
| * DESCRIPTION: calculate frame offset based on format and padding information |
| * |
| * PARAMETERS : |
| * @streamInfo : stream information |
| * |
| * RETURN : int32_t type of status |
| * 0 -- success |
| * -1 -- failure |
| *==========================================================================*/ |
| int32_t QCameraStream::calcOffset(cam_stream_info_t *streamInfo) |
| { |
| int32_t rc = 0; |
| |
| cam_dimension_t dim = streamInfo->dim; |
| if (streamInfo->pp_config.feature_mask & CAM_QCOM_FEATURE_ROTATION && |
| streamInfo->stream_type != CAM_STREAM_TYPE_VIDEO) { |
| if (streamInfo->pp_config.rotation == ROTATE_90 || |
| streamInfo->pp_config.rotation == ROTATE_270) { |
| // rotated by 90 or 270, need to switch width and height |
| dim.width = streamInfo->dim.height; |
| dim.height = streamInfo->dim.width; |
| } |
| } |
| |
| switch (streamInfo->stream_type) { |
| case CAM_STREAM_TYPE_PREVIEW: |
| rc = mm_stream_calc_offset_preview(streamInfo->fmt, |
| &dim, |
| &streamInfo->buf_planes); |
| break; |
| case CAM_STREAM_TYPE_POSTVIEW: |
| rc = mm_stream_calc_offset_post_view(streamInfo->fmt, |
| &dim, |
| &streamInfo->buf_planes); |
| break; |
| case CAM_STREAM_TYPE_SNAPSHOT: |
| rc = mm_stream_calc_offset_snapshot(streamInfo->fmt, |
| &dim, |
| &mPaddingInfo, |
| &streamInfo->buf_planes); |
| break; |
| case CAM_STREAM_TYPE_OFFLINE_PROC: |
| rc = mm_stream_calc_offset_postproc(streamInfo, |
| &mPaddingInfo, |
| &streamInfo->buf_planes); |
| break; |
| case CAM_STREAM_TYPE_VIDEO: |
| rc = mm_stream_calc_offset_video(&dim, |
| &streamInfo->buf_planes); |
| break; |
| case CAM_STREAM_TYPE_RAW: |
| rc = mm_stream_calc_offset_raw(streamInfo->fmt, |
| &dim, |
| &mPaddingInfo, |
| &streamInfo->buf_planes); |
| break; |
| case CAM_STREAM_TYPE_METADATA: |
| rc = mm_stream_calc_offset_metadata(&dim, |
| &mPaddingInfo, |
| &streamInfo->buf_planes); |
| break; |
| default: |
| ALOGE("%s: not supported for stream type %d", |
| __func__, streamInfo->stream_type); |
| rc = -1; |
| break; |
| } |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : start |
| * |
| * DESCRIPTION: start stream. Will start main stream thread to handle stream |
| * related ops. |
| * |
| * PARAMETERS : none |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::start() |
| { |
| int32_t rc = 0; |
| mDataQ.init(); |
| rc = mProcTh.launch(dataProcRoutine, this); |
| if (rc == NO_ERROR) { |
| m_bActive = true; |
| } |
| pthread_mutex_init(&m_lock, NULL); |
| pthread_cond_init(&m_cond, NULL); |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : stop |
| * |
| * DESCRIPTION: stop stream. Will stop main stream thread |
| * |
| * PARAMETERS : none |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::stop() |
| { |
| int32_t rc = 0; |
| m_bActive = false; |
| rc = mProcTh.exit(); |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : syncRuntimeParams |
| * |
| * DESCRIPTION: query and sync runtime parameters like output crop |
| * buffer info etc. |
| * |
| * PARAMETERS : none |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::syncRuntimeParams() |
| { |
| int32_t ret = NO_ERROR; |
| |
| memset(&m_OutputCrop, 0, sizeof(cam_stream_parm_buffer_t)); |
| m_OutputCrop.type = CAM_STREAM_PARAM_TYPE_GET_OUTPUT_CROP; |
| |
| ret = getParameter(m_OutputCrop); |
| if (ret != NO_ERROR) { |
| ALOGE("%s: stream getParameter for output crop failed", __func__); |
| return ret; |
| } |
| |
| memset(&m_ImgProp, 0, sizeof(cam_stream_parm_buffer_t)); |
| m_ImgProp.type = CAM_STREAM_PARAM_TYPE_GET_IMG_PROP; |
| |
| ret = getParameter(m_ImgProp); |
| if (ret != NO_ERROR) { |
| ALOGE("%s: stream getParameter for image prop failed", __func__); |
| return ret; |
| } |
| |
| return ret; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : processZoomDone |
| * |
| * DESCRIPTION: process zoom done event |
| * |
| * PARAMETERS : |
| * @previewWindoe : preview window ops table to set preview crop window |
| * @crop_info : crop info |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::processZoomDone(preview_stream_ops_t *previewWindow, |
| cam_crop_data_t &crop_info) |
| { |
| int32_t rc = 0; |
| |
| if (!m_bActive) { |
| ALOGV("%s : Stream not active", __func__); |
| return NO_ERROR; |
| } |
| |
| // get stream param for crop info |
| for (int i = 0; i < crop_info.num_of_streams; i++) { |
| if (crop_info.crop_info[i].stream_id == mStreamInfo->stream_svr_id) { |
| pthread_mutex_lock(&mCropLock); |
| mCropInfo = crop_info.crop_info[i].crop; |
| pthread_mutex_unlock(&mCropLock); |
| |
| // update preview window crop if it's preview/postview stream |
| if ( (previewWindow != NULL) && |
| (mStreamInfo->stream_type == CAM_STREAM_TYPE_PREVIEW || |
| mStreamInfo->stream_type == CAM_STREAM_TYPE_POSTVIEW) ) { |
| rc = previewWindow->set_crop(previewWindow, |
| mCropInfo.left, |
| mCropInfo.top, |
| mCropInfo.width, |
| mCropInfo.height); |
| } |
| break; |
| } |
| } |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : processDataNotify |
| * |
| * DESCRIPTION: process stream data notify |
| * |
| * PARAMETERS : |
| * @frame : stream frame received |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::processDataNotify(mm_camera_super_buf_t *frame) |
| { |
| CDBG("%s:\n", __func__); |
| if (mDataQ.enqueue((void *)frame)) { |
| return mProcTh.sendCmd(CAMERA_CMD_TYPE_DO_NEXT_JOB, FALSE, FALSE); |
| } else { |
| CDBG_HIGH("%s: Stream thread is not active, no ops here", __func__); |
| bufDone(frame->bufs[0]->buf_idx); |
| free(frame); |
| return NO_ERROR; |
| } |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : dataNotifyCB |
| * |
| * DESCRIPTION: callback for data notify. This function is registered with |
| * mm-camera-interface to handle data notify |
| * |
| * PARAMETERS : |
| * @recvd_frame : stream frame received |
| * userdata : user data ptr |
| * |
| * RETURN : none |
| *==========================================================================*/ |
| void QCameraStream::dataNotifyCB(mm_camera_super_buf_t *recvd_frame, |
| void *userdata) |
| { |
| CDBG("%s:\n", __func__); |
| QCameraStream* stream = (QCameraStream *)userdata; |
| if (stream == NULL || |
| recvd_frame == NULL || |
| recvd_frame->bufs[0] == NULL || |
| recvd_frame->bufs[0]->stream_id != stream->getMyHandle()) { |
| ALOGE("%s: Not a valid stream to handle buf", __func__); |
| return; |
| } |
| |
| mm_camera_super_buf_t *frame = |
| (mm_camera_super_buf_t *)malloc(sizeof(mm_camera_super_buf_t)); |
| if (frame == NULL) { |
| ALOGE("%s: No mem for mm_camera_buf_def_t", __func__); |
| stream->bufDone(recvd_frame->bufs[0]->buf_idx); |
| return; |
| } |
| *frame = *recvd_frame; |
| stream->processDataNotify(frame); |
| return; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : dataProcRoutine |
| * |
| * DESCRIPTION: function to process data in the main stream thread |
| * |
| * PARAMETERS : |
| * @data : user data ptr |
| * |
| * RETURN : none |
| *==========================================================================*/ |
| void *QCameraStream::dataProcRoutine(void *data) |
| { |
| int running = 1; |
| int ret; |
| QCameraStream *pme = (QCameraStream *)data; |
| QCameraCmdThread *cmdThread = &pme->mProcTh; |
| |
| CDBG("%s: E", __func__); |
| do { |
| do { |
| ret = cam_sem_wait(&cmdThread->cmd_sem); |
| if (ret != 0 && errno != EINVAL) { |
| ALOGE("%s: cam_sem_wait error (%s)", |
| __func__, strerror(errno)); |
| return NULL; |
| } |
| } while (ret != 0); |
| |
| // we got notified about new cmd avail in cmd queue |
| camera_cmd_type_t cmd = cmdThread->getCmd(); |
| switch (cmd) { |
| case CAMERA_CMD_TYPE_DO_NEXT_JOB: |
| { |
| CDBG_HIGH("%s: Do next job", __func__); |
| mm_camera_super_buf_t *frame = |
| (mm_camera_super_buf_t *)pme->mDataQ.dequeue(); |
| if (NULL != frame) { |
| if (pme->mDataCB != NULL) { |
| pme->mDataCB(frame, pme, pme->mUserData); |
| } else { |
| // no data cb routine, return buf here |
| pme->bufDone(frame->bufs[0]->buf_idx); |
| free(frame); |
| } |
| } |
| } |
| break; |
| case CAMERA_CMD_TYPE_EXIT: |
| CDBG_HIGH("%s: Exit", __func__); |
| /* flush data buf queue */ |
| pme->mDataQ.flush(); |
| running = 0; |
| break; |
| default: |
| break; |
| } |
| } while (running); |
| CDBG_HIGH("%s: X", __func__); |
| return NULL; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : bufDone |
| * |
| * DESCRIPTION: return stream buffer to kernel |
| * |
| * PARAMETERS : |
| * @index : index of buffer to be returned |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::bufDone(int index) |
| { |
| int32_t rc = NO_ERROR; |
| |
| if (index >= mNumBufs || mBufDefs == NULL) |
| return BAD_INDEX; |
| |
| rc = mCamOps->qbuf(mCamHandle, mChannelHandle, &mBufDefs[index]); |
| if (rc < 0) |
| return rc; |
| |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : bufDone |
| * |
| * DESCRIPTION: return stream buffer to kernel |
| * |
| * PARAMETERS : |
| * @opaque : stream frame/metadata buf to be returned |
| * @isMetaData: flag if returned opaque is a metadatabuf or the real frame ptr |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::bufDone(const void *opaque, bool isMetaData) |
| { |
| int32_t rc = NO_ERROR; |
| |
| int index = mStreamBufs->getMatchBufIndex(opaque, isMetaData); |
| if (index == -1 || index >= mNumBufs || mBufDefs == NULL) { |
| ALOGE("%s: Cannot find buf for opaque data = %p", __func__, opaque); |
| return BAD_INDEX; |
| } |
| CDBG_HIGH("%s: Buffer Index = %d, Frame Idx = %d", __func__, index, mBufDefs[index].frame_idx); |
| rc = bufDone(index); |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : getBufs |
| * |
| * DESCRIPTION: allocate stream buffers |
| * |
| * PARAMETERS : |
| * @offset : offset info of stream buffers |
| * @num_bufs : number of buffers allocated |
| * @initial_reg_flag: flag to indicate if buffer needs to be registered |
| * at kernel initially |
| * @bufs : output of allocated buffers |
| * @ops_tbl : ptr to buf mapping/unmapping ops |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::getBufs(cam_frame_len_offset_t *offset, |
| uint8_t *num_bufs, |
| uint8_t **initial_reg_flag, |
| mm_camera_buf_def_t **bufs, |
| mm_camera_map_unmap_ops_tbl_t *ops_tbl) |
| { |
| int rc = NO_ERROR; |
| uint8_t *regFlags; |
| |
| if (!ops_tbl) { |
| ALOGE("%s: ops_tbl is NULL", __func__); |
| return INVALID_OPERATION; |
| } |
| |
| mFrameLenOffset = *offset; |
| |
| uint8_t numBufAlloc = mNumBufs; |
| mNumBufsNeedAlloc = 0; |
| if (mDynBufAlloc) { |
| numBufAlloc = CAMERA_MIN_ALLOCATED_BUFFERS; |
| if (numBufAlloc > mNumBufs) { |
| mDynBufAlloc = false; |
| numBufAlloc = mNumBufs; |
| } else { |
| mNumBufsNeedAlloc = mNumBufs - numBufAlloc; |
| } |
| } |
| |
| //Allocate and map stream info buffer |
| mStreamBufs = mAllocator.allocateStreamBuf(mStreamInfo->stream_type, |
| mFrameLenOffset.frame_len, |
| mFrameLenOffset.mp[0].stride, |
| mFrameLenOffset.mp[0].scanline, |
| numBufAlloc); |
| mNumBufs = numBufAlloc + mNumBufsNeedAlloc; |
| |
| if (!mStreamBufs) { |
| ALOGE("%s: Failed to allocate stream buffers", __func__); |
| return NO_MEMORY; |
| } |
| |
| for (int i = 0; i < numBufAlloc; i++) { |
| rc = ops_tbl->map_ops(i, -1, mStreamBufs->getFd(i), |
| mStreamBufs->getSize(i), ops_tbl->userdata); |
| if (rc < 0) { |
| ALOGE("%s: map_stream_buf failed: %d", __func__, rc); |
| for (int j = 0; j < i; j++) { |
| ops_tbl->unmap_ops(j, -1, ops_tbl->userdata); |
| } |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| mStreamBufs = NULL; |
| return INVALID_OPERATION; |
| } |
| } |
| |
| //regFlags array is allocated by us, but consumed and freed by mm-camera-interface |
| regFlags = (uint8_t *)malloc(sizeof(uint8_t) * mNumBufs); |
| if (!regFlags) { |
| ALOGE("%s: Out of memory", __func__); |
| for (int i = 0; i < numBufAlloc; i++) { |
| ops_tbl->unmap_ops(i, -1, ops_tbl->userdata); |
| } |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| mStreamBufs = NULL; |
| return NO_MEMORY; |
| } |
| memset(regFlags, 0, sizeof(uint8_t) * mNumBufs); |
| |
| mBufDefs = (mm_camera_buf_def_t *)malloc(mNumBufs * sizeof(mm_camera_buf_def_t)); |
| if (mBufDefs == NULL) { |
| ALOGE("%s: getRegFlags failed %d", __func__, rc); |
| for (int i = 0; i < numBufAlloc; i++) { |
| ops_tbl->unmap_ops(i, -1, ops_tbl->userdata); |
| } |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| mStreamBufs = NULL; |
| free(regFlags); |
| regFlags = NULL; |
| return INVALID_OPERATION; |
| } |
| memset(mBufDefs, 0, mNumBufs * sizeof(mm_camera_buf_def_t)); |
| for (int i = 0; i < numBufAlloc; i++) { |
| mStreamBufs->getBufDef(mFrameLenOffset, mBufDefs[i], i); |
| } |
| |
| rc = mStreamBufs->getRegFlags(regFlags); |
| if (rc < 0) { |
| ALOGE("%s: getRegFlags failed %d", __func__, rc); |
| for (int i = 0; i < numBufAlloc; i++) { |
| ops_tbl->unmap_ops(i, -1, ops_tbl->userdata); |
| } |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| mStreamBufs = NULL; |
| free(mBufDefs); |
| mBufDefs = NULL; |
| free(regFlags); |
| regFlags = NULL; |
| return INVALID_OPERATION; |
| } |
| |
| *num_bufs = mNumBufs; |
| *initial_reg_flag = regFlags; |
| *bufs = mBufDefs; |
| |
| if (mNumBufsNeedAlloc > 0) { |
| pthread_mutex_lock(&m_lock); |
| wait_for_cond = TRUE; |
| pthread_mutex_unlock(&m_lock); |
| CDBG_HIGH("%s: Still need to allocate %d buffers", |
| __func__, mNumBufsNeedAlloc); |
| // remember memops table |
| m_MemOpsTbl = *ops_tbl; |
| // start another thread to allocate the rest of buffers |
| pthread_create(&mBufAllocPid, |
| NULL, |
| BufAllocRoutine, |
| this); |
| } |
| |
| return NO_ERROR; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : allocateBuffers |
| * |
| * DESCRIPTION: allocate stream buffers |
| * |
| * PARAMETERS : |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::allocateBuffers() |
| { |
| int rc = NO_ERROR; |
| |
| mFrameLenOffset = mStreamInfo->buf_planes.plane_info; |
| |
| //Allocate and map stream info buffer |
| mStreamBufs = mAllocator.allocateStreamBuf(mStreamInfo->stream_type, |
| mFrameLenOffset.frame_len, |
| mFrameLenOffset.mp[0].stride, |
| mFrameLenOffset.mp[0].scanline, |
| mNumBufs); |
| |
| if (!mStreamBufs) { |
| ALOGE("%s: Failed to allocate stream buffers", __func__); |
| return NO_MEMORY; |
| } |
| |
| for (int i = 0; i < mNumBufs; i++) { |
| rc = mapBuf(CAM_MAPPING_BUF_TYPE_STREAM_BUF, |
| i, -1, |
| mStreamBufs->getFd(i), |
| mStreamBufs->getSize(i)); |
| if (rc < 0) { |
| ALOGE("%s: map_stream_buf failed: %d", __func__, rc); |
| for (int j = 0; j < i; j++) { |
| unmapBuf(CAM_MAPPING_BUF_TYPE_STREAM_BUF, i, -1); |
| } |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| mStreamBufs = NULL; |
| return INVALID_OPERATION; |
| } |
| } |
| |
| //regFlags array is allocated by us, |
| // but consumed and freed by mm-camera-interface |
| mRegFlags = (uint8_t *)malloc(sizeof(uint8_t) * mNumBufs); |
| if (!mRegFlags) { |
| ALOGE("%s: Out of memory", __func__); |
| for (int i = 0; i < mNumBufs; i++) { |
| unmapBuf(CAM_MAPPING_BUF_TYPE_STREAM_BUF, i, -1); |
| } |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| mStreamBufs = NULL; |
| return NO_MEMORY; |
| } |
| memset(mRegFlags, 0, sizeof(uint8_t) * mNumBufs); |
| |
| size_t bufDefsSize = mNumBufs * sizeof(mm_camera_buf_def_t); |
| mBufDefs = (mm_camera_buf_def_t *)malloc(bufDefsSize); |
| if (mBufDefs == NULL) { |
| ALOGE("%s: getRegFlags failed %d", __func__, rc); |
| for (int i = 0; i < mNumBufs; i++) { |
| unmapBuf(CAM_MAPPING_BUF_TYPE_STREAM_BUF, i, -1); |
| } |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| mStreamBufs = NULL; |
| free(mRegFlags); |
| mRegFlags = NULL; |
| return INVALID_OPERATION; |
| } |
| memset(mBufDefs, 0, bufDefsSize); |
| for (int i = 0; i < mNumBufs; i++) { |
| mStreamBufs->getBufDef(mFrameLenOffset, mBufDefs[i], i); |
| } |
| |
| rc = mStreamBufs->getRegFlags(mRegFlags); |
| if (rc < 0) { |
| ALOGE("%s: getRegFlags failed %d", __func__, rc); |
| for (int i = 0; i < mNumBufs; i++) { |
| unmapBuf(CAM_MAPPING_BUF_TYPE_STREAM_BUF, i, -1); |
| } |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| mStreamBufs = NULL; |
| free(mBufDefs); |
| mBufDefs = NULL; |
| free(mRegFlags); |
| mRegFlags = NULL; |
| return INVALID_OPERATION; |
| } |
| |
| return NO_ERROR; |
| } |
| |
| |
| /*=========================================================================== |
| * FUNCTION : releaseBuffs |
| * |
| * DESCRIPTION: method to deallocate stream buffers |
| * |
| * PARAMETERS : |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::releaseBuffs() |
| { |
| int rc = NO_ERROR; |
| |
| if (NULL != mBufDefs) { |
| for (int i = 0; i < mNumBufs; i++) { |
| rc = unmapBuf(CAM_MAPPING_BUF_TYPE_STREAM_BUF, i, -1); |
| if (rc < 0) { |
| ALOGE("%s: map_stream_buf failed: %d", __func__, rc); |
| } |
| } |
| |
| // mBufDefs just keep a ptr to the buffer |
| // mm-camera-interface own the buffer, so no need to free |
| mBufDefs = NULL; |
| memset(&mFrameLenOffset, 0, sizeof(mFrameLenOffset)); |
| } |
| if ( !mStreamBufsAcquired ) { |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| } |
| |
| return rc; |
| } |
| |
| |
| /*=========================================================================== |
| * FUNCTION : BufAllocRoutine |
| * |
| * DESCRIPTION: function to allocate additional stream buffers |
| * |
| * PARAMETERS : |
| * @data : user data ptr |
| * |
| * RETURN : none |
| *==========================================================================*/ |
| void *QCameraStream::BufAllocRoutine(void *data) |
| { |
| QCameraStream *pme = (QCameraStream *)data; |
| int32_t rc = NO_ERROR; |
| |
| CDBG_HIGH("%s: E", __func__); |
| pme->cond_wait(); |
| if (pme->mNumBufsNeedAlloc > 0) { |
| uint8_t numBufAlloc = pme->mNumBufs - pme->mNumBufsNeedAlloc; |
| rc = pme->mAllocator.allocateMoreStreamBuf(pme->mStreamBufs, |
| pme->mFrameLenOffset.frame_len, |
| pme->mNumBufsNeedAlloc); |
| if (rc == NO_ERROR){ |
| for (int i = numBufAlloc; i < pme->mNumBufs; i++) { |
| rc = pme->m_MemOpsTbl.map_ops(i, -1, |
| pme->mStreamBufs->getFd(i), |
| pme->mStreamBufs->getSize(i), |
| pme->m_MemOpsTbl.userdata); |
| if (rc == 0) { |
| pme->mStreamBufs->getBufDef(pme->mFrameLenOffset, |
| pme->mBufDefs[i], i); |
| pme->mCamOps->qbuf(pme->mCamHandle, |
| pme->mChannelHandle, |
| &pme->mBufDefs[i]); |
| } else { |
| ALOGE("%s: map_stream_buf %d failed: %d", __func__, rc, i); |
| } |
| } |
| |
| pme->mNumBufsNeedAlloc = 0; |
| } |
| } |
| CDBG_HIGH("%s: X", __func__); |
| return NULL; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : cond_signal |
| * |
| * DESCRIPTION: signal if flag "wait_for_cond" is set |
| * |
| *==========================================================================*/ |
| void QCameraStream::cond_signal() |
| { |
| pthread_mutex_lock(&m_lock); |
| if(wait_for_cond == TRUE){ |
| wait_for_cond = FALSE; |
| pthread_cond_signal(&m_cond); |
| } |
| pthread_mutex_unlock(&m_lock); |
| } |
| |
| |
| /*=========================================================================== |
| * FUNCTION : cond_wait |
| * |
| * DESCRIPTION: wait on if flag "wait_for_cond" is set |
| * |
| *==========================================================================*/ |
| void QCameraStream::cond_wait() |
| { |
| pthread_mutex_lock(&m_lock); |
| while (wait_for_cond == TRUE) { |
| pthread_cond_wait(&m_cond, &m_lock); |
| } |
| pthread_mutex_unlock(&m_lock); |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : putBufs |
| * |
| * DESCRIPTION: deallocate stream buffers |
| * |
| * PARAMETERS : |
| * @ops_tbl : ptr to buf mapping/unmapping ops |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::putBufs(mm_camera_map_unmap_ops_tbl_t *ops_tbl) |
| { |
| int rc = NO_ERROR; |
| |
| if (mBufAllocPid != 0) { |
| CDBG_HIGH("%s: wait for buf allocation thread dead", __func__); |
| pthread_join(mBufAllocPid, NULL); |
| mBufAllocPid = 0; |
| CDBG_HIGH("%s: return from buf allocation thread", __func__); |
| } |
| |
| for (int i = 0; i < mNumBufs; i++) { |
| rc = ops_tbl->unmap_ops(i, -1, ops_tbl->userdata); |
| if (rc < 0) { |
| ALOGE("%s: map_stream_buf failed: %d", __func__, rc); |
| } |
| } |
| mBufDefs = NULL; // mBufDefs just keep a ptr to the buffer |
| // mm-camera-interface own the buffer, so no need to free |
| memset(&mFrameLenOffset, 0, sizeof(mFrameLenOffset)); |
| if ( !mStreamBufsAcquired ) { |
| mStreamBufs->deallocate(); |
| delete mStreamBufs; |
| } |
| |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : invalidateBuf |
| * |
| * DESCRIPTION: invalidate a specific stream buffer |
| * |
| * PARAMETERS : |
| * @index : index of the buffer to invalidate |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::invalidateBuf(int index) |
| { |
| return mStreamBufs->invalidateCache(index); |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : cleanInvalidateBuf |
| * |
| * DESCRIPTION: clean invalidate a specific stream buffer |
| * |
| * PARAMETERS : |
| * @index : index of the buffer to clean invalidate |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::cleanInvalidateBuf(int index) |
| { |
| return mStreamBufs->cleanInvalidateCache(index); |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : isTypeOf |
| * |
| * DESCRIPTION: helper function to determine if the stream is of the queried type |
| * |
| * PARAMETERS : |
| * @type : stream type as of queried |
| * |
| * RETURN : true/false |
| *==========================================================================*/ |
| bool QCameraStream::isTypeOf(cam_stream_type_t type) |
| { |
| if (mStreamInfo != NULL && (mStreamInfo->stream_type == type)) { |
| return true; |
| } else { |
| return false; |
| } |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : isOrignalTypeOf |
| * |
| * DESCRIPTION: helper function to determine if the original stream is of the |
| * queried type if it's reproc stream |
| * |
| * PARAMETERS : |
| * @type : stream type as of queried |
| * |
| * RETURN : true/false |
| *==========================================================================*/ |
| bool QCameraStream::isOrignalTypeOf(cam_stream_type_t type) |
| { |
| if (mStreamInfo != NULL && |
| mStreamInfo->stream_type == CAM_STREAM_TYPE_OFFLINE_PROC && |
| mStreamInfo->reprocess_config.pp_type == CAM_ONLINE_REPROCESS_TYPE && |
| mStreamInfo->reprocess_config.online.input_stream_type == type) { |
| return true; |
| } else if ( |
| mStreamInfo != NULL && |
| mStreamInfo->stream_type == CAM_STREAM_TYPE_OFFLINE_PROC && |
| mStreamInfo->reprocess_config.pp_type == CAM_OFFLINE_REPROCESS_TYPE && |
| mStreamInfo->reprocess_config.offline.input_type == type) { |
| return true; |
| } else { |
| return false; |
| } |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : getMyType |
| * |
| * DESCRIPTION: return stream type |
| * |
| * PARAMETERS : none |
| * |
| * RETURN : stream type |
| *==========================================================================*/ |
| cam_stream_type_t QCameraStream::getMyType() |
| { |
| if (mStreamInfo != NULL) { |
| return mStreamInfo->stream_type; |
| } else { |
| return CAM_STREAM_TYPE_DEFAULT; |
| } |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : getFrameOffset |
| * |
| * DESCRIPTION: query stream buffer frame offset info |
| * |
| * PARAMETERS : |
| * @offset : reference to struct to store the queried frame offset info |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::getFrameOffset(cam_frame_len_offset_t &offset) |
| { |
| offset = mFrameLenOffset; |
| return 0; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : getCropInfo |
| * |
| * DESCRIPTION: query crop info of the stream |
| * |
| * PARAMETERS : |
| * @crop : reference to struct to store the queried crop info |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::getCropInfo(cam_rect_t &crop) |
| { |
| pthread_mutex_lock(&mCropLock); |
| crop = mCropInfo; |
| pthread_mutex_unlock(&mCropLock); |
| return NO_ERROR; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : setCropInfo |
| * |
| * DESCRIPTION: set crop info of the stream |
| * |
| * PARAMETERS : |
| * @crop : struct to store new crop info |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::setCropInfo(cam_rect_t crop) |
| { |
| pthread_mutex_lock(&mCropLock); |
| mCropInfo = crop; |
| pthread_mutex_unlock(&mCropLock); |
| return NO_ERROR; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : getFrameDimension |
| * |
| * DESCRIPTION: query stream frame dimension info |
| * |
| * PARAMETERS : |
| * @dim : reference to struct to store the queried frame dimension |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::getFrameDimension(cam_dimension_t &dim) |
| { |
| if (mStreamInfo != NULL) { |
| dim = mStreamInfo->dim; |
| return 0; |
| } |
| return -1; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : getFormat |
| * |
| * DESCRIPTION: query stream format |
| * |
| * PARAMETERS : |
| * @fmt : reference to stream format |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::getFormat(cam_format_t &fmt) |
| { |
| if (mStreamInfo != NULL) { |
| fmt = mStreamInfo->fmt; |
| return 0; |
| } |
| return -1; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : getMyServerID |
| * |
| * DESCRIPTION: query server stream ID |
| * |
| * PARAMETERS : None |
| * |
| * RETURN : stream ID from server |
| *==========================================================================*/ |
| uint32_t QCameraStream::getMyServerID() { |
| if (mStreamInfo != NULL) { |
| return mStreamInfo->stream_svr_id; |
| } else { |
| return 0; |
| } |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : acquireStreamBufs |
| * |
| * DESCRIPTION: acquire stream buffers and postpone their release. |
| * |
| * PARAMETERS : None |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::acquireStreamBufs() |
| { |
| mStreamBufsAcquired = true; |
| |
| return NO_ERROR; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : mapBuf |
| * |
| * DESCRIPTION: map stream related buffer to backend server |
| * |
| * PARAMETERS : |
| * @buf_type : mapping type of buffer |
| * @buf_idx : index of buffer |
| * @plane_idx: plane index |
| * @fd : fd of the buffer |
| * @size : lenght of the buffer |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::mapBuf(uint8_t buf_type, |
| uint32_t buf_idx, |
| int32_t plane_idx, |
| int fd, |
| uint32_t size) |
| { |
| return mCamOps->map_stream_buf(mCamHandle, mChannelHandle, |
| mHandle, buf_type, |
| buf_idx, plane_idx, |
| fd, size); |
| |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : unmapBuf |
| * |
| * DESCRIPTION: unmap stream related buffer to backend server |
| * |
| * PARAMETERS : |
| * @buf_type : mapping type of buffer |
| * @buf_idx : index of buffer |
| * @plane_idx: plane index |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::unmapBuf(uint8_t buf_type, uint32_t buf_idx, int32_t plane_idx) |
| { |
| return mCamOps->unmap_stream_buf(mCamHandle, mChannelHandle, |
| mHandle, buf_type, |
| buf_idx, plane_idx); |
| |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : setParameter |
| * |
| * DESCRIPTION: set stream based parameters |
| * |
| * PARAMETERS : |
| * @param : ptr to parameters to be set |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::setParameter(cam_stream_parm_buffer_t ¶m) |
| { |
| int32_t rc = NO_ERROR; |
| pthread_mutex_lock(&mParameterLock); |
| mStreamInfo->parm_buf = param; |
| rc = mCamOps->set_stream_parms(mCamHandle, |
| mChannelHandle, |
| mHandle, |
| &mStreamInfo->parm_buf); |
| if (rc == NO_ERROR) { |
| param = mStreamInfo->parm_buf; |
| } |
| pthread_mutex_unlock(&mParameterLock); |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : getParameter |
| * |
| * DESCRIPTION: get stream based parameters |
| * |
| * PARAMETERS : |
| * @param : ptr to parameters to be red |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::getParameter(cam_stream_parm_buffer_t ¶m) |
| { |
| int32_t rc = NO_ERROR; |
| pthread_mutex_lock(&mParameterLock); |
| mStreamInfo->parm_buf = param; |
| rc = mCamOps->get_stream_parms(mCamHandle, |
| mChannelHandle, |
| mHandle, |
| &mStreamInfo->parm_buf); |
| if (rc == NO_ERROR) { |
| param = mStreamInfo->parm_buf; |
| } |
| pthread_mutex_unlock(&mParameterLock); |
| return rc; |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : releaseFrameData |
| * |
| * DESCRIPTION: callback function to release frame data node |
| * |
| * PARAMETERS : |
| * @data : ptr to post process input data |
| * @user_data : user data ptr (QCameraReprocessor) |
| * |
| * RETURN : None |
| *==========================================================================*/ |
| void QCameraStream::releaseFrameData(void *data, void *user_data) |
| { |
| QCameraStream *pme = (QCameraStream *)user_data; |
| mm_camera_super_buf_t *frame = (mm_camera_super_buf_t *)data; |
| if (NULL != pme) { |
| pme->bufDone(frame->bufs[0]->buf_idx); |
| } |
| } |
| |
| /*=========================================================================== |
| * FUNCTION : configStream |
| * |
| * DESCRIPTION: send stream configuration to back end |
| * |
| * PARAMETERS : |
| * |
| * RETURN : int32_t type of status |
| * NO_ERROR -- success |
| * none-zero failure code |
| *==========================================================================*/ |
| int32_t QCameraStream::configStream() |
| { |
| int rc = NO_ERROR; |
| |
| // Configure the stream |
| mm_camera_stream_config_t stream_config; |
| stream_config.stream_info = mStreamInfo; |
| stream_config.mem_vtbl = mMemVtbl; |
| stream_config.stream_cb = dataNotifyCB; |
| stream_config.padding_info = mPaddingInfo; |
| stream_config.userdata = this; |
| rc = mCamOps->config_stream(mCamHandle, |
| mChannelHandle, mHandle, &stream_config); |
| if (rc < 0) { |
| ALOGE("Failed to config stream, rc = %d", rc); |
| mCamOps->unmap_stream_buf(mCamHandle, |
| mChannelHandle, |
| mHandle, |
| CAM_MAPPING_BUF_TYPE_STREAM_INFO, |
| 0, |
| -1); |
| return UNKNOWN_ERROR; |
| } |
| |
| return rc; |
| } |
| |
| }; // namespace qcamera |