1 /*
2  * rk_aiq_algo_camgroup_adpcc_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 "adpcc/rk_aiq_algo_adpcc_itf.h"
23 #include "adpcc/rk_aiq_adpcc_algo.h"
24 #include "adpcc/rk_aiq_types_adpcc_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     LOG1_ADPCC("%s: (enter)", __FUNCTION__ );
36     AlgoCtxInstanceCfgCamGroup *cfgInt = (AlgoCtxInstanceCfgCamGroup*)cfg;
37 
38     AdpccContext_t* pAdpccCtx = NULL;
39     AdpccResult_t ret = AdpccInit(&pAdpccCtx, (CamCalibDbV2Context_t*)(cfgInt->s_calibv2));//load json paras
40     if(ret != ADPCC_RET_SUCCESS) {
41         result = XCAM_RETURN_ERROR_FAILED;
42         LOGE_ADPCC("%s: Initializaion Adpcc failed (%d)", __FUNCTION__, ret);
43     } else {
44         *context = (RkAiqAlgoContext *)(pAdpccCtx);
45     }
46 
47     LOG1_ADPCC("%s: (exit)", __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     LOG1_ADPCC("%s: (enter)", __FUNCTION__ );
57 
58 #if 1
59     AdpccContext_t* pAdpccCtx = (AdpccContext_t*)context;
60     AdpccResult_t ret = AdpccRelease(pAdpccCtx);
61     if(ret != ADPCC_RET_SUCCESS) {
62         result = XCAM_RETURN_ERROR_FAILED;
63         LOGE_ADPCC("%s: release Adpcc failed (%d)", __FUNCTION__, ret);
64     }
65 #endif
66 
67     LOG1_ADPCC("%s: (exit)", __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     LOG1_ADPCC("%s: (enter)", __FUNCTION__ );
77 
78     AdpccContext_t* pAdpccCtx = (AdpccContext_t *)params->ctx;
79     RkAiqAlgoCamGroupPrepare* pCfgParam = (RkAiqAlgoCamGroupPrepare*)params;
80     pAdpccCtx->prepare_type = params->u.prepare.conf_type;
81 
82     if(!!(params->u.prepare.conf_type & RK_AIQ_ALGO_CONFTYPE_UPDATECALIB )) {
83         AdpccResult_t ret = AdpccReloadPara(pAdpccCtx, (CamCalibDbV2Context_t*)(pCfgParam->s_calibv2));
84         if(ret != ADPCC_RET_SUCCESS) {
85             result = XCAM_RETURN_ERROR_FAILED;
86             LOGE_ADPCC("%s: Adpcc Reload Para failed (%d)", __FUNCTION__, ret);
87         }
88     }
89 
90     pAdpccCtx->isReCal_ = true;
91 
92     LOG1_ADPCC("%s: (exit)", __FUNCTION__ );
93     return result;
94 }
95 
96 static XCamReturn
processing(const RkAiqAlgoCom * inparams,RkAiqAlgoResCom * outparams)97 processing(const RkAiqAlgoCom* inparams, RkAiqAlgoResCom* outparams)
98 {
99     XCamReturn result = XCAM_RETURN_NO_ERROR;
100     int iso;
101 
102     LOG1_ADPCC("%s: (enter)", __FUNCTION__ );
103 
104 #if 1
105     RkAiqAlgoCamGroupProcIn* procParaGroup = (RkAiqAlgoCamGroupProcIn*)inparams;
106     RkAiqAlgoCamGroupProcOut* procResParaGroup = (RkAiqAlgoCamGroupProcOut*)outparams;
107     AdpccContext_t* pAdpccCtx = (AdpccContext_t *)inparams->ctx;
108     AdpccExpInfo_t stExpInfo;
109     memset(&stExpInfo, 0x00, sizeof(AdpccExpInfo_t));
110 
111     LOGD_ADPCC("%s:%d init:%d hdr mode:%d",
112                __FUNCTION__, __LINE__,
113                inparams->u.proc.init,
114                procParaGroup->working_mode);
115 
116     stExpInfo.hdr_mode = 0; //pAnrProcParams->hdr_mode;
117     for(int i = 0; i < 3; i++) {
118         stExpInfo.arPreResIso[i] = 50;
119         stExpInfo.arPreResAGain[i] = 1.0;
120         stExpInfo.arPreResDGain[i] = 1.0;
121         stExpInfo.arPreResTime[i] = 0.01;
122 
123         stExpInfo.arProcResIso[i] = 50;
124         stExpInfo.arProcResAGain[i] = 1.0;
125         stExpInfo.arProcResDGain[i] = 1.0;
126         stExpInfo.arProcResTime[i] = 0.01;
127     }
128 
129     pAdpccCtx->isBlackSensor = procParaGroup->_is_bw_sensor;
130 
131     if(procParaGroup->working_mode == RK_AIQ_WORKING_MODE_NORMAL) {
132         stExpInfo.hdr_mode = 0;
133     } else if(procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_2_FRAME_HDR
134               || procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_2_LINE_HDR ) {
135         stExpInfo.hdr_mode = 1;
136     } else if(procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_3_FRAME_HDR
137               || procParaGroup->working_mode == RK_AIQ_ISP_HDR_MODE_3_LINE_HDR ) {
138         stExpInfo.hdr_mode = 2;
139     }
140 
141     rk_aiq_singlecam_3a_result_t* scam_3a_res = procParaGroup->camgroupParmasArray[0];
142 
143     if(scam_3a_res->aec._bEffAecExpValid) {
144         RKAiqAecExpInfo_t* pAERes = &scam_3a_res->aec._effAecExpInfo;
145         if(procParaGroup->working_mode == RK_AIQ_WORKING_MODE_NORMAL) {
146             stExpInfo.arPreResAGain[0] = pAERes->LinearExp.exp_real_params.analog_gain;
147             stExpInfo.arPreResDGain[0] = pAERes->LinearExp.exp_real_params.digital_gain * pAERes->LinearExp.exp_real_params.isp_dgain;
148             stExpInfo.arPreResTime[0] = pAERes->LinearExp.exp_real_params.integration_time;
149             stExpInfo.arPreResIso[0] = stExpInfo.arPreResAGain[0] * stExpInfo.arPreResDGain[0] * 50;
150 
151             LOGD_ADPCC("%s:%d index:%d again:%f dgain:%f time:%f iso:%d hdr_mode:%d",
152                        __FUNCTION__, __LINE__,
153                        0,
154                        stExpInfo.arPreResAGain[0],
155                        stExpInfo.arPreResDGain[0],
156                        stExpInfo.arPreResTime[0],
157                        stExpInfo.arPreResIso[0],
158                        stExpInfo.hdr_mode);
159         } else {
160             for(int i = 0; i < 3; i++) {
161                 stExpInfo.arPreResAGain[i] = pAERes->HdrExp[i].exp_real_params.analog_gain;
162                 stExpInfo.arPreResDGain[i] = pAERes->HdrExp[i].exp_real_params.digital_gain *
163                     pAERes->HdrExp[i].exp_real_params.isp_dgain;
164                 stExpInfo.arPreResTime[i] = pAERes->HdrExp[i].exp_real_params.integration_time;
165                 stExpInfo.arPreResIso[i] = stExpInfo.arPreResAGain[i] * stExpInfo.arPreResDGain[i] * 50;
166 
167                 LOGD_ADPCC("%s:%d index:%d again:%f dgain:%f time:%f iso:%d hdr_mode:%d",
168                            __FUNCTION__, __LINE__,
169                            i,
170                            stExpInfo.arPreResAGain[i],
171                            stExpInfo.arPreResDGain[i],
172                            stExpInfo.arPreResTime[i],
173                            stExpInfo.arPreResIso[i],
174                            stExpInfo.hdr_mode);
175             }
176         }
177     } else {
178         LOGE_ADPCC("%s:%d pAERes is NULL, so use default instead", __FUNCTION__, __LINE__);
179     }
180 
181     if (pAdpccCtx->stExpInfo.arPreResIso[pAdpccCtx->stExpInfo.hdr_mode] !=
182         stExpInfo.arPreResIso[pAdpccCtx->stExpInfo.hdr_mode])
183         pAdpccCtx->isReCal_ = true;
184 
185 
186     if (pAdpccCtx->isReCal_) {
187         AdpccResult_t ret = AdpccProcess(pAdpccCtx, &stExpInfo, procResParaGroup->camgroupParmasArray[0]->_dpccConfig);
188         if(ret != ADPCC_RET_SUCCESS) {
189             result = XCAM_RETURN_ERROR_FAILED;
190             LOGE_ADPCC("%s: processing Adpcc failed (%d)", __FUNCTION__, ret);
191         }
192 
193         for (int i = 1; i < procResParaGroup->arraySize; i++) {
194             procResParaGroup->camgroupParmasArray[i]->_dpccConfig = procResParaGroup->camgroupParmasArray[0]->_dpccConfig;
195             IS_UPDATE_MEM((procResParaGroup->camgroupParmasArray[i]->_adehazeConfig), procParaGroup->_offset_is_update) =
196                 true;
197         }
198 
199         outparams->cfg_update = true;
200         pAdpccCtx->isReCal_ = false;
201     } else {
202         for (int i = 1; i < procResParaGroup->arraySize; i++) {
203             procResParaGroup->camgroupParmasArray[i]->_dpccConfig = procResParaGroup->camgroupParmasArray[0]->_dpccConfig;
204             IS_UPDATE_MEM((procResParaGroup->camgroupParmasArray[i]->_adehazeConfig), procParaGroup->_offset_is_update) =
205                 false;
206         }
207         outparams->cfg_update = false;
208     }
209 #if 0 //TODO: Is this necessary for group algo ?
210     //sensor dpcc setting
211     pAdpccProcResParams->adpcc_proc_res_com.SenDpccRes.enable = pAdpccCtx->SenDpccRes.enable;
212     pAdpccProcResParams->adpcc_proc_res_com.SenDpccRes.total_dpcc = pAdpccCtx->SenDpccRes.total_dpcc;
213     pAdpccProcResParams->adpcc_proc_res_com.SenDpccRes.cur_single_dpcc = pAdpccCtx->SenDpccRes.cur_single_dpcc;
214     pAdpccProcResParams->adpcc_proc_res_com.SenDpccRes.cur_multiple_dpcc = pAdpccCtx->SenDpccRes.cur_multiple_dpcc;
215 #endif
216 
217 #endif
218 
219     LOG1_ADPCC("%s: (exit)", __FUNCTION__ );
220     return XCAM_RETURN_NO_ERROR;
221 }
222 
223 RkAiqAlgoDescription g_RkIspAlgoDescCamgroupAdpcc = {
224     .common = {
225         .version = RKISP_ALGO_ADPCC_VERSION,
226         .vendor  = RKISP_ALGO_ADPCC_VENDOR,
227         .description = RKISP_ALGO_ADPCC_DESCRIPTION,
228         .type    = RK_AIQ_ALGO_TYPE_ADPCC,
229         .id      = 0,
230         .create_context  = create_context,
231         .destroy_context = destroy_context,
232     },
233     .prepare = prepare,
234     .pre_process = NULL,
235     .processing = processing,
236     .post_process = NULL,
237 };
238 
239 RKAIQ_END_DECLARE
240