1 /*
2  * rk_aiq_algo_camgroup_ablc_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_types.h"
21 #include "misc/rk_aiq_algo_camgroup_misc_itf.h"
22 #include "ablc/rk_aiq_algo_ablc_itf.h"
23 #include "ablc/rk_aiq_ablc_algo.h"
24 #include "ablc/rk_aiq_types_ablc_algo_prvt.h"
25 
26 
27 RKAIQ_BEGIN_DECLARE
28 
29 
30 static XCamReturn
create_context(RkAiqAlgoContext ** context,const AlgoCtxInstanceCfg * cfg)31 create_context(RkAiqAlgoContext **context, const AlgoCtxInstanceCfg* cfg)
32 {
33     XCamReturn result = XCAM_RETURN_NO_ERROR;
34 
35     LOGI_ABLC("%s: (enter)\n", __FUNCTION__ );
36     AlgoCtxInstanceCfgCamGroup *cfgInt = (AlgoCtxInstanceCfgCamGroup*)cfg;
37 
38     AblcContext_t* pAblcCtx = NULL;
39     AblcResult_t ret = AblcInit(&pAblcCtx, (CamCalibDbV2Context_t*)(cfgInt->s_calibv2));//load json paras
40     if(ret != ABLC_RET_SUCCESS) {
41         result = XCAM_RETURN_ERROR_FAILED;
42         LOGE_ABLC("%s: Initializaion Ablc failed (%d)\n", __FUNCTION__, ret);
43     } else {
44         *context = (RkAiqAlgoContext *)(pAblcCtx);
45     }
46 
47     LOGI_ABLC("%s: (exit)\n", __FUNCTION__ );
48     return result;
49 }
50 
51 static XCamReturn
destroy_context(RkAiqAlgoContext * context)52 destroy_context(RkAiqAlgoContext *context)
53 {
54     XCamReturn result = XCAM_RETURN_NO_ERROR;
55 
56     LOGI_ABLC("%s: (enter)\n", __FUNCTION__ );
57 
58 #if 1
59     AblcContext_t* pAblcCtx = (AblcContext_t*)context;
60     AblcResult_t ret = AblcRelease(pAblcCtx);
61     if(ret != ABLC_RET_SUCCESS) {
62         result = XCAM_RETURN_ERROR_FAILED;
63         LOGE_ABLC("%s: release Ablc failed (%d)\n", __FUNCTION__, ret);
64     }
65 #endif
66 
67     LOGI_ABLC("%s: (exit)\n", __FUNCTION__ );
68     return result;
69 }
70 
71 static XCamReturn
prepare(RkAiqAlgoCom * params)72 prepare(RkAiqAlgoCom* params)
73 {
74     XCamReturn result = XCAM_RETURN_NO_ERROR;
75 
76     LOGD_ABLC("%s: (enter)\n", __FUNCTION__ );
77 
78     AblcContext_t* pAblcCtx = (AblcContext_t *)params->ctx;
79     RkAiqAlgoCamGroupPrepare* pCfgParam = (RkAiqAlgoCamGroupPrepare*)params;
80     pAblcCtx->prepare_type = params->u.prepare.conf_type;
81 
82     if(!!(params->u.prepare.conf_type & RK_AIQ_ALGO_CONFTYPE_UPDATECALIB )) {
83         CalibDbV2_Ablc_t* calibv2_ablc_calib =
84             (CalibDbV2_Ablc_t*)(CALIBDBV2_GET_MODULE_PTR((void*)(pCfgParam->s_calibv2), ablc_calib));
85         memcpy(&pAblcCtx->stBlcCalib, calibv2_ablc_calib, sizeof(CalibDbV2_Ablc_t));
86         pAblcCtx->isUpdateParam = true;
87         pAblcCtx->isReCalculate |= 1;
88     }
89 
90 	if(pAblcCtx->isUpdateParam) {
91         AblcParamsUpdate(pAblcCtx, &pAblcCtx->stBlcCalib);
92         pAblcCtx->isReCalculate |= 1;
93         pAblcCtx->isUpdateParam = false;
94     }
95 
96     LOGI_ABLC("%s: (exit)\n", __FUNCTION__ );
97     return result;
98 }
99 
100 static XCamReturn
processing(const RkAiqAlgoCom * inparams,RkAiqAlgoResCom * outparams)101 processing(const RkAiqAlgoCom* inparams, RkAiqAlgoResCom* outparams)
102 {
103     XCamReturn result = XCAM_RETURN_NO_ERROR;
104     int iso;
105     int delta_iso = 0;
106     LOGI_ABLC("%s: (enter)\n", __FUNCTION__ );
107 
108 #if 1
109     RkAiqAlgoCamGroupProcIn* procParaGroup = (RkAiqAlgoCamGroupProcIn*)inparams;
110     RkAiqAlgoCamGroupProcOut* procResParaGroup = (RkAiqAlgoCamGroupProcOut*)outparams;
111     AblcContext_t* pAblcCtx = (AblcContext_t *)inparams->ctx;
112     AblcExpInfo_t stExpInfo;
113     memset(&stExpInfo, 0x00, sizeof(AblcExpInfo_t));
114 
115     LOGD_ABLC("%s:%d init:%d hdr mode:%d  \n",
116               __FUNCTION__, __LINE__,
117               inparams->u.proc.init,
118               procParaGroup->working_mode);
119 
120     stExpInfo.hdr_mode = 0; //pAnrProcParams->hdr_mode;
121     for(int i = 0; i < 3; i++) {
122         stExpInfo.arIso[i] = 50;
123         stExpInfo.arAGain[i] = 1.0;
124         stExpInfo.arDGain[i] = 1.0;
125         stExpInfo.arTime[i] = 0.01;
126     }
127 
128     if(procParaGroup->working_mode == RK_AIQ_WORKING_MODE_NORMAL) {
129         stExpInfo.hdr_mode = 0;
130     } else if(procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_2_FRAME_HDR
131               || procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_2_LINE_HDR ) {
132         stExpInfo.hdr_mode = 1;
133     } else if(procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_3_FRAME_HDR
134               || procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_3_LINE_HDR ) {
135         stExpInfo.hdr_mode = 2;
136     }
137 
138     rk_aiq_singlecam_3a_result_t* scam_3a_res = procParaGroup->camgroupParmasArray[0];
139 
140     if(scam_3a_res->aec._bEffAecExpValid) {
141         RKAiqAecExpInfo_t* pAERes = &scam_3a_res->aec._effAecExpInfo;
142         if(procParaGroup->working_mode == RK_AIQ_WORKING_MODE_NORMAL) {
143             stExpInfo.arAGain[0] = pAERes->LinearExp.exp_real_params.analog_gain;
144             stExpInfo.arDGain[0] = pAERes->LinearExp.exp_real_params.digital_gain * pAERes->LinearExp.exp_real_params.isp_dgain;
145             stExpInfo.arTime[0] = pAERes->LinearExp.exp_real_params.integration_time;
146             stExpInfo.isp_dgain[0] = pAERes->LinearExp.exp_real_params.isp_dgain;
147             stExpInfo.arIso[0] = stExpInfo.arAGain[0] * stExpInfo.arDGain[0] * 50;
148         } else {
149             for(int i = 0; i < 3; i++) {
150                 stExpInfo.arAGain[i] = pAERes->HdrExp[i].exp_real_params.analog_gain;
151                 stExpInfo.arDGain[i] = pAERes->HdrExp[i].exp_real_params.digital_gain;
152                 stExpInfo.arTime[i] = pAERes->HdrExp[i].exp_real_params.integration_time;
153                 stExpInfo.isp_dgain[i] = pAERes->HdrExp[i].exp_real_params.isp_dgain;
154                 stExpInfo.arIso[i] = stExpInfo.arAGain[i] * stExpInfo.arDGain[i] * 50;
155 
156                 LOGD_ABLC("%s:%d index:%d again:%f dgain:%f time:%f iso:%d hdr_mode:%d\n",
157                           __FUNCTION__, __LINE__,
158                           i,
159                           stExpInfo.arAGain[i],
160                           stExpInfo.arDGain[i],
161                           stExpInfo.arTime[i],
162                           stExpInfo.arIso[i],
163                           stExpInfo.hdr_mode);
164             }
165         }
166     } else {
167         LOGE_ABLC("%s:%d pAERes is NULL, so use default instead \n", __FUNCTION__, __LINE__);
168     }
169 
170     delta_iso = abs(stExpInfo.arIso[stExpInfo.hdr_mode] - pAblcCtx->stExpInfo.arIso[pAblcCtx->stExpInfo.hdr_mode]);
171     if(delta_iso > ABLC_RECALCULATE_DELTE_ISO) {
172         pAblcCtx->isReCalculate |= 1;
173     }
174 
175 
176     if(pAblcCtx->isReCalculate ) {
177         AblcResult_t ret = AblcProcess(pAblcCtx, &stExpInfo);
178         if(ret != ABLC_RET_SUCCESS) {
179             result = XCAM_RETURN_ERROR_FAILED;
180             LOGE_ABLC("%s: processing Ablc failed (%d)\n", __FUNCTION__, ret);
181         }
182         LOGD_ABLC("%s:%d processing ABLC recalculate delta_iso:%d \n", __FUNCTION__, __LINE__, delta_iso);
183     }
184 
185 
186     for (int i = 0; i < procResParaGroup->arraySize; i++) {
187         if (pAblcCtx->isReCalculate)
188             procResParaGroup->camgroupParmasArray[i]->ablc._blcConfig->v0 = pAblcCtx->ProcRes;
189         //TODO
190         IS_UPDATE_MEM((procResParaGroup->camgroupParmasArray[i]->ablc._blcConfig), procParaGroup->_offset_is_update) =
191             pAblcCtx->isReCalculate;
192     }
193 
194     pAblcCtx->isReCalculate = 0;
195 #if 0 //TODO: Is this necessary for group algo ?
196     //sensor blc setting
197     pAblcProcResParams->ablc_proc_res_com.SenDpccRes.enable = pAblcCtx->SenDpccRes.enable;
198     pAblcProcResParams->ablc_proc_res_com.SenDpccRes.total_blc = pAblcCtx->SenDpccRes.total_blc;
199     pAblcProcResParams->ablc_proc_res_com.SenDpccRes.cur_single_blc = pAblcCtx->SenDpccRes.cur_single_blc;
200     pAblcProcResParams->ablc_proc_res_com.SenDpccRes.cur_multiple_blc = pAblcCtx->SenDpccRes.cur_multiple_blc;
201 #endif
202 
203 #endif
204 
205     LOGI_ABLC("%s: (exit)\n", __FUNCTION__ );
206     return XCAM_RETURN_NO_ERROR;
207 }
208 
209 RkAiqAlgoDescription g_RkIspAlgoDescCamgroupAblc = {
210     .common = {
211         .version = RKISP_ALGO_ABLC_VERSION,
212         .vendor  = RKISP_ALGO_ABLC_VENDOR,
213         .description = RKISP_ALGO_ABLC_DESCRIPTION,
214         .type    = RK_AIQ_ALGO_TYPE_ABLC,
215         .id      = 0,
216         .create_context  = create_context,
217         .destroy_context = destroy_context,
218     },
219     .prepare = prepare,
220     .pre_process = NULL,
221     .processing = processing,
222     .post_process = NULL,
223 };
224 
225 RKAIQ_END_DECLARE
226