camera/hal/intel/ipu6/modules/sandboxing/client/IntelFaceDetection.cpp

/*
 * Copyright (C) 2019-2020 Intel Corporation
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#define LOG_TAG "ClientIntelFaceDetection"

#include "modules/sandboxing/client/IntelFaceDetection.h"

#include <algorithm>

#include "FaceBase.h"

namespace icamera {
IntelFaceDetection::IntelFaceDetection() : mInitialized(false) {
    LOG1("@%s", __func__);

    uintptr_t personal = reinterpret_cast<uintptr_t>(this);
    mMems = {{("/faceDetectionInit" + std::to_string(personal) + "Shm"),
              sizeof(FaceDetectionInitParams), &mMemInit, false}};

    for (int i = 0; i < MAX_STORE_FACE_DATA_BUF_NUM; i++) {
        mMems.push_back(
            {("/faceDetectionRun" + std::to_string(i) + std::to_string(personal) + "Shm"),
             sizeof(FaceDetectionRunParams), &mMemRunBufs[i], false});
    }

    bool success = mCommon.allocateAllShmMems(&mMems);
    if (!success) {
        LOGE("@%s,Failed to call allocateAllShmMems", __func__);
        mCommon.releaseAllShmMems(mMems);
        return;
    }

    LOG1("@%s, done", __func__);
    mInitialized = true;
}

IntelFaceDetection::~IntelFaceDetection() {
    LOG1("@%s", __func__);
    mCommon.releaseAllShmMems(mMems);
}

status_t IntelFaceDetection::init(FaceDetectionInitParams* initParams, int dataSize) {
    CheckError(!mInitialized, UNKNOWN_ERROR, "@%s, mInitialized is false", __func__);

    LOG1("@%s, initParams:%p, dataSize:%d", __func__, initParams, dataSize);
    CheckError(initParams == nullptr, UNKNOWN_ERROR, "@%s, initParams is nullptr", __func__);
    CheckError(dataSize < static_cast<int>(sizeof(FaceDetectionInitParams)), UNKNOWN_ERROR,
               "@%s, buffer is small", __func__);

    unsigned int maxFacesNum =
        std::min(initParams->max_face_num, static_cast<unsigned int>(MAX_FACES_DETECTABLE));
    LOG2("@%s, maxFacesNum:%d", __func__, maxFacesNum);

    FaceDetectionInitParams* params = static_cast<FaceDetectionInitParams*>(mMemInit.mAddr);

    bool ret = mIpc.clientFlattenInit(maxFacesNum, params);
    CheckError(ret == false, UNKNOWN_ERROR, "@%s, clientFlattenInit fails", __func__);

    ret = mCommon.requestSync(IPC_FD_INIT, mMemInit.mHandle);
    CheckError(ret == false, UNKNOWN_ERROR, "@%s, requestSync fails", __func__);

    return OK;
}

status_t IntelFaceDetection::deinit() {
    LOG1("@%s", __func__);
    CheckError(!mInitialized, UNKNOWN_ERROR, "@%s, mInitialized is false", __func__);

    bool ret = mCommon.requestSync(IPC_FD_DEINIT);
    CheckError(ret == false, UNKNOWN_ERROR, "@%s, requestSync fails", __func__);

    return OK;
}

FaceDetectionRunParams* IntelFaceDetection::prepareRunBuffer(unsigned int index) {
    LOG1("@%s", __func__);
    CheckError(index >= MAX_STORE_FACE_DATA_BUF_NUM, nullptr, "@%s, index is error %d", __func__,
               index);
    CheckError(!mInitialized, nullptr, "@%s, mInitialized is false", __func__);

    return static_cast<FaceDetectionRunParams*>(mMemRunBufs[index].mAddr);
}

status_t IntelFaceDetection::run(FaceDetectionRunParams* runParams, int dataSize, int dmafd) {
    CheckError(!mInitialized, UNKNOWN_ERROR, "@%s, mInitialized is false", __func__);
    CheckError(!runParams, UNKNOWN_ERROR, "@%s,runParams is nullptr", __func__);
    CheckError(dataSize < static_cast<int>(sizeof(FaceDetectionRunParams)), UNKNOWN_ERROR,
               "@%s, buffer is small", __func__);

    if (dmafd >= 0) {
        runParams->bufferHandle = mCommon.registerGbmBuffer(dmafd);
        CheckError((runParams->bufferHandle < 0), false, "@%s, call mCommon.registerGbmBuffer",
                   __func__);
    }

    int32_t runBufHandle = mCommon.getShmMemHandle(static_cast<void*>(runParams));
    CheckError(runBufHandle < 0, UNKNOWN_ERROR, "@%s, getShmMemHandle fails", __func__, runParams);

    bool ret = mCommon.requestSync(IPC_FD_RUN, runBufHandle);
    CheckError(ret == false, UNKNOWN_ERROR, "@%s, requestSync fails", __func__);

    if (dmafd >= 0) {
        mCommon.deregisterGbmBuffer(runParams->bufferHandle);
    }

    return OK;
}
} /* namespace icamera */