/* * rk_aiq_algo_camgroup_awb_itf.c * * Copyright (c) 2021 Rockchip 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. * */ #include "rk_aiq_algo_camgroup_asharp_itf.h" #include "rk_aiq_algo_camgroup_types.h" #include "rk_aiq_types_camgroup_asharp_prvt.h" #include "asharp3/rk_aiq_asharp_algo_itf_v3.h" #include "asharp3/rk_aiq_asharp_algo_v3.h" #include "asharp4/rk_aiq_asharp_algo_itf_v4.h" #include "asharp4/rk_aiq_asharp_algo_v4.h" RKAIQ_BEGIN_DECLARE static asharp_hardware_version_t g_asharp_hw_ver = ASHARP_HARDWARE_V4; static XCamReturn groupAsharpCreateCtx(RkAiqAlgoContext **context, const AlgoCtxInstanceCfg* cfg) { LOGI_ASHARP("%s enter \n", __FUNCTION__ ); XCamReturn ret = XCAM_RETURN_NO_ERROR; CamGroup_Asharp_Contex_t *asharp_group_contex = NULL; AlgoCtxInstanceCfgCamGroup *cfgInt = (AlgoCtxInstanceCfgCamGroup*)cfg; //g_asharp_hw_ver = (asharp_hardware_version_t)(cfgInt->cfg_com.module_hw_version); if (CHECK_ISP_HW_V21()) { g_asharp_hw_ver = ASHARP_HARDWARE_V3; } else if(CHECK_ISP_HW_V3X()) { g_asharp_hw_ver = ASHARP_HARDWARE_V4; } else { g_asharp_hw_ver = ASHARP_HARDWARE_MIN; } if(g_asharp_hw_ver == ASHARP_HARDWARE_V3) { asharp_group_contex = (CamGroup_Asharp_Contex_t*)malloc(sizeof(CamGroup_Asharp_Contex_t)); #if ASHARP_USE_JSON_FILE_V3 Asharp3_result_t ret_v3 = ASHARP3_RET_SUCCESS; ret_v3 = Asharp_Init_V3(&(asharp_group_contex->asharp_contex_v3), (void *)cfgInt->s_calibv2); if(ret_v3 != ASHARP3_RET_SUCCESS) { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("%s: Initializaion asharp failed (%d)\n", __FUNCTION__, ret); } #endif } else if(g_asharp_hw_ver == ASHARP_HARDWARE_V4) { asharp_group_contex = (CamGroup_Asharp_Contex_t*)malloc(sizeof(CamGroup_Asharp_Contex_t)); #if (ASHARP_USE_JSON_FILE_V4) Asharp4_result_t ret_v4 = ASHARP4_RET_SUCCESS; ret_v4 = Asharp_Init_V4(&(asharp_group_contex->asharp_contex_v4), (void *)cfgInt->s_calibv2); if(ret_v4 != ASHARP4_RET_SUCCESS) { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("%s: Initializaion ASHARP failed (%d)\n", __FUNCTION__, ret); } #endif } else { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("module_hw_version of asharp (%d) is invalid!!!!", g_asharp_hw_ver); } if(ret != XCAM_RETURN_NO_ERROR) { LOGE_ASHARP("%s: Initializaion group sharp failed (%d)\n", __FUNCTION__, ret); } else { // to do got asharpSurrViewClib and initinal paras for for surround view asharp_group_contex->group_CalibV2.groupMethod = CalibDbV2_CAMGROUP_ASHARP_METHOD_MEAN;// to do from json asharp_group_contex->camera_Num = cfgInt->camIdArrayLen; *context = (RkAiqAlgoContext *)(asharp_group_contex); LOGI_ASHARP("%s:%d surrViewMethod(1-mean):%d, cameraNum %d \n", __FUNCTION__, __LINE__, asharp_group_contex->group_CalibV2.groupMethod, asharp_group_contex->camera_Num); } LOGI_ASHARP("%s exit ret:%d\n", __FUNCTION__, ret); return ret; } static XCamReturn groupAsharpDestroyCtx(RkAiqAlgoContext *context) { LOGI_ASHARP("%s enter \n", __FUNCTION__ ); XCamReturn ret = XCAM_RETURN_NO_ERROR; CamGroup_Asharp_Contex_t *asharp_group_contex = (CamGroup_Asharp_Contex_t*)context; if(g_asharp_hw_ver == ASHARP_HARDWARE_V3) { Asharp3_result_t ret_v3 = ASHARP3_RET_SUCCESS; ret_v3 = Asharp_Release_V3(asharp_group_contex->asharp_contex_v3); if(ret_v3 != ASHARP3_RET_SUCCESS) { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("%s: Initializaion ASHARP failed (%d)\n", __FUNCTION__, ret); } } else if(g_asharp_hw_ver == ASHARP_HARDWARE_V4) { Asharp4_result_t ret_v4 = ASHARP4_RET_SUCCESS; ret_v4 = Asharp_Release_V4(asharp_group_contex->asharp_contex_v4); if(ret_v4 != ASHARP4_RET_SUCCESS) { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("%s: Initializaion ASHARP failed (%d)\n", __FUNCTION__, ret); } } else { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("module_hw_version of asharp (%d) is isvalid!!!!", g_asharp_hw_ver); } if(ret != XCAM_RETURN_NO_ERROR) { LOGE_ASHARP("%s: release asharp group failed (%d)\n", __FUNCTION__, ret); } else { free(asharp_group_contex); } LOGI_ASHARP("%s exit ret:%d\n", __FUNCTION__, ret); return ret; } static XCamReturn groupAsharpPrepare(RkAiqAlgoCom* params) { LOGI_ASHARP("%s enter \n", __FUNCTION__ ); XCamReturn ret = XCAM_RETURN_NO_ERROR; CamGroup_Asharp_Contex_t * asharp_group_contex = (CamGroup_Asharp_Contex_t *)params->ctx; RkAiqAlgoCamGroupPrepare* para = (RkAiqAlgoCamGroupPrepare*)params; if(g_asharp_hw_ver == ASHARP_HARDWARE_V3) { Asharp_Context_V3_t * asharp_contex_v3 = asharp_group_contex->asharp_contex_v3; if(!!(params->u.prepare.conf_type & RK_AIQ_ALGO_CONFTYPE_UPDATECALIB )) { // todo update calib pars for surround view #if ASHARP_USE_JSON_FILE_V3 void *pCalibdbV2 = (void*)(para->s_calibv2); CalibDbV2_SharpV3_t *sharp_v3 = (CalibDbV2_SharpV3_t*)(CALIBDBV2_GET_MODULE_PTR((void*)pCalibdbV2, sharp_v3)); asharp_contex_v3->sharp_v3 = *sharp_v3; asharp_contex_v3->isIQParaUpdate = true; asharp_contex_v3->isReCalculate |= 1; #endif } Asharp_Config_V3_t stAsharpConfigV3; stAsharpConfigV3.rawHeight = params->u.prepare.sns_op_height; stAsharpConfigV3.rawWidth = params->u.prepare.sns_op_width; Asharp3_result_t ret_v3 = ASHARP3_RET_SUCCESS; ret_v3 = Asharp_Prepare_V3(asharp_contex_v3, &stAsharpConfigV3); if(ret_v3 != ASHARP3_RET_SUCCESS) { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("%s: config asharp group failed (%d)\n", __FUNCTION__, ret); } } else if(g_asharp_hw_ver == ASHARP_HARDWARE_V4) { Asharp_Context_V4_t * asharp_contex_v4 = asharp_group_contex->asharp_contex_v4; if(!!(params->u.prepare.conf_type & RK_AIQ_ALGO_CONFTYPE_UPDATECALIB )) { // todo update calib pars for surround view #if ASHARP_USE_JSON_FILE_V4 void *pCalibdbV2 = (void*)(para->s_calibv2); CalibDbV2_SharpV4_t *sharp_v4 = (CalibDbV2_SharpV4_t*)(CALIBDBV2_GET_MODULE_PTR((void*)pCalibdbV2, sharp_v4)); asharp_contex_v4->sharp_v4 = *sharp_v4; asharp_contex_v4->isIQParaUpdate = true; asharp_contex_v4->isReCalculate |= 1; #endif } Asharp_Config_V4_t stAsharpConfigV4; stAsharpConfigV4.rawHeight = params->u.prepare.sns_op_height; stAsharpConfigV4.rawWidth = params->u.prepare.sns_op_width; Asharp4_result_t ret_v4 = ASHARP4_RET_SUCCESS; ret_v4 = Asharp_Prepare_V4(asharp_contex_v4, &stAsharpConfigV4); if(ret_v4 != ASHARP4_RET_SUCCESS) { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("%s: config ASHARP failed (%d)\n", __FUNCTION__, ret); } } else { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("module_hw_version of asharp (%d) is isvalid!!!!", g_asharp_hw_ver); } LOGI_ASHARP("%s exit ret:%d\n", __FUNCTION__, ret); return ret; } static XCamReturn groupAsharpProcessing(const RkAiqAlgoCom* inparams, RkAiqAlgoResCom* outparams) { LOGI_ASHARP("%s enter \n", __FUNCTION__ ); LOGI_ASHARP("----------------------------------------------frame_id (%d)----------------------------------------------\n", inparams->frame_id); XCamReturn ret = XCAM_RETURN_NO_ERROR; RkAiqAlgoCamGroupProcIn* procParaGroup = (RkAiqAlgoCamGroupProcIn*)inparams; RkAiqAlgoCamGroupProcOut* procResParaGroup = (RkAiqAlgoCamGroupProcOut*)outparams; CamGroup_Asharp_Contex_t * asharp_group_contex = (CamGroup_Asharp_Contex_t *)inparams->ctx; int deltaIso = 0; //method error if (asharp_group_contex->group_CalibV2.groupMethod <= CalibDbV2_CAMGROUP_ASHARP_METHOD_MIN || asharp_group_contex->group_CalibV2.groupMethod >= CalibDbV2_CAMGROUP_ASHARP_METHOD_MAX) { return (ret); } //group empty if(procParaGroup->camgroupParmasArray == nullptr) { LOGE_ASHARP("camgroupParmasArray is null"); return(XCAM_RETURN_ERROR_FAILED); } //get cur ae exposure Asharp3_ExpInfo_t stExpInfoV3; memset(&stExpInfoV3, 0x00, sizeof(Asharp3_ExpInfo_t)); stExpInfoV3.hdr_mode = 0; //pAnrProcParams->hdr_mode; stExpInfoV3.snr_mode = 0; for(int i = 0; i < 3; i++) { stExpInfoV3.arIso[i] = 50; stExpInfoV3.arAGain[i] = 1.0; stExpInfoV3.arDGain[i] = 1.0; stExpInfoV3.arTime[i] = 0.01; } //merge ae result, iso mean value rk_aiq_singlecam_3a_result_t* scam_3a_res = procParaGroup->camgroupParmasArray[0]; if(scam_3a_res->aec._bEffAecExpValid) { RKAiqAecExpInfo_t* pCurExp = &scam_3a_res->aec._effAecExpInfo; stExpInfoV3.snr_mode = pCurExp->CISFeature.SNR; if((rk_aiq_working_mode_t)procParaGroup->working_mode == RK_AIQ_WORKING_MODE_NORMAL) { stExpInfoV3.hdr_mode = 0; stExpInfoV3.arAGain[0] = pCurExp->LinearExp.exp_real_params.analog_gain; stExpInfoV3.arDGain[0] = pCurExp->LinearExp.exp_real_params.digital_gain; stExpInfoV3.arTime[0] = pCurExp->LinearExp.exp_real_params.integration_time; stExpInfoV3.arIso[0] = stExpInfoV3.arAGain[0] * stExpInfoV3.arDGain[0] * 50; } else { if(procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_2_FRAME_HDR || procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_2_LINE_HDR) stExpInfoV3.hdr_mode = 1; else if (procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_3_FRAME_HDR || procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_3_LINE_HDR) stExpInfoV3.hdr_mode = 2; else { stExpInfoV3.hdr_mode = 0; LOGE_ANR("mode error\n"); } for(int i = 0; i < 3; i++) { stExpInfoV3.arAGain[i] = pCurExp->HdrExp[i].exp_real_params.analog_gain; stExpInfoV3.arDGain[i] = pCurExp->HdrExp[i].exp_real_params.digital_gain; stExpInfoV3.arTime[i] = pCurExp->HdrExp[i].exp_real_params.integration_time; stExpInfoV3.arIso[i] = stExpInfoV3.arAGain[i] * stExpInfoV3.arDGain[i] * 50; } } } else { LOGW("fail to get sensor gain form AE module,use default value "); } if(g_asharp_hw_ver == ASHARP_HARDWARE_V3) { Asharp_Context_V3_t * asharp_contex_v3 = asharp_group_contex->asharp_contex_v3; Asharp_ProcResult_V3_t stAsharpResultV3; deltaIso = abs(stExpInfoV3.arIso[stExpInfoV3.hdr_mode] - asharp_contex_v3->stExpInfo.arIso[stExpInfoV3.hdr_mode]); if(deltaIso > ASHARPV3_RECALCULATE_DELTA_ISO) { asharp_contex_v3->isReCalculate |= 1; } if(asharp_contex_v3->isReCalculate) { Asharp3_result_t ret_v3 = ASHARP3_RET_SUCCESS; ret_v3 = Asharp_Process_V3(asharp_contex_v3, &stExpInfoV3); if(ret_v3 != ASHARP3_RET_SUCCESS) { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("%s: processing ASHARP failed (%d)\n", __FUNCTION__, ret); } stAsharpResultV3.isNeedUpdate = true; LOGD_ASHARP("recalculate: %d delta_iso:%d \n ", asharp_contex_v3->isReCalculate, deltaIso); } else { stAsharpResultV3.isNeedUpdate = true; } Asharp_GetProcResult_V3(asharp_contex_v3, &stAsharpResultV3); for (int i = 0; i < procResParaGroup->arraySize; i++) { *(procResParaGroup->camgroupParmasArray[i]->asharp._asharp_procRes_v3) = stAsharpResultV3.stFix; } asharp_contex_v3->isReCalculate = 0; } else if(g_asharp_hw_ver == ASHARP_HARDWARE_V4) { Asharp_Context_V4_t * asharp_contex_v4 = asharp_group_contex->asharp_contex_v4; Asharp_ProcResult_V4_t stAsharpResultV4; Asharp4_ExpInfo_t stExpInfoV4; memset(&stExpInfoV4, 0x00, sizeof(stExpInfoV4)); stExpInfoV4.hdr_mode = stExpInfoV3.hdr_mode; //pAnrProcParams->hdr_mode; stExpInfoV4.snr_mode = stExpInfoV3.snr_mode; for(int i = 0; i < 3; i++) { stExpInfoV4.arIso[i] = stExpInfoV3.arIso[i]; stExpInfoV4.arAGain[i] = stExpInfoV3.arAGain[i]; stExpInfoV4.arDGain[i] = stExpInfoV3.arDGain[i]; stExpInfoV4.arTime[i] = stExpInfoV3.arTime[i]; } deltaIso = abs(stExpInfoV4.arIso[stExpInfoV4.hdr_mode] - asharp_contex_v4->stExpInfo.arIso[stExpInfoV4.hdr_mode]); if(deltaIso > ASHARPV4_RECALCULATE_DELTA_ISO) { asharp_contex_v4->isReCalculate |= 1; } if(asharp_contex_v4->isReCalculate) { Asharp4_result_t ret_v4 = ASHARP4_RET_SUCCESS; ret_v4 = Asharp_Process_V4(asharp_contex_v4, &stExpInfoV4); if(ret_v4 != ASHARP4_RET_SUCCESS) { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("%s: processing ASHARP failed (%d)\n", __FUNCTION__, ret); } Asharp_GetProcResult_V4(asharp_contex_v4, &stAsharpResultV4); stAsharpResultV4.isNeedUpdate = true; LOGD_ASHARP("recalculate: %d delta_iso:%d \n ", asharp_contex_v4->isReCalculate, deltaIso); } else { stAsharpResultV4 = asharp_contex_v4->stProcResult; stAsharpResultV4.isNeedUpdate = false; } for (int i = 0; i < procResParaGroup->arraySize; i++) { *(procResParaGroup->camgroupParmasArray[i]->asharp._asharp_procRes_v4) = stAsharpResultV4.stFix; } asharp_contex_v4->isReCalculate = 0; } else { ret = XCAM_RETURN_ERROR_FAILED; LOGE_ASHARP("module_hw_version of awb (%d) is isvalid!!!!", g_asharp_hw_ver); } LOGI_ASHARP("%s exit\n", __FUNCTION__); return ret; } RkAiqAlgoDescription g_RkIspAlgoDescCamgroupAsharp = { .common = { .version = RKISP_ALGO_CAMGROUP_ASHARP_VERSION, .vendor = RKISP_ALGO_CAMGROUP_ASHARP_VENDOR, .description = RKISP_ALGO_CAMGROUP_ASHARP_DESCRIPTION, .type = RK_AIQ_ALGO_TYPE_ASHARP, .id = 0, .create_context = groupAsharpCreateCtx, .destroy_context = groupAsharpDestroyCtx, }, .prepare = groupAsharpPrepare, .pre_process = NULL, .processing = groupAsharpProcessing, .post_process = NULL, }; RKAIQ_END_DECLARE