libcamera/common_v3/ExynosCameraStreamManager.cpp - LeafOS-Devices/android_hardware_samsung_slsi-linaro_exynos - Gitiles

 /*
  * Copyright (C) 2014, Samsung Electronics Co. LTD
  *
  * 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_NDEBUG 0 */
 #define LOG_TAG "ExynosCameraStreamManager"

 #include "ExynosCameraStreamManager.h"

 namespace android {

 ExynosCamera3Stream::ExynosCamera3Stream(int id, camera3_stream_t *stream)
 {
     m_init();
     m_id = id;
     m_stream = stream;
 }

 ExynosCamera3Stream::~ExynosCamera3Stream()
 {
     m_deinit();
 }

 status_t ExynosCamera3Stream::m_init()
 {
     m_stream = NULL;
     m_id = -1;
     m_actualFormat = -1;
     m_planeCount = -1;
     m_outputPortId = -1;
     m_registerStream = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
     m_registerBuffer = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
     m_requestbuffer = -1;
     m_bufferManager = NULL;

     return NO_ERROR;
 }

 status_t ExynosCamera3Stream::m_deinit()
 {
     m_stream = NULL;
     m_id = -2;
     m_actualFormat = -2;
     m_planeCount = -2;
     m_outputPortId = -2;
     m_registerStream = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
     m_registerBuffer = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
     m_requestbuffer = -2;

     if (m_bufferManager != NULL) {
         delete m_bufferManager;
         m_bufferManager = NULL;
     }

     return NO_ERROR;
 }

 status_t ExynosCamera3Stream::setStream(camera3_stream_t *stream)
 {
     status_t ret = NO_ERROR;
     if (stream == NULL) {
         ALOGE("ERR(%s[%d]):setStream is NULL ", __FUNCTION__, __LINE__);
         ret = INVALID_OPERATION;
     } else {
         m_stream = stream;
     }

     return ret;
 }

 status_t ExynosCamera3Stream::getStream(camera3_stream_t **stream)
 {
     status_t ret = NO_ERROR;
     if (m_stream != NULL) {
         *stream = m_stream;
     } else {
         ALOGE("ERR(%s[%d]):getStream m_stream is NULL ", __FUNCTION__, __LINE__);
         *stream = NULL;
         ret = INVALID_OPERATION;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::setID(int id)
 {
     status_t ret = NO_ERROR;

     if (id < 0) {
         ALOGE("ERR(%s[%d]):setStreamID invalid value(%d)", __FUNCTION__, __LINE__, id);
         ret = INVALID_OPERATION;
     } else {
         m_id = id;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::getID(int *id)
 {
     status_t ret = NO_ERROR;

     if (m_id < 0) {
         ALOGE("ERR(%s[%d]):getStreamID invalid value(%d)", __FUNCTION__, __LINE__, m_id);
         ret = INVALID_OPERATION;
     } else {
         *id = m_id;
     }

     return ret;
 }

 status_t ExynosCamera3Stream::setFormat(int format)
 {
     status_t ret = NO_ERROR;

     if (format < 0) {
         ALOGE("ERR(%s[%d]):setFormat invalid value(%d)", __FUNCTION__, __LINE__, format);
         ret = INVALID_OPERATION;
     } else {
         m_actualFormat = format;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::getFormat(int *format)
 {
     status_t ret = NO_ERROR;

     if (m_actualFormat < 0) {
         ALOGE("ERR(%s[%d]):getFormat invalid value(%d)", __FUNCTION__, __LINE__, m_actualFormat);
         ret = INVALID_OPERATION;
     } else {
         *format = m_actualFormat;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::setPlaneCount(int planes)
 {
     status_t ret = NO_ERROR;

     if (planes < 0) {
         ALOGE("ERR(%s[%d]):setPlaneCount invalid value(%d)", __FUNCTION__, __LINE__, planes);
         ret = INVALID_OPERATION;
     } else {
         m_planeCount = planes;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::getPlaneCount(int *planes)
 {
     status_t ret = NO_ERROR;

     if (m_planeCount < 0) {
         ALOGE("ERR(%s[%d]):getFormat invalid value(%d)", __FUNCTION__, __LINE__, m_planeCount);
         ret = INVALID_OPERATION;
     } else {
         *planes = m_planeCount;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::setOutputPortId(int id)
 {
     status_t ret = NO_ERROR;

     if (id < 0) {
         ALOGE("ERR(%s[%d]):Invalid outputPortId %d",
                 __FUNCTION__, __LINE__, id);
         ret = BAD_VALUE;
     } else {
         m_outputPortId = id;
     }

     return ret;
 }

 status_t ExynosCamera3Stream::getOutputPortId(int *id)
 {
     status_t ret = NO_ERROR;

     if (m_outputPortId < 0) {
         ALOGE("ERR(%s[%d]):Invalid outputPortId %d",
                 __FUNCTION__, __LINE__, m_outputPortId);
         ret = BAD_VALUE;
     } else {
         *id = m_outputPortId;
     }

     return ret;
 }

 status_t ExynosCamera3Stream::setRegisterStream(EXYNOS_STREAM::STATE state)
 {
     status_t ret = NO_ERROR;
     switch (state) {
     case EXYNOS_STREAM::HAL_STREAM_STS_INVALID:
     case EXYNOS_STREAM::HAL_STREAM_STS_VALID:
         m_registerStream = state;
         break;
     case EXYNOS_STREAM::HAL_STREAM_STS_INIT:
     default:
         ALOGE("ERR(%s[%d]):setConfigState invalid value(%d)", __FUNCTION__, __LINE__, state);
         break;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::getRegisterStream(EXYNOS_STREAM::STATE *state)
 {
     status_t ret = NO_ERROR;
     switch (m_registerStream) {
     case EXYNOS_STREAM::HAL_STREAM_STS_INIT:
     case EXYNOS_STREAM::HAL_STREAM_STS_INVALID:
     case EXYNOS_STREAM::HAL_STREAM_STS_VALID:
         *state = m_registerStream;
         break;
     default:
         ALOGE("ERR(%s[%d]):setConfigState invalid value(%d)", __FUNCTION__, __LINE__, *state);
         break;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::setRegisterBuffer(EXYNOS_STREAM::STATE state)
 {
     status_t ret = NO_ERROR;
     switch (state) {
     case EXYNOS_STREAM::HAL_STREAM_STS_REGISTERED:
     case EXYNOS_STREAM::HAL_STREAM_STS_UNREGISTERED:
         m_registerBuffer = state;
         break;
     case EXYNOS_STREAM::HAL_STREAM_STS_INIT:
     default:
         ALOGE("ERR(%s[%d]):setRegisterBuffer invalid value(%d)", __FUNCTION__, __LINE__, state);
         break;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::getRegisterBuffer(EXYNOS_STREAM::STATE *state)
 {
     status_t ret = NO_ERROR;
     switch (m_registerBuffer) {
     case EXYNOS_STREAM::HAL_STREAM_STS_INIT:
     case EXYNOS_STREAM::HAL_STREAM_STS_REGISTERED:
     case EXYNOS_STREAM::HAL_STREAM_STS_UNREGISTERED:
         *state = m_registerBuffer;
         break;
     default:
         ALOGE("ERR(%s[%d]):getRegisterBuffer invalid value(%d)", __FUNCTION__, __LINE__, *state);
         break;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::setRequestBuffer(int bufferCnt)
 {
     status_t ret = NO_ERROR;

     if (bufferCnt < 0) {
         ALOGE("ERR(%s[%d]):setRequestBuffer invalid value(%d)", __FUNCTION__, __LINE__, bufferCnt);
         ret = INVALID_OPERATION;
     } else {
         m_requestbuffer = bufferCnt;
         m_stream->max_buffers = m_requestbuffer;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::getRequestBuffer(int *bufferCnt)
 {
     status_t ret = NO_ERROR;

     if (m_planeCount < 0) {
         ALOGE("ERR(%s[%d]):getRequestBuffer invalid value(%d)", __FUNCTION__, __LINE__, m_requestbuffer);
         ret = INVALID_OPERATION;
     } else {
         *bufferCnt = m_requestbuffer;
     }
     return ret;
 }

 status_t ExynosCamera3Stream::setBufferManager(ExynosCameraBufferManager *bufferManager)
 {
     status_t ret = NO_ERROR;

     if (m_bufferManager != NULL) {
         ALOGE("ERR(%s[%d]):m_bufferManager is not NULL", __FUNCTION__, __LINE__);
         ret = INVALID_OPERATION;
         bufferManager = NULL;
     } else {
         m_bufferManager = bufferManager;
         ALOGD("DEBUG(%s[%d]):m_bufferManager(%p)", __FUNCTION__, __LINE__, m_bufferManager);
     }

     return ret;
 }

 status_t ExynosCamera3Stream::getBufferManager(ExynosCameraBufferManager **bufferManager)
 {
     status_t ret = NO_ERROR;

     if (m_bufferManager == NULL) {
         ALOGE("ERR(%s[%d]):m_bufferManager is NULL", __FUNCTION__, __LINE__);
         ret = INVALID_OPERATION;
         *bufferManager = NULL;
     } else {
         *bufferManager = m_bufferManager;
         ALOGV("DEBUG(%s[%d]):m_bufferManager(%p)", __FUNCTION__, __LINE__, m_bufferManager);
     }

     return ret;
 }

 ExynosCameraStreamManager::ExynosCameraStreamManager(int cameraId)
 {
     ALOGD("DEBUG(%s[%d]):ID(%d)", __FUNCTION__, __LINE__, cameraId);
     m_cameraId = cameraId;
     m_init();
 }

 ExynosCameraStreamManager::~ExynosCameraStreamManager()
 {
     ALOGD("DEBUG(%s[%d]):", __FUNCTION__, __LINE__);
     m_deinit();
 }

 void ExynosCameraStreamManager::m_init()
 {
     ALOGD("DEBUG(%s[%d]):ID(%d)", __FUNCTION__, __LINE__, m_cameraId);
     m_exynosconfig = NULL;
     m_streamInfoMap.clear();
     m_yuvStreamCount = 0;
     m_yuvStreamMaxCount = 0;

     for (int i = 0; i < MAX_YUV_STREAM_COUNT; i++)
         m_yuvStreamIdMap[i] = -1;
 }

 void ExynosCameraStreamManager::m_deinit()
 {
     ALOGD("DEBUG(%s[%d]):ID(%d)", __FUNCTION__, __LINE__, m_cameraId);
     StreamInfoMap::iterator iter;

     ExynosCameraStream *streaminfo = NULL;

     m_streamInfoLock.lock();
     for (iter = m_streamInfoMap.begin() ; iter != m_streamInfoMap.end() ;) {
         streaminfo = iter->second;
         m_streamInfoMap.erase(iter++);
         delete streaminfo;
         streaminfo = NULL;
     }
     m_streamInfoMap.clear();
     m_streamInfoLock.unlock();
 }

 status_t ExynosCameraStreamManager::dumpCurrentStreamList(void)
 {
     ALOGD("DEBUG(%s[%d]):Stream List dump-----", __FUNCTION__, __LINE__);
     status_t ret = NO_ERROR;
     ExynosCameraStream *streaminfo = NULL;
     int id = 0;
     EXYNOS_STREAM::STATE registerStream = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
     EXYNOS_STREAM::STATE registerBuf    = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
     camera3_stream_t *currentStream = NULL;


     if (m_streamInfoMap.empty()) {
         ALOGE("ERR(%s[%d]):list is empty", __FUNCTION__, __LINE__);
         return NOT_ENOUGH_DATA;
     }

     for (StreamInfoIterator s = m_streamInfoMap.begin(); s != m_streamInfoMap.end();) {
         streaminfo = s->second;
         if (streaminfo == NULL) {
             ALOGE("ERR(%s[%d]):streaminfo is NULL id(%d)", __FUNCTION__, __LINE__, s->first);
             s++;
             continue;
         }

         ret = streaminfo->getStream(&currentStream);
         if (ret < 0) {
             ALOGE("ERR(%s[%d]):m_insert failed -> delete stream, id(%d)", __FUNCTION__, __LINE__, s->first);
             s++;
             continue;
         }

         streaminfo->getID(&id);
         streaminfo->getRegisterStream(&registerStream);
         streaminfo->getRegisterBuffer(&registerBuf);
         ALOGD("DEBUG(%s[%d]):Stream(%p), ID(%d), type(%d), usage(0x%x) format(0x%x) (%d,%d)", __FUNCTION__,
                                 __LINE__, currentStream, id,
                                 currentStream->stream_type, currentStream->usage, currentStream->format,
                                 currentStream->width, currentStream->height);
         ALOGD("DEBUG(%s[%d]):status %d / %d", __FUNCTION__, __LINE__, registerStream, registerBuf);
         s++;
     }

     return OK;
 }

 status_t ExynosCameraStreamManager::setConfig(struct ExynosConfigInfo *config)
 {
     status_t ret = NO_ERROR;
     m_exynosconfig = config;

     ALOGD("DEBUG(%s[%d]):preview(%d), raw(%d), jpeg(%d), recording(%d), yuvCallback(%d)",
             __FUNCTION__, __LINE__,
             m_exynosconfig->current->bufInfo.num_preview_buffers,
             m_exynosconfig->current->bufInfo.num_bayer_buffers,
             m_exynosconfig->current->bufInfo.num_picture_buffers,
             m_exynosconfig->current->bufInfo.num_recording_buffers,
             m_exynosconfig->current->bufInfo.num_preview_cb_buffers);

     return ret;
 }

 ExynosCameraStream* ExynosCameraStreamManager::createStream(int id, camera3_stream_t *stream)
 {
     int ret = NO_ERROR;
     ExynosCameraStream *obj = NULL;
     obj = new ExynosCamera3Stream(id, stream);
     if (obj == NULL){
         ALOGE("ERR(%s[%d]):m_insert failed stream id(%d)", __FUNCTION__, __LINE__, id);
         return NULL;
     }
     stream->priv = static_cast<void*>(obj);

     ret = m_insert(id, obj, &m_streamInfoMap, &m_streamInfoLock);
     if (ret < 0){
         m_delete(obj);
         ALOGE("ERR(%s[%d]):m_insert failed -> delete stream, id(%d)", __FUNCTION__, __LINE__, id);
     }
     return obj;
 }

 status_t ExynosCameraStreamManager::deleteStream(int id)
 {
     int ret = NO_ERROR;

     ret = m_delete(id, &m_streamInfoMap, &m_streamInfoLock);
     if (ret < 0) {
         ALOGE("ERR(%s[%d]):eraseStream failed stream id(%d)", __FUNCTION__, __LINE__, id);
     }

     ret = m_decreaseYuvStreamCount(id);
     if (ret != NO_ERROR) {
         ALOGE("ERR(%s[%d]):Failed to decreaseYuvStreamCount. streamId %d",
                 __FUNCTION__, __LINE__, id);
     }

     return ret;
 }

 status_t ExynosCameraStreamManager::getStream(int id, ExynosCameraStream **stream)
 {
     status_t ret = NO_ERROR;
     *stream = NULL;

     ret = m_get(id, stream, &m_streamInfoMap, &m_streamInfoLock);

     if (ret < 0) {
         *stream = NULL;
         return BAD_VALUE;
     }

     return ret;
 }

 bool ExynosCameraStreamManager::findStream(int id)
 {
     status_t ret = NO_ERROR;
     bool found = true;

     ret = m_find(id, &m_streamInfoMap, &m_streamInfoLock);
     if (ret != NO_ERROR)
         found = false;

     return found;
 }

 status_t ExynosCameraStreamManager::getStreamKeys(List<int> *keylist)
 {
     status_t ret = NO_ERROR;
     StreamInfoIterator iter;

     for (iter = m_streamInfoMap.begin(); iter != m_streamInfoMap.end() ; iter++) {
         ALOGV("DEBUG(%s[%d]):stream key is(%d)", __FUNCTION__, __LINE__, iter->first);

         keylist->push_back(iter->first);
     }

     return ret;
 }

 status_t ExynosCameraStreamManager::setYuvStreamMaxCount(int32_t count)
 {
     m_yuvStreamMaxCount = count;

     return NO_ERROR;
 }

 int32_t ExynosCameraStreamManager::getYuvStreamCount(void)
 {
     return m_yuvStreamCount;
 }

 int ExynosCameraStreamManager::getYuvStreamId(int outputPortId)
 {
     if (outputPortId < 0 || outputPortId >= 3) {
         ALOGE("ERR(%s[%d]):Invalid outputPortId %d",
                 __FUNCTION__, __LINE__, outputPortId);
         return -1;
     }

     return m_yuvStreamIdMap[outputPortId];
 }

 int ExynosCameraStreamManager::getOutputPortId(int streamId)
 {
     int outputPortId = -1;

     if (streamId < 0) {
         ALOGE("ERR(%s[%d]):Invalid streamId %d",
                 __FUNCTION__, __LINE__, streamId);
         return -1;
     }

     for (int i = 0; i < 3; i++) {
         if (m_yuvStreamIdMap[i] == streamId)
             outputPortId = i;
     }

     return outputPortId;
 }

 status_t ExynosCameraStreamManager::m_insert(int id, ExynosCameraStream *item, StreamInfoMap *list, Mutex *lock)
 {
     status_t ret = NO_ERROR;
     lock->lock();
     pair<StreamInfoMap::iterator,bool> listRet;

     listRet = list->insert( pair<int, ExynosCameraStream*>(id, item));

     while(listRet.second == false) {
         id += HAL_STREAM_ID_MAX;
         listRet = list->insert( pair<int, ExynosCameraStream*>(id, item));
         ALOGW("WARN(%s[%d]):insert id is re-define id + HAL_STREAM_ID_MAX = (%d)", __FUNCTION__, __LINE__, id);
     }

     if (listRet.second == true) {
         ALOGI("INFO(%s[%d]):inserted stream and id is (%d)", __FUNCTION__, __LINE__, id);
         item->setID(id);
     }

     ret = m_increaseYuvStreamCount(id);
     if (ret != NO_ERROR) {
         ALOGE("ERR(%s[%d]):Failed to updateYuvStreamCount. yuvStreamCount %d streamId %d",
                 __FUNCTION__, __LINE__, m_yuvStreamCount, id);
         return ret;
     }

     lock->unlock();
     return ret;
 }

 status_t ExynosCameraStreamManager::m_erase(int id, ExynosCameraStream **item, StreamInfoMap *list, Mutex *lock)
 {
     status_t ret = NO_ERROR;
     StreamInfoMap::iterator iter;

     lock->lock();
     iter = list->find(id);
     if (iter != list->end()) {
         *item = iter->second;
         list->erase(iter);
     } else {
         ret = BAD_VALUE;
         ALOGE("ERR(%s[%d]):StreamInfoMap is not EXIST stream id(%d)", __FUNCTION__, __LINE__, id);
         *item = NULL;
     }
     lock->unlock();

     return ret;
 }

 status_t ExynosCameraStreamManager::m_find(int id, StreamInfoMap *list, Mutex *lock)
 {
     status_t ret = NO_ERROR;
     StreamInfoMap::iterator iter;

     if (list == NULL) {
         ALOGE("ERR(%s[%d]):list is NULL", __FUNCTION__, __LINE__);
         return BAD_VALUE;
     }

     if (lock == NULL) {
         ALOGE("ERR(%s[%d]):lock is NULL", __FUNCTION__, __LINE__);
         return BAD_VALUE;
     }

     lock->lock();
     iter = list->find(id);
     if (iter == list->end()) {
         ret = BAD_VALUE;
     }
     lock->unlock();

     return ret;
 }

 status_t ExynosCameraStreamManager::m_get(int id, ExynosCameraStream **item, StreamInfoMap *list, Mutex *lock)
 {
     status_t ret = NO_ERROR;
     StreamInfoMap::iterator iter;

     lock->lock();
     iter = list->find(id);
     if (iter != list->end()) {
         *item = iter->second;
     } else {
         ALOGE("ERR(%s[%d]):StreamInfoMap is not EXIST stream id(%d)", __FUNCTION__, __LINE__, id);
         ret = BAD_VALUE;
     }
     lock->unlock();

     return ret;
 }

 status_t ExynosCameraStreamManager::m_delete(int id, StreamInfoMap *list, Mutex *lock)
 {
     status_t ret = NO_ERROR;
     StreamInfoMap::iterator iter;
     ExynosCameraStream *item = NULL;

     lock->lock();
     iter = list->find(id);
     if (iter != list->end()) {
         item = iter->second;
         list->erase(iter);
         m_delete(item);
     } else {
         ret = BAD_VALUE;
         ALOGE("ERR(%s[%d]):StreamInfoMap is not EXIST stream id(%d)", __FUNCTION__, __LINE__, id);
     }
     lock->unlock();

     return ret;
 }

 status_t ExynosCameraStreamManager::m_delete(ExynosCameraStream *stream)
 {
     status_t ret = NO_ERROR;
     camera3_stream_t *obj = NULL;
     int streamId = -1;

     if (stream == NULL){
         ret = BAD_VALUE;
         ALOGE("ERR(%s[%d]):StreamInfoMap is not EXIST stream", __FUNCTION__, __LINE__);
         return ret;
     }

     ret = stream->getStream(&obj);
     obj->priv = NULL;

     stream->getID(&streamId);

     delete stream;
     stream = NULL;
     return ret;
 }

 status_t ExynosCameraStreamManager::m_increaseYuvStreamCount(int id)
 {
     status_t ret = NO_ERROR;

     switch (id % HAL_STREAM_ID_MAX) {
         case HAL_STREAM_ID_PREVIEW:
         case HAL_STREAM_ID_VIDEO:
         case HAL_STREAM_ID_CALLBACK:
             m_yuvStreamIdMap[m_yuvStreamCount++] = id;
             break;
         case HAL_STREAM_ID_RAW:
         case HAL_STREAM_ID_JPEG:
         case HAL_STREAM_ID_ZSL_OUTPUT:
         case HAL_STREAM_ID_ZSL_INPUT:
             /* Not YUV streams */
             break;
         default:
             ALOGE("ERR(%s[%d]):Unsupported stream id %d",
                     __FUNCTION__, __LINE__);
             ret = BAD_VALUE;
             break;
     }

     if (m_yuvStreamCount > m_yuvStreamMaxCount) {
         ALOGE("ERR(%s[%d]):Too many YUV stream!. maxYuvStreamCount %d currentYuvStreamCount %d",
                 __FUNCTION__, __LINE__,
                 m_yuvStreamMaxCount, m_yuvStreamCount);
         ret = INVALID_OPERATION;
     }

     return ret;
 }

 status_t ExynosCameraStreamManager::m_decreaseYuvStreamCount(int id)
 {
     if (id < 0) {
         ALOGE("ERR(%s[%d]):Invalid streamId %d",
                 __FUNCTION__, __LINE__, id);
         return BAD_VALUE;
     }

     for (int i = 0; i < 3; i++) {
         if (m_yuvStreamIdMap[i] == id) {
             m_yuvStreamIdMap[i] = -1;
             m_yuvStreamCount--;
         }
     }

     return NO_ERROR;
 }

 }; /* namespace android */
	/*
	* Copyright (C) 2014, Samsung Electronics Co. LTD
	*
	* 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_NDEBUG 0 */
	#define LOG_TAG "ExynosCameraStreamManager"

	#include "ExynosCameraStreamManager.h"

	namespace android {

	ExynosCamera3Stream::ExynosCamera3Stream(int id, camera3_stream_t *stream)
	{
	m_init();
	m_id = id;
	m_stream = stream;
	}

	ExynosCamera3Stream::~ExynosCamera3Stream()
	{
	m_deinit();
	}

	status_t ExynosCamera3Stream::m_init()
	{
	m_stream = NULL;
	m_id = -1;
	m_actualFormat = -1;
	m_planeCount = -1;
	m_outputPortId = -1;
	m_registerStream = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
	m_registerBuffer = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
	m_requestbuffer = -1;
	m_bufferManager = NULL;

	return NO_ERROR;
	}

	status_t ExynosCamera3Stream::m_deinit()
	{
	m_stream = NULL;
	m_id = -2;
	m_actualFormat = -2;
	m_planeCount = -2;
	m_outputPortId = -2;
	m_registerStream = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
	m_registerBuffer = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
	m_requestbuffer = -2;

	if (m_bufferManager != NULL) {
	delete m_bufferManager;
	m_bufferManager = NULL;
	}

	return NO_ERROR;
	}

	status_t ExynosCamera3Stream::setStream(camera3_stream_t *stream)
	{
	status_t ret = NO_ERROR;
	if (stream == NULL) {
	ALOGE("ERR(%s[%d]):setStream is NULL ", __FUNCTION__, __LINE__);
	ret = INVALID_OPERATION;
	} else {
	m_stream = stream;
	}

	return ret;
	}

	status_t ExynosCamera3Stream::getStream(camera3_stream_t **stream)
	{
	status_t ret = NO_ERROR;
	if (m_stream != NULL) {
	*stream = m_stream;
	} else {
	ALOGE("ERR(%s[%d]):getStream m_stream is NULL ", __FUNCTION__, __LINE__);
	*stream = NULL;
	ret = INVALID_OPERATION;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::setID(int id)
	{
	status_t ret = NO_ERROR;

	if (id < 0) {
	ALOGE("ERR(%s[%d]):setStreamID invalid value(%d)", __FUNCTION__, __LINE__, id);
	ret = INVALID_OPERATION;
	} else {
	m_id = id;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::getID(int *id)
	{
	status_t ret = NO_ERROR;

	if (m_id < 0) {
	ALOGE("ERR(%s[%d]):getStreamID invalid value(%d)", __FUNCTION__, __LINE__, m_id);
	ret = INVALID_OPERATION;
	} else {
	*id = m_id;
	}

	return ret;
	}

	status_t ExynosCamera3Stream::setFormat(int format)
	{
	status_t ret = NO_ERROR;

	if (format < 0) {
	ALOGE("ERR(%s[%d]):setFormat invalid value(%d)", __FUNCTION__, __LINE__, format);
	ret = INVALID_OPERATION;
	} else {
	m_actualFormat = format;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::getFormat(int *format)
	{
	status_t ret = NO_ERROR;

	if (m_actualFormat < 0) {
	ALOGE("ERR(%s[%d]):getFormat invalid value(%d)", __FUNCTION__, __LINE__, m_actualFormat);
	ret = INVALID_OPERATION;
	} else {
	*format = m_actualFormat;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::setPlaneCount(int planes)
	{
	status_t ret = NO_ERROR;

	if (planes < 0) {
	ALOGE("ERR(%s[%d]):setPlaneCount invalid value(%d)", __FUNCTION__, __LINE__, planes);
	ret = INVALID_OPERATION;
	} else {
	m_planeCount = planes;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::getPlaneCount(int *planes)
	{
	status_t ret = NO_ERROR;

	if (m_planeCount < 0) {
	ALOGE("ERR(%s[%d]):getFormat invalid value(%d)", __FUNCTION__, __LINE__, m_planeCount);
	ret = INVALID_OPERATION;
	} else {
	*planes = m_planeCount;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::setOutputPortId(int id)
	{
	status_t ret = NO_ERROR;

	if (id < 0) {
	ALOGE("ERR(%s[%d]):Invalid outputPortId %d",
	__FUNCTION__, __LINE__, id);
	ret = BAD_VALUE;
	} else {
	m_outputPortId = id;
	}

	return ret;
	}

	status_t ExynosCamera3Stream::getOutputPortId(int *id)
	{
	status_t ret = NO_ERROR;

	if (m_outputPortId < 0) {
	ALOGE("ERR(%s[%d]):Invalid outputPortId %d",
	__FUNCTION__, __LINE__, m_outputPortId);
	ret = BAD_VALUE;
	} else {
	*id = m_outputPortId;
	}

	return ret;
	}

	status_t ExynosCamera3Stream::setRegisterStream(EXYNOS_STREAM::STATE state)
	{
	status_t ret = NO_ERROR;
	switch (state) {
	case EXYNOS_STREAM::HAL_STREAM_STS_INVALID:
	case EXYNOS_STREAM::HAL_STREAM_STS_VALID:
	m_registerStream = state;
	break;
	case EXYNOS_STREAM::HAL_STREAM_STS_INIT:
	default:
	ALOGE("ERR(%s[%d]):setConfigState invalid value(%d)", __FUNCTION__, __LINE__, state);
	break;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::getRegisterStream(EXYNOS_STREAM::STATE *state)
	{
	status_t ret = NO_ERROR;
	switch (m_registerStream) {
	case EXYNOS_STREAM::HAL_STREAM_STS_INIT:
	case EXYNOS_STREAM::HAL_STREAM_STS_INVALID:
	case EXYNOS_STREAM::HAL_STREAM_STS_VALID:
	*state = m_registerStream;
	break;
	default:
	ALOGE("ERR(%s[%d]):setConfigState invalid value(%d)", __FUNCTION__, __LINE__, *state);
	break;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::setRegisterBuffer(EXYNOS_STREAM::STATE state)
	{
	status_t ret = NO_ERROR;
	switch (state) {
	case EXYNOS_STREAM::HAL_STREAM_STS_REGISTERED:
	case EXYNOS_STREAM::HAL_STREAM_STS_UNREGISTERED:
	m_registerBuffer = state;
	break;
	case EXYNOS_STREAM::HAL_STREAM_STS_INIT:
	default:
	ALOGE("ERR(%s[%d]):setRegisterBuffer invalid value(%d)", __FUNCTION__, __LINE__, state);
	break;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::getRegisterBuffer(EXYNOS_STREAM::STATE *state)
	{
	status_t ret = NO_ERROR;
	switch (m_registerBuffer) {
	case EXYNOS_STREAM::HAL_STREAM_STS_INIT:
	case EXYNOS_STREAM::HAL_STREAM_STS_REGISTERED:
	case EXYNOS_STREAM::HAL_STREAM_STS_UNREGISTERED:
	*state = m_registerBuffer;
	break;
	default:
	ALOGE("ERR(%s[%d]):getRegisterBuffer invalid value(%d)", __FUNCTION__, __LINE__, *state);
	break;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::setRequestBuffer(int bufferCnt)
	{
	status_t ret = NO_ERROR;

	if (bufferCnt < 0) {
	ALOGE("ERR(%s[%d]):setRequestBuffer invalid value(%d)", __FUNCTION__, __LINE__, bufferCnt);
	ret = INVALID_OPERATION;
	} else {
	m_requestbuffer = bufferCnt;
	m_stream->max_buffers = m_requestbuffer;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::getRequestBuffer(int *bufferCnt)
	{
	status_t ret = NO_ERROR;

	if (m_planeCount < 0) {
	ALOGE("ERR(%s[%d]):getRequestBuffer invalid value(%d)", __FUNCTION__, __LINE__, m_requestbuffer);
	ret = INVALID_OPERATION;
	} else {
	*bufferCnt = m_requestbuffer;
	}
	return ret;
	}

	status_t ExynosCamera3Stream::setBufferManager(ExynosCameraBufferManager *bufferManager)
	{
	status_t ret = NO_ERROR;

	if (m_bufferManager != NULL) {
	ALOGE("ERR(%s[%d]):m_bufferManager is not NULL", __FUNCTION__, __LINE__);
	ret = INVALID_OPERATION;
	bufferManager = NULL;
	} else {
	m_bufferManager = bufferManager;
	ALOGD("DEBUG(%s[%d]):m_bufferManager(%p)", __FUNCTION__, __LINE__, m_bufferManager);
	}

	return ret;
	}

	status_t ExynosCamera3Stream::getBufferManager(ExynosCameraBufferManager **bufferManager)
	{
	status_t ret = NO_ERROR;

	if (m_bufferManager == NULL) {
	ALOGE("ERR(%s[%d]):m_bufferManager is NULL", __FUNCTION__, __LINE__);
	ret = INVALID_OPERATION;
	*bufferManager = NULL;
	} else {
	*bufferManager = m_bufferManager;
	ALOGV("DEBUG(%s[%d]):m_bufferManager(%p)", __FUNCTION__, __LINE__, m_bufferManager);
	}

	return ret;
	}

	ExynosCameraStreamManager::ExynosCameraStreamManager(int cameraId)
	{
	ALOGD("DEBUG(%s[%d]):ID(%d)", __FUNCTION__, __LINE__, cameraId);
	m_cameraId = cameraId;
	m_init();
	}

	ExynosCameraStreamManager::~ExynosCameraStreamManager()
	{
	ALOGD("DEBUG(%s[%d]):", __FUNCTION__, __LINE__);
	m_deinit();
	}

	void ExynosCameraStreamManager::m_init()
	{
	ALOGD("DEBUG(%s[%d]):ID(%d)", __FUNCTION__, __LINE__, m_cameraId);
	m_exynosconfig = NULL;
	m_streamInfoMap.clear();
	m_yuvStreamCount = 0;
	m_yuvStreamMaxCount = 0;

	for (int i = 0; i < MAX_YUV_STREAM_COUNT; i++)
	m_yuvStreamIdMap[i] = -1;
	}

	void ExynosCameraStreamManager::m_deinit()
	{
	ALOGD("DEBUG(%s[%d]):ID(%d)", __FUNCTION__, __LINE__, m_cameraId);
	StreamInfoMap::iterator iter;

	ExynosCameraStream *streaminfo = NULL;

	m_streamInfoLock.lock();
	for (iter = m_streamInfoMap.begin() ; iter != m_streamInfoMap.end() ;) {
	streaminfo = iter->second;
	m_streamInfoMap.erase(iter++);
	delete streaminfo;
	streaminfo = NULL;
	}
	m_streamInfoMap.clear();
	m_streamInfoLock.unlock();
	}

	status_t ExynosCameraStreamManager::dumpCurrentStreamList(void)
	{
	ALOGD("DEBUG(%s[%d]):Stream List dump-----", __FUNCTION__, __LINE__);
	status_t ret = NO_ERROR;
	ExynosCameraStream *streaminfo = NULL;
	int id = 0;
	EXYNOS_STREAM::STATE registerStream = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
	EXYNOS_STREAM::STATE registerBuf = EXYNOS_STREAM::HAL_STREAM_STS_INIT;
	camera3_stream_t *currentStream = NULL;



	if (m_streamInfoMap.empty()) {
	ALOGE("ERR(%s[%d]):list is empty", __FUNCTION__, __LINE__);
	return NOT_ENOUGH_DATA;
	}

	for (StreamInfoIterator s = m_streamInfoMap.begin(); s != m_streamInfoMap.end();) {
	streaminfo = s->second;
	if (streaminfo == NULL) {
	ALOGE("ERR(%s[%d]):streaminfo is NULL id(%d)", __FUNCTION__, __LINE__, s->first);
	s++;
	continue;
	}

	ret = streaminfo->getStream(&currentStream);
	if (ret < 0) {
	ALOGE("ERR(%s[%d]):m_insert failed -> delete stream, id(%d)", __FUNCTION__, __LINE__, s->first);
	s++;
	continue;
	}

	streaminfo->getID(&id);
	streaminfo->getRegisterStream(&registerStream);
	streaminfo->getRegisterBuffer(&registerBuf);
	ALOGD("DEBUG(%s[%d]):Stream(%p), ID(%d), type(%d), usage(0x%x) format(0x%x) (%d,%d)", __FUNCTION__,
	__LINE__, currentStream, id,
	currentStream->stream_type, currentStream->usage, currentStream->format,
	currentStream->width, currentStream->height);
	ALOGD("DEBUG(%s[%d]):status %d / %d", __FUNCTION__, __LINE__, registerStream, registerBuf);
	s++;
	}

	return OK;
	}

	status_t ExynosCameraStreamManager::setConfig(struct ExynosConfigInfo *config)
	{
	status_t ret = NO_ERROR;
	m_exynosconfig = config;

	ALOGD("DEBUG(%s[%d]):preview(%d), raw(%d), jpeg(%d), recording(%d), yuvCallback(%d)",
	__FUNCTION__, __LINE__,
	m_exynosconfig->current->bufInfo.num_preview_buffers,
	m_exynosconfig->current->bufInfo.num_bayer_buffers,
	m_exynosconfig->current->bufInfo.num_picture_buffers,
	m_exynosconfig->current->bufInfo.num_recording_buffers,
	m_exynosconfig->current->bufInfo.num_preview_cb_buffers);

	return ret;
	}

	ExynosCameraStream* ExynosCameraStreamManager::createStream(int id, camera3_stream_t *stream)
	{
	int ret = NO_ERROR;
	ExynosCameraStream *obj = NULL;
	obj = new ExynosCamera3Stream(id, stream);
	if (obj == NULL){
	ALOGE("ERR(%s[%d]):m_insert failed stream id(%d)", __FUNCTION__, __LINE__, id);
	return NULL;
	}
	stream->priv = static_cast<void*>(obj);

	ret = m_insert(id, obj, &m_streamInfoMap, &m_streamInfoLock);
	if (ret < 0){
	m_delete(obj);
	ALOGE("ERR(%s[%d]):m_insert failed -> delete stream, id(%d)", __FUNCTION__, __LINE__, id);
	}
	return obj;
	}

	status_t ExynosCameraStreamManager::deleteStream(int id)
	{
	int ret = NO_ERROR;

	ret = m_delete(id, &m_streamInfoMap, &m_streamInfoLock);
	if (ret < 0) {
	ALOGE("ERR(%s[%d]):eraseStream failed stream id(%d)", __FUNCTION__, __LINE__, id);
	}

	ret = m_decreaseYuvStreamCount(id);
	if (ret != NO_ERROR) {
	ALOGE("ERR(%s[%d]):Failed to decreaseYuvStreamCount. streamId %d",
	__FUNCTION__, __LINE__, id);
	}

	return ret;
	}

	status_t ExynosCameraStreamManager::getStream(int id, ExynosCameraStream **stream)
	{
	status_t ret = NO_ERROR;
	*stream = NULL;

	ret = m_get(id, stream, &m_streamInfoMap, &m_streamInfoLock);

	if (ret < 0) {
	*stream = NULL;
	return BAD_VALUE;
	}

	return ret;
	}

	bool ExynosCameraStreamManager::findStream(int id)
	{
	status_t ret = NO_ERROR;
	bool found = true;

	ret = m_find(id, &m_streamInfoMap, &m_streamInfoLock);
	if (ret != NO_ERROR)
	found = false;

	return found;
	}

	status_t ExynosCameraStreamManager::getStreamKeys(List<int> *keylist)
	{
	status_t ret = NO_ERROR;
	StreamInfoIterator iter;

	for (iter = m_streamInfoMap.begin(); iter != m_streamInfoMap.end() ; iter++) {
	ALOGV("DEBUG(%s[%d]):stream key is(%d)", __FUNCTION__, __LINE__, iter->first);

	keylist->push_back(iter->first);
	}

	return ret;
	}

	status_t ExynosCameraStreamManager::setYuvStreamMaxCount(int32_t count)
	{
	m_yuvStreamMaxCount = count;

	return NO_ERROR;
	}

	int32_t ExynosCameraStreamManager::getYuvStreamCount(void)
	{
	return m_yuvStreamCount;
	}

	int ExynosCameraStreamManager::getYuvStreamId(int outputPortId)
	{
	if (outputPortId < 0 \|\| outputPortId >= 3) {
	ALOGE("ERR(%s[%d]):Invalid outputPortId %d",
	__FUNCTION__, __LINE__, outputPortId);
	return -1;
	}

	return m_yuvStreamIdMap[outputPortId];
	}

	int ExynosCameraStreamManager::getOutputPortId(int streamId)
	{
	int outputPortId = -1;

	if (streamId < 0) {
	ALOGE("ERR(%s[%d]):Invalid streamId %d",
	__FUNCTION__, __LINE__, streamId);
	return -1;
	}

	for (int i = 0; i < 3; i++) {
	if (m_yuvStreamIdMap[i] == streamId)
	outputPortId = i;
	}

	return outputPortId;
	}

	status_t ExynosCameraStreamManager::m_insert(int id, ExynosCameraStream item, StreamInfoMap list, Mutex *lock)
	{
	status_t ret = NO_ERROR;
	lock->lock();
	pair<StreamInfoMap::iterator,bool> listRet;

	listRet = list->insert( pair<int, ExynosCameraStream*>(id, item));

	while(listRet.second == false) {
	id += HAL_STREAM_ID_MAX;
	listRet = list->insert( pair<int, ExynosCameraStream*>(id, item));
	ALOGW("WARN(%s[%d]):insert id is re-define id + HAL_STREAM_ID_MAX = (%d)", __FUNCTION__, __LINE__, id);
	}

	if (listRet.second == true) {
	ALOGI("INFO(%s[%d]):inserted stream and id is (%d)", __FUNCTION__, __LINE__, id);
	item->setID(id);
	}

	ret = m_increaseYuvStreamCount(id);
	if (ret != NO_ERROR) {
	ALOGE("ERR(%s[%d]):Failed to updateYuvStreamCount. yuvStreamCount %d streamId %d",
	__FUNCTION__, __LINE__, m_yuvStreamCount, id);
	return ret;
	}

	lock->unlock();
	return ret;
	}

	status_t ExynosCameraStreamManager::m_erase(int id, ExynosCameraStream *item, StreamInfoMap list, Mutex *lock)
	{
	status_t ret = NO_ERROR;
	StreamInfoMap::iterator iter;

	lock->lock();
	iter = list->find(id);
	if (iter != list->end()) {
	*item = iter->second;
	list->erase(iter);
	} else {
	ret = BAD_VALUE;
	ALOGE("ERR(%s[%d]):StreamInfoMap is not EXIST stream id(%d)", __FUNCTION__, __LINE__, id);
	*item = NULL;
	}
	lock->unlock();

	return ret;
	}

	status_t ExynosCameraStreamManager::m_find(int id, StreamInfoMap list, Mutex lock)
	{
	status_t ret = NO_ERROR;
	StreamInfoMap::iterator iter;

	if (list == NULL) {
	ALOGE("ERR(%s[%d]):list is NULL", __FUNCTION__, __LINE__);
	return BAD_VALUE;
	}

	if (lock == NULL) {
	ALOGE("ERR(%s[%d]):lock is NULL", __FUNCTION__, __LINE__);
	return BAD_VALUE;
	}

	lock->lock();
	iter = list->find(id);
	if (iter == list->end()) {
	ret = BAD_VALUE;
	}
	lock->unlock();

	return ret;
	}

	status_t ExynosCameraStreamManager::m_get(int id, ExynosCameraStream *item, StreamInfoMap list, Mutex *lock)
	{
	status_t ret = NO_ERROR;
	StreamInfoMap::iterator iter;

	lock->lock();
	iter = list->find(id);
	if (iter != list->end()) {
	*item = iter->second;
	} else {
	ALOGE("ERR(%s[%d]):StreamInfoMap is not EXIST stream id(%d)", __FUNCTION__, __LINE__, id);
	ret = BAD_VALUE;
	}
	lock->unlock();

	return ret;
	}

	status_t ExynosCameraStreamManager::m_delete(int id, StreamInfoMap list, Mutex lock)
	{
	status_t ret = NO_ERROR;
	StreamInfoMap::iterator iter;
	ExynosCameraStream *item = NULL;

	lock->lock();
	iter = list->find(id);
	if (iter != list->end()) {
	item = iter->second;
	list->erase(iter);
	m_delete(item);
	} else {
	ret = BAD_VALUE;
	ALOGE("ERR(%s[%d]):StreamInfoMap is not EXIST stream id(%d)", __FUNCTION__, __LINE__, id);
	}
	lock->unlock();

	return ret;
	}

	status_t ExynosCameraStreamManager::m_delete(ExynosCameraStream *stream)
	{
	status_t ret = NO_ERROR;
	camera3_stream_t *obj = NULL;
	int streamId = -1;

	if (stream == NULL){
	ret = BAD_VALUE;
	ALOGE("ERR(%s[%d]):StreamInfoMap is not EXIST stream", __FUNCTION__, __LINE__);
	return ret;
	}

	ret = stream->getStream(&obj);
	obj->priv = NULL;

	stream->getID(&streamId);

	delete stream;
	stream = NULL;
	return ret;
	}

	status_t ExynosCameraStreamManager::m_increaseYuvStreamCount(int id)
	{
	status_t ret = NO_ERROR;

	switch (id % HAL_STREAM_ID_MAX) {
	case HAL_STREAM_ID_PREVIEW:
	case HAL_STREAM_ID_VIDEO:
	case HAL_STREAM_ID_CALLBACK:
	m_yuvStreamIdMap[m_yuvStreamCount++] = id;
	break;
	case HAL_STREAM_ID_RAW:
	case HAL_STREAM_ID_JPEG:
	case HAL_STREAM_ID_ZSL_OUTPUT:
	case HAL_STREAM_ID_ZSL_INPUT:
	/* Not YUV streams */
	break;
	default:
	ALOGE("ERR(%s[%d]):Unsupported stream id %d",
	__FUNCTION__, __LINE__);
	ret = BAD_VALUE;
	break;
	}

	if (m_yuvStreamCount > m_yuvStreamMaxCount) {
	ALOGE("ERR(%s[%d]):Too many YUV stream!. maxYuvStreamCount %d currentYuvStreamCount %d",
	__FUNCTION__, __LINE__,
	m_yuvStreamMaxCount, m_yuvStreamCount);
	ret = INVALID_OPERATION;
	}

	return ret;
	}

	status_t ExynosCameraStreamManager::m_decreaseYuvStreamCount(int id)
	{
	if (id < 0) {
	ALOGE("ERR(%s[%d]):Invalid streamId %d",
	__FUNCTION__, __LINE__, id);
	return BAD_VALUE;
	}

	for (int i = 0; i < 3; i++) {
	if (m_yuvStreamIdMap[i] == id) {
	m_yuvStreamIdMap[i] = -1;
	m_yuvStreamCount--;
	}
	}

	return NO_ERROR;
	}

	}; /* namespace android */