1 /*
2 * rk_aiq_algo_camgroup_awb_itf.c
3 *
4 * Copyright (c) 2021 Rockchip Corporation
5 *
6 * Licensed under the Apache License, Version 2.0 (the "License");
7 * you may not use this file except in compliance with the License.
8 * You may obtain a copy of the License at
9 *
10 * http://www.apache.org/licenses/LICENSE-2.0
11 *
12 * Unless required by applicable law or agreed to in writing, software
13 * distributed under the License is distributed on an "AS IS" BASIS,
14 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
15 * See the License for the specific language governing permissions and
16 * limitations under the License.
17 *
18 */
19
20 #include "rk_aiq_algo_camgroup_acnr_itf.h"
21 #include "rk_aiq_algo_camgroup_types.h"
22 #include "rk_aiq_types_camgroup_acnr_prvt.h"
23 #include "acnr/rk_aiq_acnr_algo_itf_v1.h"
24 #include "acnr/rk_aiq_acnr_algo_v1.h"
25
26
27
28 RKAIQ_BEGIN_DECLARE
29
30
groupAcnrCreateCtx(RkAiqAlgoContext ** context,const AlgoCtxInstanceCfg * cfg)31 static XCamReturn groupAcnrCreateCtx(RkAiqAlgoContext **context, const AlgoCtxInstanceCfg* cfg)
32 {
33 LOGI_ANR("%s enter \n", __FUNCTION__ );
34
35 XCamReturn ret = XCAM_RETURN_NO_ERROR;
36 CamGroup_Acnr_Contex_t *acnr_group_contex = NULL;
37 AlgoCtxInstanceCfgCamGroup *cfgInt = (AlgoCtxInstanceCfgCamGroup*)cfg;
38 //g_acnr_hw_ver = (acnr_hardware_version_t)(cfgInt->cfg_com.module_hw_version);
39
40
41 if(CHECK_ISP_HW_V21()) {
42 acnr_group_contex = (CamGroup_Acnr_Contex_t*)malloc(sizeof(CamGroup_Acnr_Contex_t));
43 #if (ACNR_USE_JSON_FILE_V1)
44 Acnr_result_t ret_v1 = ACNR_RET_SUCCESS;
45 ret_v1 = Acnr_Init_V1(&(acnr_group_contex->acnr_contex_v1), (void *)cfgInt->s_calibv2);
46 if(ret_v1 != ACNR_RET_SUCCESS) {
47 ret = XCAM_RETURN_ERROR_FAILED;
48 LOGE_ANR("%s: Initializaion ANR failed (%d)\n", __FUNCTION__, ret);
49 }
50 #endif
51 } else {
52 ret = XCAM_RETURN_ERROR_FAILED;
53 LOGE_ANR("module_hw_version of acnr is invalid!!!!");
54 }
55
56 if(ret != XCAM_RETURN_NO_ERROR) {
57 LOGE_ANR("%s: Initializaion group cnr failed (%d)\n", __FUNCTION__, ret);
58 } else {
59 // to do got acnrSurrViewClib and initinal paras for for surround view
60 acnr_group_contex->group_CalibV2.groupMethod = CalibDbV2_CAMGROUP_ACNR_METHOD_MEAN;// to do from json
61 acnr_group_contex->camera_Num = cfgInt->camIdArrayLen;
62
63 *context = (RkAiqAlgoContext *)(acnr_group_contex);
64
65 LOGI_ANR("%s:%d surrViewMethod(1-mean):%d, cameraNum %d \n",
66 __FUNCTION__, __LINE__,
67 acnr_group_contex->group_CalibV2.groupMethod,
68 acnr_group_contex->camera_Num);
69 }
70
71 LOGI_ANR("%s exit ret:%d\n", __FUNCTION__, ret);
72 return ret;
73
74 }
75
groupAcnrDestroyCtx(RkAiqAlgoContext * context)76 static XCamReturn groupAcnrDestroyCtx(RkAiqAlgoContext *context)
77 {
78 LOGI_ANR("%s enter \n", __FUNCTION__ );
79
80 XCamReturn ret = XCAM_RETURN_NO_ERROR;
81
82 CamGroup_Acnr_Contex_t *acnr_group_contex = (CamGroup_Acnr_Contex_t*)context;
83
84 if(CHECK_ISP_HW_V21()) {
85 Acnr_result_t ret_v1 = ACNR_RET_SUCCESS;
86 ret_v1 = Acnr_Release_V1(acnr_group_contex->acnr_contex_v1);
87 if(ret_v1 != ACNR_RET_SUCCESS) {
88 ret = XCAM_RETURN_ERROR_FAILED;
89 LOGE_ANR("%s: Initializaion ANR failed (%d)\n", __FUNCTION__, ret);
90 }
91 }
92 else {
93 ret = XCAM_RETURN_ERROR_FAILED;
94 LOGE_ANR("module_hw_version of acnr is isvalid!!!!");
95 }
96
97 if(ret != XCAM_RETURN_NO_ERROR) {
98 LOGE_ANR("%s: release ANR failed (%d)\n", __FUNCTION__, ret);
99 } else {
100 free(acnr_group_contex);
101 }
102
103
104 LOGI_ANR("%s exit ret:%d\n", __FUNCTION__, ret);
105 return ret;
106 }
107
groupAcnrPrepare(RkAiqAlgoCom * params)108 static XCamReturn groupAcnrPrepare(RkAiqAlgoCom* params)
109 {
110 LOGI_ANR("%s enter \n", __FUNCTION__ );
111
112 XCamReturn ret = XCAM_RETURN_NO_ERROR;
113
114 CamGroup_Acnr_Contex_t * acnr_group_contex = (CamGroup_Acnr_Contex_t *)params->ctx;
115 RkAiqAlgoCamGroupPrepare* para = (RkAiqAlgoCamGroupPrepare*)params;
116
117 if(CHECK_ISP_HW_V21()) {
118 Acnr_Context_V1_t * acnr_contex_v1 = acnr_group_contex->acnr_contex_v1;
119 acnr_contex_v1->prepare_type = params->u.prepare.conf_type;
120 if(!!(params->u.prepare.conf_type & RK_AIQ_ALGO_CONFTYPE_UPDATECALIB )) {
121 // todo update calib pars for surround view
122 #if ACNR_USE_JSON_FILE_V1
123 void *pCalibdbV2 = (void*)(para->s_calibv2);
124 CalibDbV2_CNR_t *cnr_v1 = (CalibDbV2_CNR_t*)(CALIBDBV2_GET_MODULE_PTR((void*)pCalibdbV2, cnr_v1));
125 acnr_contex_v1->cnr_v1 = *cnr_v1;
126 acnr_contex_v1->isIQParaUpdate = true;
127 acnr_contex_v1->isReCalculate |= 1;
128 #endif
129 }
130 Acnr_Config_V1_t stAcnrConfigV1;
131 stAcnrConfigV1.rawHeight = params->u.prepare.sns_op_height;
132 stAcnrConfigV1.rawWidth = params->u.prepare.sns_op_width;
133 Acnr_result_t ret_v1 = ACNR_RET_SUCCESS;
134 ret_v1 = Acnr_Prepare_V1(acnr_contex_v1, &stAcnrConfigV1);
135 if(ret_v1 != ACNR_RET_SUCCESS) {
136 ret = XCAM_RETURN_ERROR_FAILED;
137 LOGE_ANR("%s: config ANR failed (%d)\n", __FUNCTION__, ret);
138 }
139 }
140 else {
141 ret = XCAM_RETURN_ERROR_FAILED;
142 LOGE_ANR("module_hw_version of acnr is isvalid!!!!");
143 }
144
145 LOGI_ANR("%s exit ret:%d\n", __FUNCTION__, ret);
146 return ret;
147 }
148
groupAcnrProcessing(const RkAiqAlgoCom * inparams,RkAiqAlgoResCom * outparams)149 static XCamReturn groupAcnrProcessing(const RkAiqAlgoCom* inparams, RkAiqAlgoResCom* outparams)
150 {
151 LOGI_ANR("%s enter \n", __FUNCTION__ );
152 LOGI_ANR("----------------------------------------------frame_id (%d)----------------------------------------------\n", inparams->frame_id);
153
154 XCamReturn ret = XCAM_RETURN_NO_ERROR;
155 RkAiqAlgoCamGroupProcIn* procParaGroup = (RkAiqAlgoCamGroupProcIn*)inparams;
156 RkAiqAlgoCamGroupProcOut* procResParaGroup = (RkAiqAlgoCamGroupProcOut*)outparams;
157 CamGroup_Acnr_Contex_t * acnr_group_contex = (CamGroup_Acnr_Contex_t *)inparams->ctx;
158 int deltaIso = 0;
159
160 //method error
161 if (acnr_group_contex->group_CalibV2.groupMethod <= CalibDbV2_CAMGROUP_ACNR_METHOD_MIN
162 || acnr_group_contex->group_CalibV2.groupMethod >= CalibDbV2_CAMGROUP_ACNR_METHOD_MAX) {
163 return (ret);
164 }
165
166 //group empty
167 if(procParaGroup->camgroupParmasArray == nullptr) {
168 LOGE_ANR("camgroupParmasArray is null");
169 return(XCAM_RETURN_ERROR_FAILED);
170 }
171
172 //get cur ae exposure
173 Acnr_ExpInfo_t stExpInfoV1;
174 memset(&stExpInfoV1, 0x00, sizeof(stExpInfoV1));
175 stExpInfoV1.hdr_mode = 0; //pAnrProcParams->hdr_mode;
176 stExpInfoV1.snr_mode = 0;
177 for(int i = 0; i < 3; i++) {
178 stExpInfoV1.arIso[i] = 50;
179 stExpInfoV1.arAGain[i] = 1.0;
180 stExpInfoV1.arDGain[i] = 1.0;
181 stExpInfoV1.arTime[i] = 0.01;
182 }
183
184
185 //merge ae result, iso mean value
186 rk_aiq_singlecam_3a_result_t* scam_3a_res = procParaGroup->camgroupParmasArray[0];
187 if(scam_3a_res->aec._bEffAecExpValid) {
188 RKAiqAecExpInfo_t* pCurExp = &scam_3a_res->aec._effAecExpInfo;
189 stExpInfoV1.snr_mode = pCurExp->CISFeature.SNR;
190 if((rk_aiq_working_mode_t)procParaGroup->working_mode == RK_AIQ_WORKING_MODE_NORMAL) {
191 stExpInfoV1.hdr_mode = 0;
192 stExpInfoV1.arAGain[0] = pCurExp->LinearExp.exp_real_params.analog_gain;
193 stExpInfoV1.arDGain[0] = pCurExp->LinearExp.exp_real_params.digital_gain * pCurExp->LinearExp.exp_real_params.isp_dgain;
194 stExpInfoV1.arTime[0] = pCurExp->LinearExp.exp_real_params.integration_time;
195 stExpInfoV1.arIso[0] = stExpInfoV1.arAGain[0] * stExpInfoV1.arDGain[0] * 50;
196
197 } else {
198 if(procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_2_FRAME_HDR
199 || procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_2_LINE_HDR)
200 stExpInfoV1.hdr_mode = 1;
201 else if (procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_3_FRAME_HDR
202 || procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_3_LINE_HDR)
203 stExpInfoV1.hdr_mode = 2;
204 else {
205 stExpInfoV1.hdr_mode = 0;
206 LOGE_ANR("mode error\n");
207 }
208
209 for(int i = 0; i < 3; i++) {
210 stExpInfoV1.arAGain[i] = pCurExp->HdrExp[i].exp_real_params.analog_gain;
211 stExpInfoV1.arDGain[i] = pCurExp->HdrExp[i].exp_real_params.digital_gain;
212 stExpInfoV1.arTime[i] = pCurExp->HdrExp[i].exp_real_params.integration_time;
213 stExpInfoV1.arIso[i] = stExpInfoV1.arAGain[i] * stExpInfoV1.arDGain[i] * 50;
214 }
215
216 }
217 } else {
218 LOGW("fail to get sensor gain form AE module,use default value ");
219 }
220
221
222
223 if(CHECK_ISP_HW_V21()) {
224 Acnr_Context_V1_t * acnr_contex_v1 = acnr_group_contex->acnr_contex_v1;
225 Acnr_ProcResult_V1_t stAcnrResultV1;
226 RK_CNR_Fix_V1_t stFix;
227 stAcnrResultV1.stFix = &stFix;
228
229 deltaIso = abs(stExpInfoV1.arIso[stExpInfoV1.hdr_mode] - acnr_contex_v1->stExpInfo.arIso[stExpInfoV1.hdr_mode]);
230 if(deltaIso > ACNRV1_RECALCULATE_DELTA_ISO) {
231 acnr_contex_v1->isReCalculate |= 1;
232 }
233 if(acnr_contex_v1->isReCalculate) {
234 Acnr_result_t ret_v1 = ACNR_RET_SUCCESS;
235 ret_v1 = Acnr_Process_V1(acnr_contex_v1, &stExpInfoV1);
236 if(ret_v1 != ACNR_RET_SUCCESS) {
237 ret = XCAM_RETURN_ERROR_FAILED;
238 LOGE_ANR("%s: processing ANR failed (%d)\n", __FUNCTION__, ret);
239 }
240 outparams->cfg_update = true;
241 LOGD_ANR("recalculate: %d delta_iso:%d \n ", acnr_contex_v1->isReCalculate, deltaIso);
242 } else {
243 outparams->cfg_update = false;
244 }
245 Acnr_GetProcResult_V1(acnr_contex_v1, &stAcnrResultV1);
246 for (int i = 0; i < procResParaGroup->arraySize; i++) {
247 *(procResParaGroup->camgroupParmasArray[i]->acnr._acnr_procRes_v1) = *stAcnrResultV1.stFix;
248 IS_UPDATE_MEM((procResParaGroup->camgroupParmasArray[i]->acnr._acnr_procRes_v1), procParaGroup->_offset_is_update) =
249 outparams->cfg_update;
250 }
251 acnr_contex_v1->isReCalculate = 0;
252
253 }
254 else {
255 ret = XCAM_RETURN_ERROR_FAILED;
256 LOGE_ANR("module_hw_version of acnr is isvalid!!!!");
257 }
258
259 LOGI_ANR("%s exit\n", __FUNCTION__);
260 return ret;
261 }
262
263 RkAiqAlgoDescription g_RkIspAlgoDescCamgroupAcnr = {
264 .common = {
265 .version = RKISP_ALGO_CAMGROUP_ACNR_VERSION,
266 .vendor = RKISP_ALGO_CAMGROUP_ACNR_VENDOR,
267 .description = RKISP_ALGO_CAMGROUP_ACNR_DESCRIPTION,
268 .type = RK_AIQ_ALGO_TYPE_ACNR,
269 .id = 0,
270 .create_context = groupAcnrCreateCtx,
271 .destroy_context = groupAcnrDestroyCtx,
272 },
273 .prepare = groupAcnrPrepare,
274 .pre_process = NULL,
275 .processing = groupAcnrProcessing,
276 .post_process = NULL,
277 };
278
279 RKAIQ_END_DECLARE
280