blob: 5535d56d09679f83fbcb0ff2ddde186af76db4bf [file] [log] [blame]
/*
* Copyright (C) 2014 The Android Open Source Project
*
* 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 "SecCameraPreviewFrameScheduler"
#include <utils/Log.h>
#include <utils/Trace.h>
#include <sys/time.h>
#include <binder/IServiceManager.h>
#include <gui/ISurfaceComposer.h>
#include <ui/DisplayStatInfo.h>
#include "SecCameraPreviewFrameScheduler.h"
namespace android {
SecCameraPreviewFrameScheduler::SecCameraPreviewFrameScheduler()
: m_vsyncTime(0),
m_vsyncPeriod(0),
m_frameCount(0),
m_frameDropCount(0),
m_frameScheduleMode(FRAME_SCHEDULE_MODE_OFF),
m_enableSkip(false),
m_scpBufferMgr(NULL),
m_previewWindow(NULL),
m_frameMgr(NULL)
{
ALOGV("(%s[%d])", __FUNCTION__, __LINE__);
}
void SecCameraPreviewFrameScheduler::m_init()
{
ALOGD("(%s[%d]", __FUNCTION__, __LINE__);
m_reset(FRAME_SCHEDULE_MODE_OFF, 30, true);
m_previewFrameQ.setWaitTime(2000000000);
m_scheduler = new m_schedulerThread(this,
&SecCameraPreviewFrameScheduler::m_schedulerThreadFunc,
"PreviewFrameScheduler", PRIORITY_DISPLAY);
}
void SecCameraPreviewFrameScheduler::m_setHandles(ExynosCameraBufferManager *scpBufferMgr,
preview_stream_ops *previewWindow, ExynosCameraFrameManager *frameMgr)
{
ALOGD("(%s[%d]", __FUNCTION__, __LINE__);
m_scpBufferMgr = scpBufferMgr;
m_previewWindow = previewWindow;
m_frameMgr = frameMgr;
}
void SecCameraPreviewFrameScheduler::m_reset(frame_schedule_mode_t mode, float targetFps, bool skip)
{
if(m_frameCount > 240) {
ALOGD("(%s[%d]) m_frameCount=%lld, m_frameDropCount=%lld", __FUNCTION__, __LINE__, m_frameCount, m_frameDropCount);
}
m_vsyncTime = 0;
m_frameCount = 0;
m_frameDropCount = 0;
m_videoSyncPeriod = (nsecs_t)(1e9 / targetFps + 0.5);
m_frameScheduleMode = mode;
m_enableSkip = skip;
m_frameDurationUs = m_videoSyncPeriod / 1000;
if (m_frameDurationUs > FRAME_DURATION_OFFSET_US) {
m_frameDurationUs -= FRAME_DURATION_OFFSET_US;
}
if(mode == FRAME_SCHEDULE_MODE_SCHEDULE) {
m_updateVsync();
ALOGD("(%s[%d] m_vsyncPeriod=%lld", __FUNCTION__, __LINE__, m_vsyncPeriod);
}
ALOGD("(%s[%d] targetFps=%f, videoSyncPeriod=%lld, frameScheduleMode=%d, enableSkip=%d, frameDurationUs=%lld)",
__FUNCTION__, __LINE__, targetFps, m_videoSyncPeriod, m_frameScheduleMode, m_enableSkip, m_frameDurationUs);
}
void SecCameraPreviewFrameScheduler::m_updateVsync()
{
Mutex::Autolock lock(m_updateVsyncLock);
m_vsyncPeriod = 0;
m_vsyncTimeOld = m_vsyncTime;
m_vsyncTime = 0;
// For now, surface flinger only schedules frames on the primary display
if (m_composer == NULL) {
String16 name("SurfaceFlinger");
sp<IServiceManager> sm = defaultServiceManager();
m_composer = interface_cast<ISurfaceComposer>(sm->checkService(name));
}
if (m_composer != NULL) {
DisplayStatInfo stats;
status_t res = m_composer->getDisplayStats(NULL /* display */, &stats);
if (res == OK) {
ALOGV("vsync time:%lld period:%lld",
(long long)stats.vsyncTime, (long long)stats.vsyncPeriod);
m_vsyncTime = stats.vsyncTime;
m_vsyncPeriod = stats.vsyncPeriod;
} else {
ALOGW("getDisplayStats returned %d", res);
}
} else {
ALOGW("could not get surface m_composer service");
}
}
nsecs_t SecCameraPreviewFrameScheduler::m_schedule()
{
nsecs_t curTime = systemTime(SYSTEM_TIME_MONOTONIC);
nsecs_t delayTime = 0;
m_updateVsync();
// without VSYNC info, there is nothing to do
if (m_vsyncPeriod == 0) {
ALOGE("no vsync: render=%lld", (long long)curTime);
goto func_exit;
}
if (m_vsyncTime < m_vsyncTimeOld) {
ALOGE("Invalid vsync time m_vsyncTime(%lld) < m_vsyncTimeOld(%lld)", m_vsyncTime, m_vsyncTimeOld);
goto func_exit;
}
if (m_vsyncTime < curTime) {
ALOGE("Vsync is older than now : m_vsyncTime(%lld), curTime(%lld)", m_vsyncTime, curTime);
goto func_exit;
}
if (m_vsyncTime - m_vsyncTimeOld > m_videoSyncPeriod*3/2 + MULTIPLE_VSYNC_DETECT_OFFSET_NS) {
ALOGV("Multiple vsyncs have been triggered: %lld, %lld", m_vsyncTimeOld, m_vsyncTime);
goto func_exit;
}
if (m_videoSyncPeriod > m_vsyncPeriod) {
delayTime = (m_vsyncTime - curTime + (m_videoSyncPeriod - m_vsyncPeriod) + FRAME_SCHEDULE_OFFSET_NS) % m_videoSyncPeriod;
} else {
delayTime = (m_vsyncTime - curTime + FRAME_SCHEDULE_OFFSET_NS) % m_videoSyncPeriod;
}
func_exit:
ALOGV("schedule() VsyncOld(%lld), Vsync(%lld), cur(%lld), VsyncPeriod(%lld), VideoPeriod(%lld), Delay(%lld), target(%lld)",
m_vsyncTimeOld, m_vsyncTime, curTime, m_vsyncPeriod, m_videoSyncPeriod, delayTime, curTime+delayTime);
return delayTime;
}
void SecCameraPreviewFrameScheduler::m_run()
{
ALOGD("(%s[%d])", __FUNCTION__, __LINE__);
m_flagThreadStop = false;
m_scheduler->run();
}
void SecCameraPreviewFrameScheduler::m_stop()
{
ALOGD("(%s[%d])", __FUNCTION__, __LINE__);
m_flagThreadStop = true;
m_scheduler->stop();
m_previewFrameQ.sendCmd(WAKE_UP);
m_scheduler->requestExitAndWait();
m_clearList(&m_previewFrameQ);
}
void SecCameraPreviewFrameScheduler::m_release()
{
ALOGD("(%s[%d])", __FUNCTION__, __LINE__);
m_composer.clear();
m_previewFrameQ.release();
}
status_t SecCameraPreviewFrameScheduler::m_pushProcessQ(ExynosCameraFrame ** frame)
{
status_t ret = NO_ERROR;
m_previewFrameQ.pushProcessQ(frame);
return ret;
}
status_t SecCameraPreviewFrameScheduler::m_clearList(frame_queue_t *queue)
{
ExynosCameraFrame *curFrame = NULL;
if(queue->getSizeOfProcessQ() == 0) {
return NO_ERROR;
}
ALOGD("DEBUG(%s):remaining frame(%d), we remove them all", __FUNCTION__, queue->getSizeOfProcessQ());
while (0 < queue->getSizeOfProcessQ()) {
queue->popProcessQ(&curFrame);
if (curFrame != NULL) {
ALOGV("DEBUG(%s):remove frame count %d", __FUNCTION__, curFrame->getFrameCount() );
curFrame->decRef();
m_frameMgr->deleteFrame(curFrame);
curFrame = NULL;
}
}
ALOGD("DEBUG(%s):EXIT ", __FUNCTION__);
return NO_ERROR;
}
bool SecCameraPreviewFrameScheduler::m_schedulerThreadFunc(void)
{
int ret = 0;
ExynosCameraBuffer buffer;
uint64_t delayUs = 0;
int qnum = 0;
uint32_t offset = FRAME_DURATION_OFFSET_US;
ExynosCameraFrame* frame = NULL;
/* Wait and pop preview frame */
ret = m_previewFrameQ.waitAndPopProcessQ(&frame);
if (m_flagThreadStop == true) {
ALOGD("INFO(%s[%d]):m_flagThreadStop(%d)", __FUNCTION__, __LINE__, m_flagThreadStop);
goto func_exit;
}
if (ret < 0) {
ALOGW("WARN(%s[%d]):wait and pop fail, ret(%d)", __FUNCTION__, __LINE__, ret);
goto func_exit;
}
/* Get destBuffer form frame */
ret = frame->getDstBuffer(PIPE_SCP, &buffer);
if (ret < 0) {
ALOGE("ERR(%s[%d]):getDstBuffer fail, ret(%d)", __FUNCTION__, __LINE__, ret);
goto func_exit;
}
ALOGV("(%s[%d])index:%d", __FUNCTION__, __LINE__, buffer.index);
qnum = m_previewFrameQ.getSizeOfProcessQ();
/* Do skip frame by stacked qnum */
if ((m_enableSkip == true) && (qnum >= 1)) {
m_frameDropCount++;
ALOGD("(%s[%d])skip frame Qnum=%d", __FUNCTION__, __LINE__, qnum);
frame->setFrameState(FRAME_STATE_SKIPPED);
if (m_scpBufferMgr != NULL) {
m_scpBufferMgr->cancelBuffer(buffer.index, true);
}
goto func_exit;
}
m_frameCount++;
/* Do frame scheduling */
if (m_frameScheduleMode == FRAME_SCHEDULE_MODE_SCHEDULE) {
if ((m_enableSkip == false) && (qnum >= 1)) {
m_frameDropCount++;
ALOGD("(%s[%d])overwrite frame Qnum=%d", __FUNCTION__, __LINE__, qnum);
} else {
delayUs = m_schedule() / 1000;
}
} else if (m_frameScheduleMode == FRAME_SCHEDULE_MODE_DURATION) {
m_previewDurationTimer.stop();
m_previewDurationTime = m_previewDurationTimer.durationUsecs();
if (qnum == 1) {
if (m_frameDurationUs > offset) {
m_frameDurationUs -= offset;
}
} else if (qnum >= 2) {
if (m_frameDurationUs > offset*2) {
m_frameDurationUs -= offset*2;
}
}
if (m_frameDurationUs > m_previewDurationTime) {
delayUs = m_frameDurationUs - m_previewDurationTime;
}
}
/* Delay frame using delayUs value */
if (delayUs > 0) {
ALOGV("(%s[%d])m_frameScheduleMode=%d delayUs=%lld", __FUNCTION__, __LINE__,
m_frameScheduleMode, delayUs);
usleep(delayUs);
}
if(m_frameScheduleMode == FRAME_SCHEDULE_MODE_DURATION) {
m_previewDurationTimer.start();
}
/* Set time stamp */
if (m_previewWindow != NULL) {
int64_t timeStamp = (int64_t)frame->getTimeStamp();
if (timeStamp > 0L) {
m_previewWindow->set_timestamp(m_previewWindow, timeStamp);
} else {
uint32_t fcount = 0;
int frameCount = frame->getFrameCount();
getStreamFrameCount((struct camera2_stream *)buffer.addr[2], &fcount);
ALOGW("WRN(%s[%d]): frameCount(%d)(%d), Invalid timeStamp(%lld)",
__FUNCTION__, __LINE__,
frameCount,
fcount,
timeStamp);
}
}
#ifdef PREVIEW_DURATION_DEBUG
m_previewDurationDebugTimer.stop();
ALOGW("(%s):PreviewDelay Time(%lld), Qnum(%d)", __FUNCTION__,
m_previewDurationDebugTimer.durationUsecs(), m_previewFrameQ.getSizeOfProcessQ());
m_previewDurationDebugTimer.start();
#endif
/* putBuffer to surface */
if (m_scpBufferMgr != NULL) {
m_scpBufferMgr->putBuffer(buffer.index, EXYNOS_CAMERA_BUFFER_POSITION_NONE);
}
func_exit:
if (frame != NULL) {
frame->decRef();
m_frameMgr->deleteFrame(frame);
frame = NULL;
}
return true;
}
SecCameraPreviewFrameScheduler::~SecCameraPreviewFrameScheduler()
{
m_release();
}
} // namespace android