1 // SPDX-License-Identifier: (GPL-2.0+ OR MIT) 2 /* 3 * Rockchip ISP1 Driver - Params subdevice 4 * 5 * Copyright (C) 2017 Rockchip Electronics Co., Ltd. 6 */ 7 8 #include <media/v4l2-common.h> 9 #include <media/v4l2-event.h> 10 #include <media/v4l2-ioctl.h> 11 #include <media/videobuf2-core.h> 12 #include <media/videobuf2-vmalloc.h> /* for ISP params */ 13 14 #include "rkisp1-common.h" 15 16 #define RKISP1_PARAMS_DEV_NAME RKISP1_DRIVER_NAME "_params" 17 18 #define RKISP1_ISP_PARAMS_REQ_BUFS_MIN 2 19 #define RKISP1_ISP_PARAMS_REQ_BUFS_MAX 8 20 21 #define RKISP1_ISP_DPCC_LINE_THRESH(n) \ 22 (RKISP1_CIF_ISP_DPCC_LINE_THRESH_1 + 0x14 * (n)) 23 #define RKISP1_ISP_DPCC_LINE_MAD_FAC(n) \ 24 (RKISP1_CIF_ISP_DPCC_LINE_MAD_FAC_1 + 0x14 * (n)) 25 #define RKISP1_ISP_DPCC_PG_FAC(n) \ 26 (RKISP1_CIF_ISP_DPCC_PG_FAC_1 + 0x14 * (n)) 27 #define RKISP1_ISP_DPCC_RND_THRESH(n) \ 28 (RKISP1_CIF_ISP_DPCC_RND_THRESH_1 + 0x14 * (n)) 29 #define RKISP1_ISP_DPCC_RG_FAC(n) \ 30 (RKISP1_CIF_ISP_DPCC_RG_FAC_1 + 0x14 * (n)) 31 #define RKISP1_ISP_CC_COEFF(n) \ 32 (RKISP1_CIF_ISP_CC_COEFF_0 + (n) * 4) 33 34 static inline void 35 rkisp1_param_set_bits(struct rkisp1_params *params, u32 reg, u32 bit_mask) 36 { 37 u32 val; 38 39 val = rkisp1_read(params->rkisp1, reg); 40 rkisp1_write(params->rkisp1, val | bit_mask, reg); 41 } 42 43 static inline void 44 rkisp1_param_clear_bits(struct rkisp1_params *params, u32 reg, u32 bit_mask) 45 { 46 u32 val; 47 48 val = rkisp1_read(params->rkisp1, reg); 49 rkisp1_write(params->rkisp1, val & ~bit_mask, reg); 50 } 51 52 /* ISP BP interface function */ 53 static void rkisp1_dpcc_config(struct rkisp1_params *params, 54 const struct rkisp1_cif_isp_dpcc_config *arg) 55 { 56 unsigned int i; 57 u32 mode; 58 59 /* avoid to override the old enable value */ 60 mode = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_DPCC_MODE); 61 mode &= RKISP1_CIF_ISP_DPCC_ENA; 62 mode |= arg->mode & ~RKISP1_CIF_ISP_DPCC_ENA; 63 rkisp1_write(params->rkisp1, mode, RKISP1_CIF_ISP_DPCC_MODE); 64 rkisp1_write(params->rkisp1, arg->output_mode, 65 RKISP1_CIF_ISP_DPCC_OUTPUT_MODE); 66 rkisp1_write(params->rkisp1, arg->set_use, 67 RKISP1_CIF_ISP_DPCC_SET_USE); 68 69 rkisp1_write(params->rkisp1, arg->methods[0].method, 70 RKISP1_CIF_ISP_DPCC_METHODS_SET_1); 71 rkisp1_write(params->rkisp1, arg->methods[1].method, 72 RKISP1_CIF_ISP_DPCC_METHODS_SET_2); 73 rkisp1_write(params->rkisp1, arg->methods[2].method, 74 RKISP1_CIF_ISP_DPCC_METHODS_SET_3); 75 for (i = 0; i < RKISP1_CIF_ISP_DPCC_METHODS_MAX; i++) { 76 rkisp1_write(params->rkisp1, arg->methods[i].line_thresh, 77 RKISP1_ISP_DPCC_LINE_THRESH(i)); 78 rkisp1_write(params->rkisp1, arg->methods[i].line_mad_fac, 79 RKISP1_ISP_DPCC_LINE_MAD_FAC(i)); 80 rkisp1_write(params->rkisp1, arg->methods[i].pg_fac, 81 RKISP1_ISP_DPCC_PG_FAC(i)); 82 rkisp1_write(params->rkisp1, arg->methods[i].rnd_thresh, 83 RKISP1_ISP_DPCC_RND_THRESH(i)); 84 rkisp1_write(params->rkisp1, arg->methods[i].rg_fac, 85 RKISP1_ISP_DPCC_RG_FAC(i)); 86 } 87 88 rkisp1_write(params->rkisp1, arg->rnd_offs, 89 RKISP1_CIF_ISP_DPCC_RND_OFFS); 90 rkisp1_write(params->rkisp1, arg->ro_limits, 91 RKISP1_CIF_ISP_DPCC_RO_LIMITS); 92 } 93 94 /* ISP black level subtraction interface function */ 95 static void rkisp1_bls_config(struct rkisp1_params *params, 96 const struct rkisp1_cif_isp_bls_config *arg) 97 { 98 /* avoid to override the old enable value */ 99 u32 new_control; 100 101 new_control = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_BLS_CTRL); 102 new_control &= RKISP1_CIF_ISP_BLS_ENA; 103 /* fixed subtraction values */ 104 if (!arg->enable_auto) { 105 const struct rkisp1_cif_isp_bls_fixed_val *pval = 106 &arg->fixed_val; 107 108 switch (params->raw_type) { 109 case RKISP1_RAW_BGGR: 110 rkisp1_write(params->rkisp1, 111 pval->r, RKISP1_CIF_ISP_BLS_D_FIXED); 112 rkisp1_write(params->rkisp1, 113 pval->gr, RKISP1_CIF_ISP_BLS_C_FIXED); 114 rkisp1_write(params->rkisp1, 115 pval->gb, RKISP1_CIF_ISP_BLS_B_FIXED); 116 rkisp1_write(params->rkisp1, 117 pval->b, RKISP1_CIF_ISP_BLS_A_FIXED); 118 break; 119 case RKISP1_RAW_GBRG: 120 rkisp1_write(params->rkisp1, 121 pval->r, RKISP1_CIF_ISP_BLS_C_FIXED); 122 rkisp1_write(params->rkisp1, 123 pval->gr, RKISP1_CIF_ISP_BLS_D_FIXED); 124 rkisp1_write(params->rkisp1, 125 pval->gb, RKISP1_CIF_ISP_BLS_A_FIXED); 126 rkisp1_write(params->rkisp1, 127 pval->b, RKISP1_CIF_ISP_BLS_B_FIXED); 128 break; 129 case RKISP1_RAW_GRBG: 130 rkisp1_write(params->rkisp1, 131 pval->r, RKISP1_CIF_ISP_BLS_B_FIXED); 132 rkisp1_write(params->rkisp1, 133 pval->gr, RKISP1_CIF_ISP_BLS_A_FIXED); 134 rkisp1_write(params->rkisp1, 135 pval->gb, RKISP1_CIF_ISP_BLS_D_FIXED); 136 rkisp1_write(params->rkisp1, 137 pval->b, RKISP1_CIF_ISP_BLS_C_FIXED); 138 break; 139 case RKISP1_RAW_RGGB: 140 rkisp1_write(params->rkisp1, 141 pval->r, RKISP1_CIF_ISP_BLS_A_FIXED); 142 rkisp1_write(params->rkisp1, 143 pval->gr, RKISP1_CIF_ISP_BLS_B_FIXED); 144 rkisp1_write(params->rkisp1, 145 pval->gb, RKISP1_CIF_ISP_BLS_C_FIXED); 146 rkisp1_write(params->rkisp1, 147 pval->b, RKISP1_CIF_ISP_BLS_D_FIXED); 148 break; 149 default: 150 break; 151 } 152 153 } else { 154 if (arg->en_windows & BIT(1)) { 155 rkisp1_write(params->rkisp1, arg->bls_window2.h_offs, 156 RKISP1_CIF_ISP_BLS_H2_START); 157 rkisp1_write(params->rkisp1, arg->bls_window2.h_size, 158 RKISP1_CIF_ISP_BLS_H2_STOP); 159 rkisp1_write(params->rkisp1, arg->bls_window2.v_offs, 160 RKISP1_CIF_ISP_BLS_V2_START); 161 rkisp1_write(params->rkisp1, arg->bls_window2.v_size, 162 RKISP1_CIF_ISP_BLS_V2_STOP); 163 new_control |= RKISP1_CIF_ISP_BLS_WINDOW_2; 164 } 165 166 if (arg->en_windows & BIT(0)) { 167 rkisp1_write(params->rkisp1, arg->bls_window1.h_offs, 168 RKISP1_CIF_ISP_BLS_H1_START); 169 rkisp1_write(params->rkisp1, arg->bls_window1.h_size, 170 RKISP1_CIF_ISP_BLS_H1_STOP); 171 rkisp1_write(params->rkisp1, arg->bls_window1.v_offs, 172 RKISP1_CIF_ISP_BLS_V1_START); 173 rkisp1_write(params->rkisp1, arg->bls_window1.v_size, 174 RKISP1_CIF_ISP_BLS_V1_STOP); 175 new_control |= RKISP1_CIF_ISP_BLS_WINDOW_1; 176 } 177 178 rkisp1_write(params->rkisp1, arg->bls_samples, 179 RKISP1_CIF_ISP_BLS_SAMPLES); 180 181 new_control |= RKISP1_CIF_ISP_BLS_MODE_MEASURED; 182 } 183 rkisp1_write(params->rkisp1, new_control, RKISP1_CIF_ISP_BLS_CTRL); 184 } 185 186 /* ISP LS correction interface function */ 187 static void 188 rkisp1_lsc_matrix_config_v10(struct rkisp1_params *params, 189 const struct rkisp1_cif_isp_lsc_config *pconfig) 190 { 191 unsigned int isp_lsc_status, sram_addr, isp_lsc_table_sel, i, j, data; 192 193 isp_lsc_status = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_LSC_STATUS); 194 195 /* RKISP1_CIF_ISP_LSC_TABLE_ADDRESS_153 = ( 17 * 18 ) >> 1 */ 196 sram_addr = (isp_lsc_status & RKISP1_CIF_ISP_LSC_ACTIVE_TABLE) ? 197 RKISP1_CIF_ISP_LSC_TABLE_ADDRESS_0 : 198 RKISP1_CIF_ISP_LSC_TABLE_ADDRESS_153; 199 rkisp1_write(params->rkisp1, sram_addr, 200 RKISP1_CIF_ISP_LSC_R_TABLE_ADDR); 201 rkisp1_write(params->rkisp1, sram_addr, 202 RKISP1_CIF_ISP_LSC_GR_TABLE_ADDR); 203 rkisp1_write(params->rkisp1, sram_addr, 204 RKISP1_CIF_ISP_LSC_GB_TABLE_ADDR); 205 rkisp1_write(params->rkisp1, sram_addr, 206 RKISP1_CIF_ISP_LSC_B_TABLE_ADDR); 207 208 /* program data tables (table size is 9 * 17 = 153) */ 209 for (i = 0; i < RKISP1_CIF_ISP_LSC_SAMPLES_MAX; i++) { 210 /* 211 * 17 sectors with 2 values in one DWORD = 9 212 * DWORDs (2nd value of last DWORD unused) 213 */ 214 for (j = 0; j < RKISP1_CIF_ISP_LSC_SAMPLES_MAX - 1; j += 2) { 215 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V10(pconfig->r_data_tbl[i][j], 216 pconfig->r_data_tbl[i][j + 1]); 217 rkisp1_write(params->rkisp1, data, 218 RKISP1_CIF_ISP_LSC_R_TABLE_DATA); 219 220 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V10(pconfig->gr_data_tbl[i][j], 221 pconfig->gr_data_tbl[i][j + 1]); 222 rkisp1_write(params->rkisp1, data, 223 RKISP1_CIF_ISP_LSC_GR_TABLE_DATA); 224 225 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V10(pconfig->gb_data_tbl[i][j], 226 pconfig->gb_data_tbl[i][j + 1]); 227 rkisp1_write(params->rkisp1, data, 228 RKISP1_CIF_ISP_LSC_GB_TABLE_DATA); 229 230 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V10(pconfig->b_data_tbl[i][j], 231 pconfig->b_data_tbl[i][j + 1]); 232 rkisp1_write(params->rkisp1, data, 233 RKISP1_CIF_ISP_LSC_B_TABLE_DATA); 234 } 235 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V10(pconfig->r_data_tbl[i][j], 0); 236 rkisp1_write(params->rkisp1, data, 237 RKISP1_CIF_ISP_LSC_R_TABLE_DATA); 238 239 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V10(pconfig->gr_data_tbl[i][j], 0); 240 rkisp1_write(params->rkisp1, data, 241 RKISP1_CIF_ISP_LSC_GR_TABLE_DATA); 242 243 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V10(pconfig->gb_data_tbl[i][j], 0); 244 rkisp1_write(params->rkisp1, data, 245 RKISP1_CIF_ISP_LSC_GB_TABLE_DATA); 246 247 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V10(pconfig->b_data_tbl[i][j], 0); 248 rkisp1_write(params->rkisp1, data, 249 RKISP1_CIF_ISP_LSC_B_TABLE_DATA); 250 } 251 isp_lsc_table_sel = (isp_lsc_status & RKISP1_CIF_ISP_LSC_ACTIVE_TABLE) ? 252 RKISP1_CIF_ISP_LSC_TABLE_0 : 253 RKISP1_CIF_ISP_LSC_TABLE_1; 254 rkisp1_write(params->rkisp1, isp_lsc_table_sel, 255 RKISP1_CIF_ISP_LSC_TABLE_SEL); 256 } 257 258 static void 259 rkisp1_lsc_matrix_config_v12(struct rkisp1_params *params, 260 const struct rkisp1_cif_isp_lsc_config *pconfig) 261 { 262 unsigned int isp_lsc_status, sram_addr, isp_lsc_table_sel, i, j, data; 263 264 isp_lsc_status = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_LSC_STATUS); 265 266 /* RKISP1_CIF_ISP_LSC_TABLE_ADDRESS_153 = ( 17 * 18 ) >> 1 */ 267 sram_addr = (isp_lsc_status & RKISP1_CIF_ISP_LSC_ACTIVE_TABLE) ? 268 RKISP1_CIF_ISP_LSC_TABLE_ADDRESS_0 : 269 RKISP1_CIF_ISP_LSC_TABLE_ADDRESS_153; 270 rkisp1_write(params->rkisp1, sram_addr, RKISP1_CIF_ISP_LSC_R_TABLE_ADDR); 271 rkisp1_write(params->rkisp1, sram_addr, RKISP1_CIF_ISP_LSC_GR_TABLE_ADDR); 272 rkisp1_write(params->rkisp1, sram_addr, RKISP1_CIF_ISP_LSC_GB_TABLE_ADDR); 273 rkisp1_write(params->rkisp1, sram_addr, RKISP1_CIF_ISP_LSC_B_TABLE_ADDR); 274 275 /* program data tables (table size is 9 * 17 = 153) */ 276 for (i = 0; i < RKISP1_CIF_ISP_LSC_SAMPLES_MAX; i++) { 277 /* 278 * 17 sectors with 2 values in one DWORD = 9 279 * DWORDs (2nd value of last DWORD unused) 280 */ 281 for (j = 0; j < RKISP1_CIF_ISP_LSC_SAMPLES_MAX - 1; j += 2) { 282 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V12( 283 pconfig->r_data_tbl[i][j], 284 pconfig->r_data_tbl[i][j + 1]); 285 rkisp1_write(params->rkisp1, data, 286 RKISP1_CIF_ISP_LSC_R_TABLE_DATA); 287 288 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V12( 289 pconfig->gr_data_tbl[i][j], 290 pconfig->gr_data_tbl[i][j + 1]); 291 rkisp1_write(params->rkisp1, data, 292 RKISP1_CIF_ISP_LSC_GR_TABLE_DATA); 293 294 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V12( 295 pconfig->gb_data_tbl[i][j], 296 pconfig->gb_data_tbl[i][j + 1]); 297 rkisp1_write(params->rkisp1, data, 298 RKISP1_CIF_ISP_LSC_GB_TABLE_DATA); 299 300 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V12( 301 pconfig->b_data_tbl[i][j], 302 pconfig->b_data_tbl[i][j + 1]); 303 rkisp1_write(params->rkisp1, data, 304 RKISP1_CIF_ISP_LSC_B_TABLE_DATA); 305 } 306 307 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V12(pconfig->r_data_tbl[i][j], 0); 308 rkisp1_write(params->rkisp1, data, 309 RKISP1_CIF_ISP_LSC_R_TABLE_DATA); 310 311 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V12(pconfig->gr_data_tbl[i][j], 0); 312 rkisp1_write(params->rkisp1, data, 313 RKISP1_CIF_ISP_LSC_GR_TABLE_DATA); 314 315 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V12(pconfig->gb_data_tbl[i][j], 0); 316 rkisp1_write(params->rkisp1, data, 317 RKISP1_CIF_ISP_LSC_GB_TABLE_DATA); 318 319 data = RKISP1_CIF_ISP_LSC_TABLE_DATA_V12(pconfig->b_data_tbl[i][j], 0); 320 rkisp1_write(params->rkisp1, data, 321 RKISP1_CIF_ISP_LSC_B_TABLE_DATA); 322 } 323 isp_lsc_table_sel = (isp_lsc_status & RKISP1_CIF_ISP_LSC_ACTIVE_TABLE) ? 324 RKISP1_CIF_ISP_LSC_TABLE_0 : 325 RKISP1_CIF_ISP_LSC_TABLE_1; 326 rkisp1_write(params->rkisp1, isp_lsc_table_sel, 327 RKISP1_CIF_ISP_LSC_TABLE_SEL); 328 } 329 330 static void rkisp1_lsc_config(struct rkisp1_params *params, 331 const struct rkisp1_cif_isp_lsc_config *arg) 332 { 333 unsigned int i, data; 334 u32 lsc_ctrl; 335 336 /* To config must be off , store the current status firstly */ 337 lsc_ctrl = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_LSC_CTRL); 338 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_LSC_CTRL, 339 RKISP1_CIF_ISP_LSC_CTRL_ENA); 340 params->ops->lsc_matrix_config(params, arg); 341 342 for (i = 0; i < RKISP1_CIF_ISP_LSC_SECTORS_TBL_SIZE / 2; i++) { 343 /* program x size tables */ 344 data = RKISP1_CIF_ISP_LSC_SECT_SIZE(arg->x_size_tbl[i * 2], 345 arg->x_size_tbl[i * 2 + 1]); 346 rkisp1_write(params->rkisp1, data, 347 RKISP1_CIF_ISP_LSC_XSIZE_01 + i * 4); 348 349 /* program x grad tables */ 350 data = RKISP1_CIF_ISP_LSC_SECT_SIZE(arg->x_grad_tbl[i * 2], 351 arg->x_grad_tbl[i * 2 + 1]); 352 rkisp1_write(params->rkisp1, data, 353 RKISP1_CIF_ISP_LSC_XGRAD_01 + i * 4); 354 355 /* program y size tables */ 356 data = RKISP1_CIF_ISP_LSC_SECT_SIZE(arg->y_size_tbl[i * 2], 357 arg->y_size_tbl[i * 2 + 1]); 358 rkisp1_write(params->rkisp1, data, 359 RKISP1_CIF_ISP_LSC_YSIZE_01 + i * 4); 360 361 /* program y grad tables */ 362 data = RKISP1_CIF_ISP_LSC_SECT_SIZE(arg->y_grad_tbl[i * 2], 363 arg->y_grad_tbl[i * 2 + 1]); 364 rkisp1_write(params->rkisp1, data, 365 RKISP1_CIF_ISP_LSC_YGRAD_01 + i * 4); 366 } 367 368 /* restore the lsc ctrl status */ 369 if (lsc_ctrl & RKISP1_CIF_ISP_LSC_CTRL_ENA) { 370 rkisp1_param_set_bits(params, 371 RKISP1_CIF_ISP_LSC_CTRL, 372 RKISP1_CIF_ISP_LSC_CTRL_ENA); 373 } else { 374 rkisp1_param_clear_bits(params, 375 RKISP1_CIF_ISP_LSC_CTRL, 376 RKISP1_CIF_ISP_LSC_CTRL_ENA); 377 } 378 } 379 380 /* ISP Filtering function */ 381 static void rkisp1_flt_config(struct rkisp1_params *params, 382 const struct rkisp1_cif_isp_flt_config *arg) 383 { 384 u32 filt_mode; 385 386 rkisp1_write(params->rkisp1, 387 arg->thresh_bl0, RKISP1_CIF_ISP_FILT_THRESH_BL0); 388 rkisp1_write(params->rkisp1, 389 arg->thresh_bl1, RKISP1_CIF_ISP_FILT_THRESH_BL1); 390 rkisp1_write(params->rkisp1, 391 arg->thresh_sh0, RKISP1_CIF_ISP_FILT_THRESH_SH0); 392 rkisp1_write(params->rkisp1, 393 arg->thresh_sh1, RKISP1_CIF_ISP_FILT_THRESH_SH1); 394 rkisp1_write(params->rkisp1, arg->fac_bl0, RKISP1_CIF_ISP_FILT_FAC_BL0); 395 rkisp1_write(params->rkisp1, arg->fac_bl1, RKISP1_CIF_ISP_FILT_FAC_BL1); 396 rkisp1_write(params->rkisp1, arg->fac_mid, RKISP1_CIF_ISP_FILT_FAC_MID); 397 rkisp1_write(params->rkisp1, arg->fac_sh0, RKISP1_CIF_ISP_FILT_FAC_SH0); 398 rkisp1_write(params->rkisp1, arg->fac_sh1, RKISP1_CIF_ISP_FILT_FAC_SH1); 399 rkisp1_write(params->rkisp1, 400 arg->lum_weight, RKISP1_CIF_ISP_FILT_LUM_WEIGHT); 401 402 rkisp1_write(params->rkisp1, 403 (arg->mode ? RKISP1_CIF_ISP_FLT_MODE_DNR : 0) | 404 RKISP1_CIF_ISP_FLT_CHROMA_V_MODE(arg->chr_v_mode) | 405 RKISP1_CIF_ISP_FLT_CHROMA_H_MODE(arg->chr_h_mode) | 406 RKISP1_CIF_ISP_FLT_GREEN_STAGE1(arg->grn_stage1), 407 RKISP1_CIF_ISP_FILT_MODE); 408 409 /* avoid to override the old enable value */ 410 filt_mode = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_FILT_MODE); 411 filt_mode &= RKISP1_CIF_ISP_FLT_ENA; 412 if (arg->mode) 413 filt_mode |= RKISP1_CIF_ISP_FLT_MODE_DNR; 414 filt_mode |= RKISP1_CIF_ISP_FLT_CHROMA_V_MODE(arg->chr_v_mode) | 415 RKISP1_CIF_ISP_FLT_CHROMA_H_MODE(arg->chr_h_mode) | 416 RKISP1_CIF_ISP_FLT_GREEN_STAGE1(arg->grn_stage1); 417 rkisp1_write(params->rkisp1, filt_mode, RKISP1_CIF_ISP_FILT_MODE); 418 } 419 420 /* ISP demosaic interface function */ 421 static int rkisp1_bdm_config(struct rkisp1_params *params, 422 const struct rkisp1_cif_isp_bdm_config *arg) 423 { 424 u32 bdm_th; 425 426 /* avoid to override the old enable value */ 427 bdm_th = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_DEMOSAIC); 428 bdm_th &= RKISP1_CIF_ISP_DEMOSAIC_BYPASS; 429 bdm_th |= arg->demosaic_th & ~RKISP1_CIF_ISP_DEMOSAIC_BYPASS; 430 /* set demosaic threshold */ 431 rkisp1_write(params->rkisp1, bdm_th, RKISP1_CIF_ISP_DEMOSAIC); 432 return 0; 433 } 434 435 /* ISP GAMMA correction interface function */ 436 static void rkisp1_sdg_config(struct rkisp1_params *params, 437 const struct rkisp1_cif_isp_sdg_config *arg) 438 { 439 unsigned int i; 440 441 rkisp1_write(params->rkisp1, 442 arg->xa_pnts.gamma_dx0, RKISP1_CIF_ISP_GAMMA_DX_LO); 443 rkisp1_write(params->rkisp1, 444 arg->xa_pnts.gamma_dx1, RKISP1_CIF_ISP_GAMMA_DX_HI); 445 446 for (i = 0; i < RKISP1_CIF_ISP_DEGAMMA_CURVE_SIZE; i++) { 447 rkisp1_write(params->rkisp1, arg->curve_r.gamma_y[i], 448 RKISP1_CIF_ISP_GAMMA_R_Y0 + i * 4); 449 rkisp1_write(params->rkisp1, arg->curve_g.gamma_y[i], 450 RKISP1_CIF_ISP_GAMMA_G_Y0 + i * 4); 451 rkisp1_write(params->rkisp1, arg->curve_b.gamma_y[i], 452 RKISP1_CIF_ISP_GAMMA_B_Y0 + i * 4); 453 } 454 } 455 456 /* ISP GAMMA correction interface function */ 457 static void rkisp1_goc_config_v10(struct rkisp1_params *params, 458 const struct rkisp1_cif_isp_goc_config *arg) 459 { 460 unsigned int i; 461 462 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_CTRL, 463 RKISP1_CIF_ISP_CTRL_ISP_GAMMA_OUT_ENA); 464 rkisp1_write(params->rkisp1, arg->mode, RKISP1_CIF_ISP_GAMMA_OUT_MODE_V10); 465 466 for (i = 0; i < RKISP1_CIF_ISP_GAMMA_OUT_MAX_SAMPLES_V10; i++) 467 rkisp1_write(params->rkisp1, arg->gamma_y[i], 468 RKISP1_CIF_ISP_GAMMA_OUT_Y_0_V10 + i * 4); 469 } 470 471 static void rkisp1_goc_config_v12(struct rkisp1_params *params, 472 const struct rkisp1_cif_isp_goc_config *arg) 473 { 474 unsigned int i; 475 u32 value; 476 477 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_CTRL, 478 RKISP1_CIF_ISP_CTRL_ISP_GAMMA_OUT_ENA); 479 rkisp1_write(params->rkisp1, arg->mode, RKISP1_CIF_ISP_GAMMA_OUT_MODE_V12); 480 481 for (i = 0; i < RKISP1_CIF_ISP_GAMMA_OUT_MAX_SAMPLES_V12 / 2; i++) { 482 value = RKISP1_CIF_ISP_GAMMA_VALUE_V12( 483 arg->gamma_y[2 * i + 1], 484 arg->gamma_y[2 * i]); 485 rkisp1_write(params->rkisp1, value, 486 RKISP1_CIF_ISP_GAMMA_OUT_Y_0_V12 + i * 4); 487 } 488 } 489 490 /* ISP Cross Talk */ 491 static void rkisp1_ctk_config(struct rkisp1_params *params, 492 const struct rkisp1_cif_isp_ctk_config *arg) 493 { 494 unsigned int i, j, k = 0; 495 496 for (i = 0; i < 3; i++) 497 for (j = 0; j < 3; j++) 498 rkisp1_write(params->rkisp1, arg->coeff[i][j], 499 RKISP1_CIF_ISP_CT_COEFF_0 + 4 * k++); 500 for (i = 0; i < 3; i++) 501 rkisp1_write(params->rkisp1, arg->ct_offset[i], 502 RKISP1_CIF_ISP_CT_OFFSET_R + i * 4); 503 } 504 505 static void rkisp1_ctk_enable(struct rkisp1_params *params, bool en) 506 { 507 if (en) 508 return; 509 510 /* Write back the default values. */ 511 rkisp1_write(params->rkisp1, 0x80, RKISP1_CIF_ISP_CT_COEFF_0); 512 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_COEFF_1); 513 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_COEFF_2); 514 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_COEFF_3); 515 rkisp1_write(params->rkisp1, 0x80, RKISP1_CIF_ISP_CT_COEFF_4); 516 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_COEFF_5); 517 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_COEFF_6); 518 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_COEFF_7); 519 rkisp1_write(params->rkisp1, 0x80, RKISP1_CIF_ISP_CT_COEFF_8); 520 521 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_OFFSET_R); 522 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_OFFSET_G); 523 rkisp1_write(params->rkisp1, 0, RKISP1_CIF_ISP_CT_OFFSET_B); 524 } 525 526 /* ISP White Balance Mode */ 527 static void rkisp1_awb_meas_config_v10(struct rkisp1_params *params, 528 const struct rkisp1_cif_isp_awb_meas_config *arg) 529 { 530 u32 reg_val = 0; 531 /* based on the mode,configure the awb module */ 532 if (arg->awb_mode == RKISP1_CIF_ISP_AWB_MODE_YCBCR) { 533 /* Reference Cb and Cr */ 534 rkisp1_write(params->rkisp1, 535 RKISP1_CIF_ISP_AWB_REF_CR_SET(arg->awb_ref_cr) | 536 arg->awb_ref_cb, RKISP1_CIF_ISP_AWB_REF_V10); 537 /* Yc Threshold */ 538 rkisp1_write(params->rkisp1, 539 RKISP1_CIF_ISP_AWB_MAX_Y_SET(arg->max_y) | 540 RKISP1_CIF_ISP_AWB_MIN_Y_SET(arg->min_y) | 541 RKISP1_CIF_ISP_AWB_MAX_CS_SET(arg->max_csum) | 542 arg->min_c, RKISP1_CIF_ISP_AWB_THRESH_V10); 543 } 544 545 reg_val = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_AWB_PROP_V10); 546 if (arg->enable_ymax_cmp) 547 reg_val |= RKISP1_CIF_ISP_AWB_YMAX_CMP_EN; 548 else 549 reg_val &= ~RKISP1_CIF_ISP_AWB_YMAX_CMP_EN; 550 rkisp1_write(params->rkisp1, reg_val, RKISP1_CIF_ISP_AWB_PROP_V10); 551 552 /* window offset */ 553 rkisp1_write(params->rkisp1, 554 arg->awb_wnd.v_offs, RKISP1_CIF_ISP_AWB_WND_V_OFFS_V10); 555 rkisp1_write(params->rkisp1, 556 arg->awb_wnd.h_offs, RKISP1_CIF_ISP_AWB_WND_H_OFFS_V10); 557 /* AWB window size */ 558 rkisp1_write(params->rkisp1, 559 arg->awb_wnd.v_size, RKISP1_CIF_ISP_AWB_WND_V_SIZE_V10); 560 rkisp1_write(params->rkisp1, 561 arg->awb_wnd.h_size, RKISP1_CIF_ISP_AWB_WND_H_SIZE_V10); 562 /* Number of frames */ 563 rkisp1_write(params->rkisp1, 564 arg->frames, RKISP1_CIF_ISP_AWB_FRAMES_V10); 565 } 566 567 static void rkisp1_awb_meas_config_v12(struct rkisp1_params *params, 568 const struct rkisp1_cif_isp_awb_meas_config *arg) 569 { 570 u32 reg_val = 0; 571 /* based on the mode,configure the awb module */ 572 if (arg->awb_mode == RKISP1_CIF_ISP_AWB_MODE_YCBCR) { 573 /* Reference Cb and Cr */ 574 rkisp1_write(params->rkisp1, 575 RKISP1_CIF_ISP_AWB_REF_CR_SET(arg->awb_ref_cr) | 576 arg->awb_ref_cb, RKISP1_CIF_ISP_AWB_REF_V12); 577 /* Yc Threshold */ 578 rkisp1_write(params->rkisp1, 579 RKISP1_CIF_ISP_AWB_MAX_Y_SET(arg->max_y) | 580 RKISP1_CIF_ISP_AWB_MIN_Y_SET(arg->min_y) | 581 RKISP1_CIF_ISP_AWB_MAX_CS_SET(arg->max_csum) | 582 arg->min_c, RKISP1_CIF_ISP_AWB_THRESH_V12); 583 } 584 585 reg_val = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_AWB_PROP_V12); 586 if (arg->enable_ymax_cmp) 587 reg_val |= RKISP1_CIF_ISP_AWB_YMAX_CMP_EN; 588 else 589 reg_val &= ~RKISP1_CIF_ISP_AWB_YMAX_CMP_EN; 590 reg_val &= ~RKISP1_CIF_ISP_AWB_SET_FRAMES_MASK_V12; 591 reg_val |= RKISP1_CIF_ISP_AWB_SET_FRAMES_V12(arg->frames); 592 rkisp1_write(params->rkisp1, reg_val, RKISP1_CIF_ISP_AWB_PROP_V12); 593 594 /* window offset */ 595 rkisp1_write(params->rkisp1, 596 arg->awb_wnd.v_offs << 16 | 597 arg->awb_wnd.h_offs, 598 RKISP1_CIF_ISP_AWB_OFFS_V12); 599 /* AWB window size */ 600 rkisp1_write(params->rkisp1, 601 arg->awb_wnd.v_size << 16 | 602 arg->awb_wnd.h_size, 603 RKISP1_CIF_ISP_AWB_SIZE_V12); 604 } 605 606 static void 607 rkisp1_awb_meas_enable_v10(struct rkisp1_params *params, 608 const struct rkisp1_cif_isp_awb_meas_config *arg, 609 bool en) 610 { 611 u32 reg_val = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_AWB_PROP_V10); 612 613 /* switch off */ 614 reg_val &= RKISP1_CIF_ISP_AWB_MODE_MASK_NONE; 615 616 if (en) { 617 if (arg->awb_mode == RKISP1_CIF_ISP_AWB_MODE_RGB) 618 reg_val |= RKISP1_CIF_ISP_AWB_MODE_RGB_EN; 619 else 620 reg_val |= RKISP1_CIF_ISP_AWB_MODE_YCBCR_EN; 621 622 rkisp1_write(params->rkisp1, reg_val, RKISP1_CIF_ISP_AWB_PROP_V10); 623 624 /* Measurements require AWB block be active. */ 625 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_CTRL, 626 RKISP1_CIF_ISP_CTRL_ISP_AWB_ENA); 627 } else { 628 rkisp1_write(params->rkisp1, 629 reg_val, RKISP1_CIF_ISP_AWB_PROP_V10); 630 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_CTRL, 631 RKISP1_CIF_ISP_CTRL_ISP_AWB_ENA); 632 } 633 } 634 635 static void 636 rkisp1_awb_meas_enable_v12(struct rkisp1_params *params, 637 const struct rkisp1_cif_isp_awb_meas_config *arg, 638 bool en) 639 { 640 u32 reg_val = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_AWB_PROP_V12); 641 642 /* switch off */ 643 reg_val &= RKISP1_CIF_ISP_AWB_MODE_MASK_NONE; 644 645 if (en) { 646 if (arg->awb_mode == RKISP1_CIF_ISP_AWB_MODE_RGB) 647 reg_val |= RKISP1_CIF_ISP_AWB_MODE_RGB_EN; 648 else 649 reg_val |= RKISP1_CIF_ISP_AWB_MODE_YCBCR_EN; 650 651 rkisp1_write(params->rkisp1, reg_val, RKISP1_CIF_ISP_AWB_PROP_V12); 652 653 /* Measurements require AWB block be active. */ 654 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_CTRL, 655 RKISP1_CIF_ISP_CTRL_ISP_AWB_ENA); 656 } else { 657 rkisp1_write(params->rkisp1, 658 reg_val, RKISP1_CIF_ISP_AWB_PROP_V12); 659 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_CTRL, 660 RKISP1_CIF_ISP_CTRL_ISP_AWB_ENA); 661 } 662 } 663 664 static void 665 rkisp1_awb_gain_config_v10(struct rkisp1_params *params, 666 const struct rkisp1_cif_isp_awb_gain_config *arg) 667 { 668 rkisp1_write(params->rkisp1, 669 RKISP1_CIF_ISP_AWB_GAIN_R_SET(arg->gain_green_r) | 670 arg->gain_green_b, RKISP1_CIF_ISP_AWB_GAIN_G_V10); 671 672 rkisp1_write(params->rkisp1, 673 RKISP1_CIF_ISP_AWB_GAIN_R_SET(arg->gain_red) | 674 arg->gain_blue, RKISP1_CIF_ISP_AWB_GAIN_RB_V10); 675 } 676 677 static void 678 rkisp1_awb_gain_config_v12(struct rkisp1_params *params, 679 const struct rkisp1_cif_isp_awb_gain_config *arg) 680 { 681 rkisp1_write(params->rkisp1, 682 RKISP1_CIF_ISP_AWB_GAIN_R_SET(arg->gain_green_r) | 683 arg->gain_green_b, RKISP1_CIF_ISP_AWB_GAIN_G_V12); 684 685 rkisp1_write(params->rkisp1, 686 RKISP1_CIF_ISP_AWB_GAIN_R_SET(arg->gain_red) | 687 arg->gain_blue, RKISP1_CIF_ISP_AWB_GAIN_RB_V12); 688 } 689 690 static void rkisp1_aec_config_v10(struct rkisp1_params *params, 691 const struct rkisp1_cif_isp_aec_config *arg) 692 { 693 unsigned int block_hsize, block_vsize; 694 u32 exp_ctrl; 695 696 /* avoid to override the old enable value */ 697 exp_ctrl = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_EXP_CTRL); 698 exp_ctrl &= RKISP1_CIF_ISP_EXP_ENA; 699 if (arg->autostop) 700 exp_ctrl |= RKISP1_CIF_ISP_EXP_CTRL_AUTOSTOP; 701 if (arg->mode == RKISP1_CIF_ISP_EXP_MEASURING_MODE_1) 702 exp_ctrl |= RKISP1_CIF_ISP_EXP_CTRL_MEASMODE_1; 703 rkisp1_write(params->rkisp1, exp_ctrl, RKISP1_CIF_ISP_EXP_CTRL); 704 705 rkisp1_write(params->rkisp1, 706 arg->meas_window.h_offs, RKISP1_CIF_ISP_EXP_H_OFFSET_V10); 707 rkisp1_write(params->rkisp1, 708 arg->meas_window.v_offs, RKISP1_CIF_ISP_EXP_V_OFFSET_V10); 709 710 block_hsize = arg->meas_window.h_size / 711 RKISP1_CIF_ISP_EXP_COLUMN_NUM_V10 - 1; 712 block_vsize = arg->meas_window.v_size / 713 RKISP1_CIF_ISP_EXP_ROW_NUM_V10 - 1; 714 715 rkisp1_write(params->rkisp1, 716 RKISP1_CIF_ISP_EXP_H_SIZE_SET_V10(block_hsize), 717 RKISP1_CIF_ISP_EXP_H_SIZE_V10); 718 rkisp1_write(params->rkisp1, 719 RKISP1_CIF_ISP_EXP_V_SIZE_SET_V10(block_vsize), 720 RKISP1_CIF_ISP_EXP_V_SIZE_V10); 721 } 722 723 static void rkisp1_aec_config_v12(struct rkisp1_params *params, 724 const struct rkisp1_cif_isp_aec_config *arg) 725 { 726 u32 exp_ctrl; 727 u32 block_hsize, block_vsize; 728 u32 wnd_num_idx = 1; 729 const u32 ae_wnd_num[] = { 5, 9, 15, 15 }; 730 731 /* avoid to override the old enable value */ 732 exp_ctrl = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_EXP_CTRL); 733 exp_ctrl &= RKISP1_CIF_ISP_EXP_ENA; 734 if (arg->autostop) 735 exp_ctrl |= RKISP1_CIF_ISP_EXP_CTRL_AUTOSTOP; 736 if (arg->mode == RKISP1_CIF_ISP_EXP_MEASURING_MODE_1) 737 exp_ctrl |= RKISP1_CIF_ISP_EXP_CTRL_MEASMODE_1; 738 exp_ctrl |= RKISP1_CIF_ISP_EXP_CTRL_WNDNUM_SET_V12(wnd_num_idx); 739 rkisp1_write(params->rkisp1, exp_ctrl, RKISP1_CIF_ISP_EXP_CTRL); 740 741 rkisp1_write(params->rkisp1, 742 RKISP1_CIF_ISP_EXP_V_OFFSET_SET_V12(arg->meas_window.v_offs) | 743 RKISP1_CIF_ISP_EXP_H_OFFSET_SET_V12(arg->meas_window.h_offs), 744 RKISP1_CIF_ISP_EXP_OFFS_V12); 745 746 block_hsize = arg->meas_window.h_size / ae_wnd_num[wnd_num_idx] - 1; 747 block_vsize = arg->meas_window.v_size / ae_wnd_num[wnd_num_idx] - 1; 748 749 rkisp1_write(params->rkisp1, 750 RKISP1_CIF_ISP_EXP_V_SIZE_SET_V12(block_vsize) | 751 RKISP1_CIF_ISP_EXP_H_SIZE_SET_V12(block_hsize), 752 RKISP1_CIF_ISP_EXP_SIZE_V12); 753 } 754 755 static void rkisp1_cproc_config(struct rkisp1_params *params, 756 const struct rkisp1_cif_isp_cproc_config *arg) 757 { 758 struct rkisp1_cif_isp_isp_other_cfg *cur_other_cfg = 759 container_of(arg, struct rkisp1_cif_isp_isp_other_cfg, cproc_config); 760 struct rkisp1_cif_isp_ie_config *cur_ie_config = 761 &cur_other_cfg->ie_config; 762 u32 effect = cur_ie_config->effect; 763 u32 quantization = params->quantization; 764 765 rkisp1_write(params->rkisp1, arg->contrast, RKISP1_CIF_C_PROC_CONTRAST); 766 rkisp1_write(params->rkisp1, arg->hue, RKISP1_CIF_C_PROC_HUE); 767 rkisp1_write(params->rkisp1, arg->sat, RKISP1_CIF_C_PROC_SATURATION); 768 rkisp1_write(params->rkisp1, arg->brightness, 769 RKISP1_CIF_C_PROC_BRIGHTNESS); 770 771 if (quantization != V4L2_QUANTIZATION_FULL_RANGE || 772 effect != V4L2_COLORFX_NONE) { 773 rkisp1_param_clear_bits(params, RKISP1_CIF_C_PROC_CTRL, 774 RKISP1_CIF_C_PROC_YOUT_FULL | 775 RKISP1_CIF_C_PROC_YIN_FULL | 776 RKISP1_CIF_C_PROC_COUT_FULL); 777 } else { 778 rkisp1_param_set_bits(params, RKISP1_CIF_C_PROC_CTRL, 779 RKISP1_CIF_C_PROC_YOUT_FULL | 780 RKISP1_CIF_C_PROC_YIN_FULL | 781 RKISP1_CIF_C_PROC_COUT_FULL); 782 } 783 } 784 785 static void rkisp1_hst_config_v10(struct rkisp1_params *params, 786 const struct rkisp1_cif_isp_hst_config *arg) 787 { 788 unsigned int block_hsize, block_vsize; 789 static const u32 hist_weight_regs[] = { 790 RKISP1_CIF_ISP_HIST_WEIGHT_00TO30_V10, 791 RKISP1_CIF_ISP_HIST_WEIGHT_40TO21_V10, 792 RKISP1_CIF_ISP_HIST_WEIGHT_31TO12_V10, 793 RKISP1_CIF_ISP_HIST_WEIGHT_22TO03_V10, 794 RKISP1_CIF_ISP_HIST_WEIGHT_13TO43_V10, 795 RKISP1_CIF_ISP_HIST_WEIGHT_04TO34_V10, 796 }; 797 const u8 *weight; 798 unsigned int i; 799 u32 hist_prop; 800 801 /* avoid to override the old enable value */ 802 hist_prop = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_HIST_PROP_V10); 803 hist_prop &= RKISP1_CIF_ISP_HIST_PROP_MODE_MASK_V10; 804 hist_prop |= RKISP1_CIF_ISP_HIST_PREDIV_SET_V10(arg->histogram_predivider); 805 rkisp1_write(params->rkisp1, hist_prop, RKISP1_CIF_ISP_HIST_PROP_V10); 806 rkisp1_write(params->rkisp1, 807 arg->meas_window.h_offs, 808 RKISP1_CIF_ISP_HIST_H_OFFS_V10); 809 rkisp1_write(params->rkisp1, 810 arg->meas_window.v_offs, 811 RKISP1_CIF_ISP_HIST_V_OFFS_V10); 812 813 block_hsize = arg->meas_window.h_size / 814 RKISP1_CIF_ISP_HIST_COLUMN_NUM_V10 - 1; 815 block_vsize = arg->meas_window.v_size / RKISP1_CIF_ISP_HIST_ROW_NUM_V10 - 1; 816 817 rkisp1_write(params->rkisp1, block_hsize, RKISP1_CIF_ISP_HIST_H_SIZE_V10); 818 rkisp1_write(params->rkisp1, block_vsize, RKISP1_CIF_ISP_HIST_V_SIZE_V10); 819 820 weight = arg->hist_weight; 821 for (i = 0; i < ARRAY_SIZE(hist_weight_regs); ++i, weight += 4) 822 rkisp1_write(params->rkisp1, 823 RKISP1_CIF_ISP_HIST_WEIGHT_SET_V10(weight[0], 824 weight[1], 825 weight[2], 826 weight[3]), 827 hist_weight_regs[i]); 828 829 rkisp1_write(params->rkisp1, weight[0] & 0x1F, RKISP1_CIF_ISP_HIST_WEIGHT_44_V10); 830 } 831 832 static void rkisp1_hst_config_v12(struct rkisp1_params *params, 833 const struct rkisp1_cif_isp_hst_config *arg) 834 { 835 unsigned int i, j; 836 u32 block_hsize, block_vsize; 837 u32 wnd_num_idx, hist_weight_num, hist_ctrl, value; 838 u8 weight15x15[RKISP1_CIF_ISP_HIST_WEIGHT_REG_SIZE_V12]; 839 const u32 hist_wnd_num[] = { 5, 9, 15, 15 }; 840 841 /* now we just support 9x9 window */ 842 wnd_num_idx = 1; 843 memset(weight15x15, 0x00, sizeof(weight15x15)); 844 /* avoid to override the old enable value */ 845 hist_ctrl = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_HIST_CTRL_V12); 846 hist_ctrl &= RKISP1_CIF_ISP_HIST_CTRL_MODE_MASK_V12 | 847 RKISP1_CIF_ISP_HIST_CTRL_EN_MASK_V12; 848 hist_ctrl = hist_ctrl | 849 RKISP1_CIF_ISP_HIST_CTRL_INTRSEL_SET_V12(1) | 850 RKISP1_CIF_ISP_HIST_CTRL_DATASEL_SET_V12(0) | 851 RKISP1_CIF_ISP_HIST_CTRL_WATERLINE_SET_V12(0) | 852 RKISP1_CIF_ISP_HIST_CTRL_AUTOSTOP_SET_V12(0) | 853 RKISP1_CIF_ISP_HIST_CTRL_WNDNUM_SET_V12(1) | 854 RKISP1_CIF_ISP_HIST_CTRL_STEPSIZE_SET_V12(arg->histogram_predivider); 855 rkisp1_write(params->rkisp1, hist_ctrl, RKISP1_CIF_ISP_HIST_CTRL_V12); 856 857 rkisp1_write(params->rkisp1, 858 RKISP1_CIF_ISP_HIST_OFFS_SET_V12(arg->meas_window.h_offs, 859 arg->meas_window.v_offs), 860 RKISP1_CIF_ISP_HIST_OFFS_V12); 861 862 block_hsize = arg->meas_window.h_size / hist_wnd_num[wnd_num_idx] - 1; 863 block_vsize = arg->meas_window.v_size / hist_wnd_num[wnd_num_idx] - 1; 864 rkisp1_write(params->rkisp1, 865 RKISP1_CIF_ISP_HIST_SIZE_SET_V12(block_hsize, block_vsize), 866 RKISP1_CIF_ISP_HIST_SIZE_V12); 867 868 for (i = 0; i < hist_wnd_num[wnd_num_idx]; i++) { 869 for (j = 0; j < hist_wnd_num[wnd_num_idx]; j++) { 870 weight15x15[i * RKISP1_CIF_ISP_HIST_ROW_NUM_V12 + j] = 871 arg->hist_weight[i * hist_wnd_num[wnd_num_idx] + j]; 872 } 873 } 874 875 hist_weight_num = RKISP1_CIF_ISP_HIST_WEIGHT_REG_SIZE_V12; 876 for (i = 0; i < (hist_weight_num / 4); i++) { 877 value = RKISP1_CIF_ISP_HIST_WEIGHT_SET_V12( 878 weight15x15[4 * i + 0], 879 weight15x15[4 * i + 1], 880 weight15x15[4 * i + 2], 881 weight15x15[4 * i + 3]); 882 rkisp1_write(params->rkisp1, value, 883 RKISP1_CIF_ISP_HIST_WEIGHT_V12 + 4 * i); 884 } 885 value = RKISP1_CIF_ISP_HIST_WEIGHT_SET_V12(weight15x15[4 * i + 0], 0, 0, 0); 886 rkisp1_write(params->rkisp1, value, 887 RKISP1_CIF_ISP_HIST_WEIGHT_V12 + 4 * i); 888 } 889 890 static void 891 rkisp1_hst_enable_v10(struct rkisp1_params *params, 892 const struct rkisp1_cif_isp_hst_config *arg, bool en) 893 { 894 if (en) { 895 u32 hist_prop = rkisp1_read(params->rkisp1, 896 RKISP1_CIF_ISP_HIST_PROP_V10); 897 898 hist_prop &= ~RKISP1_CIF_ISP_HIST_PROP_MODE_MASK_V10; 899 hist_prop |= arg->mode; 900 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_HIST_PROP_V10, 901 hist_prop); 902 } else { 903 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_HIST_PROP_V10, 904 RKISP1_CIF_ISP_HIST_PROP_MODE_MASK_V10); 905 } 906 } 907 908 static void 909 rkisp1_hst_enable_v12(struct rkisp1_params *params, 910 const struct rkisp1_cif_isp_hst_config *arg, bool en) 911 { 912 if (en) { 913 u32 hist_ctrl = rkisp1_read(params->rkisp1, 914 RKISP1_CIF_ISP_HIST_CTRL_V12); 915 916 hist_ctrl &= ~RKISP1_CIF_ISP_HIST_CTRL_MODE_MASK_V12; 917 hist_ctrl |= RKISP1_CIF_ISP_HIST_CTRL_MODE_SET_V12(arg->mode); 918 hist_ctrl |= RKISP1_CIF_ISP_HIST_CTRL_EN_SET_V12(1); 919 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_HIST_CTRL_V12, 920 hist_ctrl); 921 } else { 922 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_HIST_CTRL_V12, 923 RKISP1_CIF_ISP_HIST_CTRL_MODE_MASK_V12 | 924 RKISP1_CIF_ISP_HIST_CTRL_EN_MASK_V12); 925 } 926 } 927 928 static void rkisp1_afm_config_v10(struct rkisp1_params *params, 929 const struct rkisp1_cif_isp_afc_config *arg) 930 { 931 size_t num_of_win = min_t(size_t, ARRAY_SIZE(arg->afm_win), 932 arg->num_afm_win); 933 u32 afm_ctrl = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_AFM_CTRL); 934 unsigned int i; 935 936 /* Switch off to configure. */ 937 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_AFM_CTRL, 938 RKISP1_CIF_ISP_AFM_ENA); 939 940 for (i = 0; i < num_of_win; i++) { 941 rkisp1_write(params->rkisp1, 942 RKISP1_CIF_ISP_AFM_WINDOW_X(arg->afm_win[i].h_offs) | 943 RKISP1_CIF_ISP_AFM_WINDOW_Y(arg->afm_win[i].v_offs), 944 RKISP1_CIF_ISP_AFM_LT_A + i * 8); 945 rkisp1_write(params->rkisp1, 946 RKISP1_CIF_ISP_AFM_WINDOW_X(arg->afm_win[i].h_size + 947 arg->afm_win[i].h_offs) | 948 RKISP1_CIF_ISP_AFM_WINDOW_Y(arg->afm_win[i].v_size + 949 arg->afm_win[i].v_offs), 950 RKISP1_CIF_ISP_AFM_RB_A + i * 8); 951 } 952 rkisp1_write(params->rkisp1, arg->thres, RKISP1_CIF_ISP_AFM_THRES); 953 rkisp1_write(params->rkisp1, arg->var_shift, 954 RKISP1_CIF_ISP_AFM_VAR_SHIFT); 955 /* restore afm status */ 956 rkisp1_write(params->rkisp1, afm_ctrl, RKISP1_CIF_ISP_AFM_CTRL); 957 } 958 959 static void rkisp1_afm_config_v12(struct rkisp1_params *params, 960 const struct rkisp1_cif_isp_afc_config *arg) 961 { 962 size_t num_of_win = min_t(size_t, ARRAY_SIZE(arg->afm_win), 963 arg->num_afm_win); 964 u32 afm_ctrl = rkisp1_read(params->rkisp1, RKISP1_CIF_ISP_AFM_CTRL); 965 u32 lum_var_shift, afm_var_shift; 966 unsigned int i; 967 968 /* Switch off to configure. */ 969 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_AFM_CTRL, 970 RKISP1_CIF_ISP_AFM_ENA); 971 972 for (i = 0; i < num_of_win; i++) { 973 rkisp1_write(params->rkisp1, 974 RKISP1_CIF_ISP_AFM_WINDOW_X(arg->afm_win[i].h_offs) | 975 RKISP1_CIF_ISP_AFM_WINDOW_Y(arg->afm_win[i].v_offs), 976 RKISP1_CIF_ISP_AFM_LT_A + i * 8); 977 rkisp1_write(params->rkisp1, 978 RKISP1_CIF_ISP_AFM_WINDOW_X(arg->afm_win[i].h_size + 979 arg->afm_win[i].h_offs) | 980 RKISP1_CIF_ISP_AFM_WINDOW_Y(arg->afm_win[i].v_size + 981 arg->afm_win[i].v_offs), 982 RKISP1_CIF_ISP_AFM_RB_A + i * 8); 983 } 984 rkisp1_write(params->rkisp1, arg->thres, RKISP1_CIF_ISP_AFM_THRES); 985 986 lum_var_shift = RKISP1_CIF_ISP_AFM_GET_LUM_SHIFT_a_V12(arg->var_shift); 987 afm_var_shift = RKISP1_CIF_ISP_AFM_GET_AFM_SHIFT_a_V12(arg->var_shift); 988 rkisp1_write(params->rkisp1, 989 RKISP1_CIF_ISP_AFM_SET_SHIFT_a_V12(lum_var_shift, afm_var_shift) | 990 RKISP1_CIF_ISP_AFM_SET_SHIFT_b_V12(lum_var_shift, afm_var_shift) | 991 RKISP1_CIF_ISP_AFM_SET_SHIFT_c_V12(lum_var_shift, afm_var_shift), 992 RKISP1_CIF_ISP_AFM_VAR_SHIFT); 993 994 /* restore afm status */ 995 rkisp1_write(params->rkisp1, afm_ctrl, RKISP1_CIF_ISP_AFM_CTRL); 996 } 997 998 static void rkisp1_ie_config(struct rkisp1_params *params, 999 const struct rkisp1_cif_isp_ie_config *arg) 1000 { 1001 u32 eff_ctrl; 1002 1003 eff_ctrl = rkisp1_read(params->rkisp1, RKISP1_CIF_IMG_EFF_CTRL); 1004 eff_ctrl &= ~RKISP1_CIF_IMG_EFF_CTRL_MODE_MASK; 1005 1006 if (params->quantization == V4L2_QUANTIZATION_FULL_RANGE) 1007 eff_ctrl |= RKISP1_CIF_IMG_EFF_CTRL_YCBCR_FULL; 1008 1009 switch (arg->effect) { 1010 case V4L2_COLORFX_SEPIA: 1011 eff_ctrl |= RKISP1_CIF_IMG_EFF_CTRL_MODE_SEPIA; 1012 break; 1013 case V4L2_COLORFX_SET_CBCR: 1014 rkisp1_write(params->rkisp1, arg->eff_tint, 1015 RKISP1_CIF_IMG_EFF_TINT); 1016 eff_ctrl |= RKISP1_CIF_IMG_EFF_CTRL_MODE_SEPIA; 1017 break; 1018 /* 1019 * Color selection is similar to water color(AQUA): 1020 * grayscale + selected color w threshold 1021 */ 1022 case V4L2_COLORFX_AQUA: 1023 eff_ctrl |= RKISP1_CIF_IMG_EFF_CTRL_MODE_COLOR_SEL; 1024 rkisp1_write(params->rkisp1, arg->color_sel, 1025 RKISP1_CIF_IMG_EFF_COLOR_SEL); 1026 break; 1027 case V4L2_COLORFX_EMBOSS: 1028 eff_ctrl |= RKISP1_CIF_IMG_EFF_CTRL_MODE_EMBOSS; 1029 rkisp1_write(params->rkisp1, arg->eff_mat_1, 1030 RKISP1_CIF_IMG_EFF_MAT_1); 1031 rkisp1_write(params->rkisp1, arg->eff_mat_2, 1032 RKISP1_CIF_IMG_EFF_MAT_2); 1033 rkisp1_write(params->rkisp1, arg->eff_mat_3, 1034 RKISP1_CIF_IMG_EFF_MAT_3); 1035 break; 1036 case V4L2_COLORFX_SKETCH: 1037 eff_ctrl |= RKISP1_CIF_IMG_EFF_CTRL_MODE_SKETCH; 1038 rkisp1_write(params->rkisp1, arg->eff_mat_3, 1039 RKISP1_CIF_IMG_EFF_MAT_3); 1040 rkisp1_write(params->rkisp1, arg->eff_mat_4, 1041 RKISP1_CIF_IMG_EFF_MAT_4); 1042 rkisp1_write(params->rkisp1, arg->eff_mat_5, 1043 RKISP1_CIF_IMG_EFF_MAT_5); 1044 break; 1045 case V4L2_COLORFX_BW: 1046 eff_ctrl |= RKISP1_CIF_IMG_EFF_CTRL_MODE_BLACKWHITE; 1047 break; 1048 case V4L2_COLORFX_NEGATIVE: 1049 eff_ctrl |= RKISP1_CIF_IMG_EFF_CTRL_MODE_NEGATIVE; 1050 break; 1051 default: 1052 break; 1053 } 1054 1055 rkisp1_write(params->rkisp1, eff_ctrl, RKISP1_CIF_IMG_EFF_CTRL); 1056 } 1057 1058 static void rkisp1_ie_enable(struct rkisp1_params *params, bool en) 1059 { 1060 if (en) { 1061 rkisp1_param_set_bits(params, RKISP1_CIF_VI_ICCL, 1062 RKISP1_CIF_VI_ICCL_IE_CLK); 1063 rkisp1_write(params->rkisp1, RKISP1_CIF_IMG_EFF_CTRL_ENABLE, 1064 RKISP1_CIF_IMG_EFF_CTRL); 1065 rkisp1_param_set_bits(params, RKISP1_CIF_IMG_EFF_CTRL, 1066 RKISP1_CIF_IMG_EFF_CTRL_CFG_UPD); 1067 } else { 1068 rkisp1_param_clear_bits(params, RKISP1_CIF_IMG_EFF_CTRL, 1069 RKISP1_CIF_IMG_EFF_CTRL_ENABLE); 1070 rkisp1_param_clear_bits(params, RKISP1_CIF_VI_ICCL, 1071 RKISP1_CIF_VI_ICCL_IE_CLK); 1072 } 1073 } 1074 1075 static void rkisp1_csm_config(struct rkisp1_params *params, bool full_range) 1076 { 1077 static const u16 full_range_coeff[] = { 1078 0x0026, 0x004b, 0x000f, 1079 0x01ea, 0x01d6, 0x0040, 1080 0x0040, 0x01ca, 0x01f6 1081 }; 1082 static const u16 limited_range_coeff[] = { 1083 0x0021, 0x0040, 0x000d, 1084 0x01ed, 0x01db, 0x0038, 1085 0x0038, 0x01d1, 0x01f7, 1086 }; 1087 unsigned int i; 1088 1089 if (full_range) { 1090 for (i = 0; i < ARRAY_SIZE(full_range_coeff); i++) 1091 rkisp1_write(params->rkisp1, full_range_coeff[i], 1092 RKISP1_CIF_ISP_CC_COEFF_0 + i * 4); 1093 1094 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_CTRL, 1095 RKISP1_CIF_ISP_CTRL_ISP_CSM_Y_FULL_ENA | 1096 RKISP1_CIF_ISP_CTRL_ISP_CSM_C_FULL_ENA); 1097 } else { 1098 for (i = 0; i < ARRAY_SIZE(limited_range_coeff); i++) 1099 rkisp1_write(params->rkisp1, limited_range_coeff[i], 1100 RKISP1_CIF_ISP_CC_COEFF_0 + i * 4); 1101 1102 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_CTRL, 1103 RKISP1_CIF_ISP_CTRL_ISP_CSM_Y_FULL_ENA | 1104 RKISP1_CIF_ISP_CTRL_ISP_CSM_C_FULL_ENA); 1105 } 1106 } 1107 1108 /* ISP De-noise Pre-Filter(DPF) function */ 1109 static void rkisp1_dpf_config(struct rkisp1_params *params, 1110 const struct rkisp1_cif_isp_dpf_config *arg) 1111 { 1112 unsigned int isp_dpf_mode, spatial_coeff, i; 1113 1114 switch (arg->gain.mode) { 1115 case RKISP1_CIF_ISP_DPF_GAIN_USAGE_NF_GAINS: 1116 isp_dpf_mode = RKISP1_CIF_ISP_DPF_MODE_USE_NF_GAIN | 1117 RKISP1_CIF_ISP_DPF_MODE_AWB_GAIN_COMP; 1118 break; 1119 case RKISP1_CIF_ISP_DPF_GAIN_USAGE_LSC_GAINS: 1120 isp_dpf_mode = RKISP1_CIF_ISP_DPF_MODE_LSC_GAIN_COMP; 1121 break; 1122 case RKISP1_CIF_ISP_DPF_GAIN_USAGE_NF_LSC_GAINS: 1123 isp_dpf_mode = RKISP1_CIF_ISP_DPF_MODE_USE_NF_GAIN | 1124 RKISP1_CIF_ISP_DPF_MODE_AWB_GAIN_COMP | 1125 RKISP1_CIF_ISP_DPF_MODE_LSC_GAIN_COMP; 1126 break; 1127 case RKISP1_CIF_ISP_DPF_GAIN_USAGE_AWB_GAINS: 1128 isp_dpf_mode = RKISP1_CIF_ISP_DPF_MODE_AWB_GAIN_COMP; 1129 break; 1130 case RKISP1_CIF_ISP_DPF_GAIN_USAGE_AWB_LSC_GAINS: 1131 isp_dpf_mode = RKISP1_CIF_ISP_DPF_MODE_LSC_GAIN_COMP | 1132 RKISP1_CIF_ISP_DPF_MODE_AWB_GAIN_COMP; 1133 break; 1134 case RKISP1_CIF_ISP_DPF_GAIN_USAGE_DISABLED: 1135 default: 1136 isp_dpf_mode = 0; 1137 break; 1138 } 1139 1140 if (arg->nll.scale_mode == RKISP1_CIF_ISP_NLL_SCALE_LOGARITHMIC) 1141 isp_dpf_mode |= RKISP1_CIF_ISP_DPF_MODE_NLL_SEGMENTATION; 1142 if (arg->rb_flt.fltsize == RKISP1_CIF_ISP_DPF_RB_FILTERSIZE_9x9) 1143 isp_dpf_mode |= RKISP1_CIF_ISP_DPF_MODE_RB_FLTSIZE_9x9; 1144 if (!arg->rb_flt.r_enable) 1145 isp_dpf_mode |= RKISP1_CIF_ISP_DPF_MODE_R_FLT_DIS; 1146 if (!arg->rb_flt.b_enable) 1147 isp_dpf_mode |= RKISP1_CIF_ISP_DPF_MODE_B_FLT_DIS; 1148 if (!arg->g_flt.gb_enable) 1149 isp_dpf_mode |= RKISP1_CIF_ISP_DPF_MODE_GB_FLT_DIS; 1150 if (!arg->g_flt.gr_enable) 1151 isp_dpf_mode |= RKISP1_CIF_ISP_DPF_MODE_GR_FLT_DIS; 1152 1153 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_DPF_MODE, 1154 isp_dpf_mode); 1155 rkisp1_write(params->rkisp1, arg->gain.nf_b_gain, 1156 RKISP1_CIF_ISP_DPF_NF_GAIN_B); 1157 rkisp1_write(params->rkisp1, arg->gain.nf_r_gain, 1158 RKISP1_CIF_ISP_DPF_NF_GAIN_R); 1159 rkisp1_write(params->rkisp1, arg->gain.nf_gb_gain, 1160 RKISP1_CIF_ISP_DPF_NF_GAIN_GB); 1161 rkisp1_write(params->rkisp1, arg->gain.nf_gr_gain, 1162 RKISP1_CIF_ISP_DPF_NF_GAIN_GR); 1163 1164 for (i = 0; i < RKISP1_CIF_ISP_DPF_MAX_NLF_COEFFS; i++) { 1165 rkisp1_write(params->rkisp1, arg->nll.coeff[i], 1166 RKISP1_CIF_ISP_DPF_NULL_COEFF_0 + i * 4); 1167 } 1168 1169 spatial_coeff = arg->g_flt.spatial_coeff[0] | 1170 (arg->g_flt.spatial_coeff[1] << 8) | 1171 (arg->g_flt.spatial_coeff[2] << 16) | 1172 (arg->g_flt.spatial_coeff[3] << 24); 1173 rkisp1_write(params->rkisp1, spatial_coeff, 1174 RKISP1_CIF_ISP_DPF_S_WEIGHT_G_1_4); 1175 1176 spatial_coeff = arg->g_flt.spatial_coeff[4] | 1177 (arg->g_flt.spatial_coeff[5] << 8); 1178 rkisp1_write(params->rkisp1, spatial_coeff, 1179 RKISP1_CIF_ISP_DPF_S_WEIGHT_G_5_6); 1180 1181 spatial_coeff = arg->rb_flt.spatial_coeff[0] | 1182 (arg->rb_flt.spatial_coeff[1] << 8) | 1183 (arg->rb_flt.spatial_coeff[2] << 16) | 1184 (arg->rb_flt.spatial_coeff[3] << 24); 1185 rkisp1_write(params->rkisp1, spatial_coeff, 1186 RKISP1_CIF_ISP_DPF_S_WEIGHT_RB_1_4); 1187 1188 spatial_coeff = arg->rb_flt.spatial_coeff[4] | 1189 (arg->rb_flt.spatial_coeff[5] << 8); 1190 rkisp1_write(params->rkisp1, spatial_coeff, 1191 RKISP1_CIF_ISP_DPF_S_WEIGHT_RB_5_6); 1192 } 1193 1194 static void 1195 rkisp1_dpf_strength_config(struct rkisp1_params *params, 1196 const struct rkisp1_cif_isp_dpf_strength_config *arg) 1197 { 1198 rkisp1_write(params->rkisp1, arg->b, RKISP1_CIF_ISP_DPF_STRENGTH_B); 1199 rkisp1_write(params->rkisp1, arg->g, RKISP1_CIF_ISP_DPF_STRENGTH_G); 1200 rkisp1_write(params->rkisp1, arg->r, RKISP1_CIF_ISP_DPF_STRENGTH_R); 1201 } 1202 1203 static void 1204 rkisp1_isp_isr_other_config(struct rkisp1_params *params, 1205 const struct rkisp1_params_cfg *new_params) 1206 { 1207 unsigned int module_en_update, module_cfg_update, module_ens; 1208 1209 module_en_update = new_params->module_en_update; 1210 module_cfg_update = new_params->module_cfg_update; 1211 module_ens = new_params->module_ens; 1212 1213 /* update dpc config */ 1214 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_DPCC) 1215 rkisp1_dpcc_config(params, 1216 &new_params->others.dpcc_config); 1217 1218 if (module_en_update & RKISP1_CIF_ISP_MODULE_DPCC) { 1219 if (module_ens & RKISP1_CIF_ISP_MODULE_DPCC) 1220 rkisp1_param_set_bits(params, 1221 RKISP1_CIF_ISP_DPCC_MODE, 1222 RKISP1_CIF_ISP_DPCC_ENA); 1223 else 1224 rkisp1_param_clear_bits(params, 1225 RKISP1_CIF_ISP_DPCC_MODE, 1226 RKISP1_CIF_ISP_DPCC_ENA); 1227 } 1228 1229 /* update bls config */ 1230 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_BLS) 1231 rkisp1_bls_config(params, 1232 &new_params->others.bls_config); 1233 1234 if (module_en_update & RKISP1_CIF_ISP_MODULE_BLS) { 1235 if (module_ens & RKISP1_CIF_ISP_MODULE_BLS) 1236 rkisp1_param_set_bits(params, 1237 RKISP1_CIF_ISP_BLS_CTRL, 1238 RKISP1_CIF_ISP_BLS_ENA); 1239 else 1240 rkisp1_param_clear_bits(params, 1241 RKISP1_CIF_ISP_BLS_CTRL, 1242 RKISP1_CIF_ISP_BLS_ENA); 1243 } 1244 1245 /* update sdg config */ 1246 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_SDG) 1247 rkisp1_sdg_config(params, 1248 &new_params->others.sdg_config); 1249 1250 if (module_en_update & RKISP1_CIF_ISP_MODULE_SDG) { 1251 if (module_ens & RKISP1_CIF_ISP_MODULE_SDG) 1252 rkisp1_param_set_bits(params, 1253 RKISP1_CIF_ISP_CTRL, 1254 RKISP1_CIF_ISP_CTRL_ISP_GAMMA_IN_ENA); 1255 else 1256 rkisp1_param_clear_bits(params, 1257 RKISP1_CIF_ISP_CTRL, 1258 RKISP1_CIF_ISP_CTRL_ISP_GAMMA_IN_ENA); 1259 } 1260 1261 /* update lsc config */ 1262 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_LSC) 1263 rkisp1_lsc_config(params, 1264 &new_params->others.lsc_config); 1265 1266 if (module_en_update & RKISP1_CIF_ISP_MODULE_LSC) { 1267 if (module_ens & RKISP1_CIF_ISP_MODULE_LSC) 1268 rkisp1_param_set_bits(params, 1269 RKISP1_CIF_ISP_LSC_CTRL, 1270 RKISP1_CIF_ISP_LSC_CTRL_ENA); 1271 else 1272 rkisp1_param_clear_bits(params, 1273 RKISP1_CIF_ISP_LSC_CTRL, 1274 RKISP1_CIF_ISP_LSC_CTRL_ENA); 1275 } 1276 1277 /* update awb gains */ 1278 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_AWB_GAIN) 1279 params->ops->awb_gain_config(params, &new_params->others.awb_gain_config); 1280 1281 if (module_en_update & RKISP1_CIF_ISP_MODULE_AWB_GAIN) { 1282 if (module_ens & RKISP1_CIF_ISP_MODULE_AWB_GAIN) 1283 rkisp1_param_set_bits(params, 1284 RKISP1_CIF_ISP_CTRL, 1285 RKISP1_CIF_ISP_CTRL_ISP_AWB_ENA); 1286 else 1287 rkisp1_param_clear_bits(params, 1288 RKISP1_CIF_ISP_CTRL, 1289 RKISP1_CIF_ISP_CTRL_ISP_AWB_ENA); 1290 } 1291 1292 /* update bdm config */ 1293 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_BDM) 1294 rkisp1_bdm_config(params, 1295 &new_params->others.bdm_config); 1296 1297 if (module_en_update & RKISP1_CIF_ISP_MODULE_BDM) { 1298 if (module_ens & RKISP1_CIF_ISP_MODULE_BDM) 1299 rkisp1_param_set_bits(params, 1300 RKISP1_CIF_ISP_DEMOSAIC, 1301 RKISP1_CIF_ISP_DEMOSAIC_BYPASS); 1302 else 1303 rkisp1_param_clear_bits(params, 1304 RKISP1_CIF_ISP_DEMOSAIC, 1305 RKISP1_CIF_ISP_DEMOSAIC_BYPASS); 1306 } 1307 1308 /* update filter config */ 1309 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_FLT) 1310 rkisp1_flt_config(params, 1311 &new_params->others.flt_config); 1312 1313 if (module_en_update & RKISP1_CIF_ISP_MODULE_FLT) { 1314 if (module_ens & RKISP1_CIF_ISP_MODULE_FLT) 1315 rkisp1_param_set_bits(params, 1316 RKISP1_CIF_ISP_FILT_MODE, 1317 RKISP1_CIF_ISP_FLT_ENA); 1318 else 1319 rkisp1_param_clear_bits(params, 1320 RKISP1_CIF_ISP_FILT_MODE, 1321 RKISP1_CIF_ISP_FLT_ENA); 1322 } 1323 1324 /* update ctk config */ 1325 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_CTK) 1326 rkisp1_ctk_config(params, 1327 &new_params->others.ctk_config); 1328 1329 if (module_en_update & RKISP1_CIF_ISP_MODULE_CTK) 1330 rkisp1_ctk_enable(params, !!(module_ens & RKISP1_CIF_ISP_MODULE_CTK)); 1331 1332 /* update goc config */ 1333 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_GOC) 1334 params->ops->goc_config(params, &new_params->others.goc_config); 1335 1336 if (module_en_update & RKISP1_CIF_ISP_MODULE_GOC) { 1337 if (module_ens & RKISP1_CIF_ISP_MODULE_GOC) 1338 rkisp1_param_set_bits(params, 1339 RKISP1_CIF_ISP_CTRL, 1340 RKISP1_CIF_ISP_CTRL_ISP_GAMMA_OUT_ENA); 1341 else 1342 rkisp1_param_clear_bits(params, 1343 RKISP1_CIF_ISP_CTRL, 1344 RKISP1_CIF_ISP_CTRL_ISP_GAMMA_OUT_ENA); 1345 } 1346 1347 /* update cproc config */ 1348 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_CPROC) 1349 rkisp1_cproc_config(params, 1350 &new_params->others.cproc_config); 1351 1352 if (module_en_update & RKISP1_CIF_ISP_MODULE_CPROC) { 1353 if (module_ens & RKISP1_CIF_ISP_MODULE_CPROC) 1354 rkisp1_param_set_bits(params, 1355 RKISP1_CIF_C_PROC_CTRL, 1356 RKISP1_CIF_C_PROC_CTR_ENABLE); 1357 else 1358 rkisp1_param_clear_bits(params, 1359 RKISP1_CIF_C_PROC_CTRL, 1360 RKISP1_CIF_C_PROC_CTR_ENABLE); 1361 } 1362 1363 /* update ie config */ 1364 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_IE) 1365 rkisp1_ie_config(params, &new_params->others.ie_config); 1366 1367 if (module_en_update & RKISP1_CIF_ISP_MODULE_IE) 1368 rkisp1_ie_enable(params, !!(module_ens & RKISP1_CIF_ISP_MODULE_IE)); 1369 1370 /* update dpf config */ 1371 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_DPF) 1372 rkisp1_dpf_config(params, &new_params->others.dpf_config); 1373 1374 if (module_en_update & RKISP1_CIF_ISP_MODULE_DPF) { 1375 if (module_ens & RKISP1_CIF_ISP_MODULE_DPF) 1376 rkisp1_param_set_bits(params, 1377 RKISP1_CIF_ISP_DPF_MODE, 1378 RKISP1_CIF_ISP_DPF_MODE_EN); 1379 else 1380 rkisp1_param_clear_bits(params, 1381 RKISP1_CIF_ISP_DPF_MODE, 1382 RKISP1_CIF_ISP_DPF_MODE_EN); 1383 } 1384 1385 if ((module_en_update & RKISP1_CIF_ISP_MODULE_DPF_STRENGTH) || 1386 (module_cfg_update & RKISP1_CIF_ISP_MODULE_DPF_STRENGTH)) { 1387 /* update dpf strength config */ 1388 rkisp1_dpf_strength_config(params, 1389 &new_params->others.dpf_strength_config); 1390 } 1391 } 1392 1393 static void rkisp1_isp_isr_meas_config(struct rkisp1_params *params, 1394 struct rkisp1_params_cfg *new_params) 1395 { 1396 unsigned int module_en_update, module_cfg_update, module_ens; 1397 1398 module_en_update = new_params->module_en_update; 1399 module_cfg_update = new_params->module_cfg_update; 1400 module_ens = new_params->module_ens; 1401 1402 /* update awb config */ 1403 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_AWB) 1404 params->ops->awb_meas_config(params, &new_params->meas.awb_meas_config); 1405 1406 if (module_en_update & RKISP1_CIF_ISP_MODULE_AWB) 1407 params->ops->awb_meas_enable(params, 1408 &new_params->meas.awb_meas_config, 1409 !!(module_ens & RKISP1_CIF_ISP_MODULE_AWB)); 1410 1411 /* update afc config */ 1412 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_AFC) 1413 params->ops->afm_config(params, 1414 &new_params->meas.afc_config); 1415 1416 if (module_en_update & RKISP1_CIF_ISP_MODULE_AFC) { 1417 if (module_ens & RKISP1_CIF_ISP_MODULE_AFC) 1418 rkisp1_param_set_bits(params, 1419 RKISP1_CIF_ISP_AFM_CTRL, 1420 RKISP1_CIF_ISP_AFM_ENA); 1421 else 1422 rkisp1_param_clear_bits(params, 1423 RKISP1_CIF_ISP_AFM_CTRL, 1424 RKISP1_CIF_ISP_AFM_ENA); 1425 } 1426 1427 /* update hst config */ 1428 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_HST) 1429 params->ops->hst_config(params, 1430 &new_params->meas.hst_config); 1431 1432 if (module_en_update & RKISP1_CIF_ISP_MODULE_HST) 1433 params->ops->hst_enable(params, 1434 &new_params->meas.hst_config, 1435 !!(module_ens & RKISP1_CIF_ISP_MODULE_HST)); 1436 1437 /* update aec config */ 1438 if (module_cfg_update & RKISP1_CIF_ISP_MODULE_AEC) 1439 params->ops->aec_config(params, 1440 &new_params->meas.aec_config); 1441 1442 if (module_en_update & RKISP1_CIF_ISP_MODULE_AEC) { 1443 if (module_ens & RKISP1_CIF_ISP_MODULE_AEC) 1444 rkisp1_param_set_bits(params, 1445 RKISP1_CIF_ISP_EXP_CTRL, 1446 RKISP1_CIF_ISP_EXP_ENA); 1447 else 1448 rkisp1_param_clear_bits(params, 1449 RKISP1_CIF_ISP_EXP_CTRL, 1450 RKISP1_CIF_ISP_EXP_ENA); 1451 } 1452 } 1453 1454 static void rkisp1_params_apply_params_cfg(struct rkisp1_params *params, 1455 unsigned int frame_sequence) 1456 { 1457 struct rkisp1_params_cfg *new_params; 1458 struct rkisp1_buffer *cur_buf = NULL; 1459 1460 if (list_empty(¶ms->params)) 1461 return; 1462 1463 cur_buf = list_first_entry(¶ms->params, 1464 struct rkisp1_buffer, queue); 1465 1466 new_params = (struct rkisp1_params_cfg *)vb2_plane_vaddr(&cur_buf->vb.vb2_buf, 0); 1467 1468 rkisp1_isp_isr_other_config(params, new_params); 1469 rkisp1_isp_isr_meas_config(params, new_params); 1470 1471 /* update shadow register immediately */ 1472 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_CTRL, RKISP1_CIF_ISP_CTRL_ISP_CFG_UPD); 1473 1474 list_del(&cur_buf->queue); 1475 1476 cur_buf->vb.sequence = frame_sequence; 1477 vb2_buffer_done(&cur_buf->vb.vb2_buf, VB2_BUF_STATE_DONE); 1478 } 1479 1480 void rkisp1_params_isr(struct rkisp1_device *rkisp1) 1481 { 1482 /* 1483 * This isr is called when the ISR finishes processing a frame (RKISP1_CIF_ISP_FRAME). 1484 * Configurations performed here will be applied on the next frame. 1485 * Since frame_sequence is updated on the vertical sync signal, we should use 1486 * frame_sequence + 1 here to indicate to userspace on which frame these parameters 1487 * are being applied. 1488 */ 1489 unsigned int frame_sequence = rkisp1->isp.frame_sequence + 1; 1490 struct rkisp1_params *params = &rkisp1->params; 1491 1492 spin_lock(¶ms->config_lock); 1493 rkisp1_params_apply_params_cfg(params, frame_sequence); 1494 1495 spin_unlock(¶ms->config_lock); 1496 } 1497 1498 static const struct rkisp1_cif_isp_awb_meas_config rkisp1_awb_params_default_config = { 1499 { 1500 0, 0, RKISP1_DEFAULT_WIDTH, RKISP1_DEFAULT_HEIGHT 1501 }, 1502 RKISP1_CIF_ISP_AWB_MODE_YCBCR, 200, 30, 20, 20, 0, 128, 128 1503 }; 1504 1505 static const struct rkisp1_cif_isp_aec_config rkisp1_aec_params_default_config = { 1506 RKISP1_CIF_ISP_EXP_MEASURING_MODE_0, 1507 RKISP1_CIF_ISP_EXP_CTRL_AUTOSTOP_0, 1508 { 1509 RKISP1_DEFAULT_WIDTH >> 2, RKISP1_DEFAULT_HEIGHT >> 2, 1510 RKISP1_DEFAULT_WIDTH >> 1, RKISP1_DEFAULT_HEIGHT >> 1 1511 } 1512 }; 1513 1514 static const struct rkisp1_cif_isp_hst_config rkisp1_hst_params_default_config = { 1515 RKISP1_CIF_ISP_HISTOGRAM_MODE_RGB_COMBINED, 1516 3, 1517 { 1518 RKISP1_DEFAULT_WIDTH >> 2, RKISP1_DEFAULT_HEIGHT >> 2, 1519 RKISP1_DEFAULT_WIDTH >> 1, RKISP1_DEFAULT_HEIGHT >> 1 1520 }, 1521 { 1522 0, /* To be filled in with 0x01 at runtime. */ 1523 } 1524 }; 1525 1526 static const struct rkisp1_cif_isp_afc_config rkisp1_afc_params_default_config = { 1527 1, 1528 { 1529 { 1530 300, 225, 200, 150 1531 } 1532 }, 1533 4, 1534 14 1535 }; 1536 1537 static void rkisp1_params_config_parameter(struct rkisp1_params *params) 1538 { 1539 struct rkisp1_cif_isp_hst_config hst = rkisp1_hst_params_default_config; 1540 1541 params->ops->awb_meas_config(params, &rkisp1_awb_params_default_config); 1542 params->ops->awb_meas_enable(params, &rkisp1_awb_params_default_config, 1543 true); 1544 1545 params->ops->aec_config(params, &rkisp1_aec_params_default_config); 1546 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_EXP_CTRL, 1547 RKISP1_CIF_ISP_EXP_ENA); 1548 1549 params->ops->afm_config(params, &rkisp1_afc_params_default_config); 1550 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_AFM_CTRL, 1551 RKISP1_CIF_ISP_AFM_ENA); 1552 1553 memset(hst.hist_weight, 0x01, sizeof(hst.hist_weight)); 1554 params->ops->hst_config(params, &hst); 1555 rkisp1_param_set_bits(params, RKISP1_CIF_ISP_HIST_PROP_V10, 1556 rkisp1_hst_params_default_config.mode); 1557 1558 /* set the range */ 1559 if (params->quantization == V4L2_QUANTIZATION_FULL_RANGE) 1560 rkisp1_csm_config(params, true); 1561 else 1562 rkisp1_csm_config(params, false); 1563 1564 spin_lock_irq(¶ms->config_lock); 1565 1566 /* apply the first buffer if there is one already */ 1567 rkisp1_params_apply_params_cfg(params, 0); 1568 1569 spin_unlock_irq(¶ms->config_lock); 1570 } 1571 1572 void rkisp1_params_configure(struct rkisp1_params *params, 1573 enum rkisp1_fmt_raw_pat_type bayer_pat, 1574 enum v4l2_quantization quantization) 1575 { 1576 params->quantization = quantization; 1577 params->raw_type = bayer_pat; 1578 rkisp1_params_config_parameter(params); 1579 } 1580 1581 /* 1582 * Not called when the camera is active, therefore there is no need to acquire 1583 * a lock. 1584 */ 1585 void rkisp1_params_disable(struct rkisp1_params *params) 1586 { 1587 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_DPCC_MODE, 1588 RKISP1_CIF_ISP_DPCC_ENA); 1589 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_LSC_CTRL, 1590 RKISP1_CIF_ISP_LSC_CTRL_ENA); 1591 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_BLS_CTRL, 1592 RKISP1_CIF_ISP_BLS_ENA); 1593 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_CTRL, 1594 RKISP1_CIF_ISP_CTRL_ISP_GAMMA_IN_ENA); 1595 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_CTRL, 1596 RKISP1_CIF_ISP_CTRL_ISP_GAMMA_OUT_ENA); 1597 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_DEMOSAIC, 1598 RKISP1_CIF_ISP_DEMOSAIC_BYPASS); 1599 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_FILT_MODE, 1600 RKISP1_CIF_ISP_FLT_ENA); 1601 params->ops->awb_meas_enable(params, NULL, false); 1602 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_CTRL, 1603 RKISP1_CIF_ISP_CTRL_ISP_AWB_ENA); 1604 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_EXP_CTRL, 1605 RKISP1_CIF_ISP_EXP_ENA); 1606 rkisp1_ctk_enable(params, false); 1607 rkisp1_param_clear_bits(params, RKISP1_CIF_C_PROC_CTRL, 1608 RKISP1_CIF_C_PROC_CTR_ENABLE); 1609 params->ops->hst_enable(params, NULL, false); 1610 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_AFM_CTRL, 1611 RKISP1_CIF_ISP_AFM_ENA); 1612 rkisp1_ie_enable(params, false); 1613 rkisp1_param_clear_bits(params, RKISP1_CIF_ISP_DPF_MODE, 1614 RKISP1_CIF_ISP_DPF_MODE_EN); 1615 } 1616 1617 static const struct rkisp1_params_ops rkisp1_v10_params_ops = { 1618 .lsc_matrix_config = rkisp1_lsc_matrix_config_v10, 1619 .goc_config = rkisp1_goc_config_v10, 1620 .awb_meas_config = rkisp1_awb_meas_config_v10, 1621 .awb_meas_enable = rkisp1_awb_meas_enable_v10, 1622 .awb_gain_config = rkisp1_awb_gain_config_v10, 1623 .aec_config = rkisp1_aec_config_v10, 1624 .hst_config = rkisp1_hst_config_v10, 1625 .hst_enable = rkisp1_hst_enable_v10, 1626 .afm_config = rkisp1_afm_config_v10, 1627 }; 1628 1629 static struct rkisp1_params_ops rkisp1_v12_params_ops = { 1630 .lsc_matrix_config = rkisp1_lsc_matrix_config_v12, 1631 .goc_config = rkisp1_goc_config_v12, 1632 .awb_meas_config = rkisp1_awb_meas_config_v12, 1633 .awb_meas_enable = rkisp1_awb_meas_enable_v12, 1634 .awb_gain_config = rkisp1_awb_gain_config_v12, 1635 .aec_config = rkisp1_aec_config_v12, 1636 .hst_config = rkisp1_hst_config_v12, 1637 .hst_enable = rkisp1_hst_enable_v12, 1638 .afm_config = rkisp1_afm_config_v12, 1639 }; 1640 1641 static int rkisp1_params_enum_fmt_meta_out(struct file *file, void *priv, 1642 struct v4l2_fmtdesc *f) 1643 { 1644 struct video_device *video = video_devdata(file); 1645 struct rkisp1_params *params = video_get_drvdata(video); 1646 1647 if (f->index > 0 || f->type != video->queue->type) 1648 return -EINVAL; 1649 1650 f->pixelformat = params->vdev_fmt.fmt.meta.dataformat; 1651 1652 return 0; 1653 } 1654 1655 static int rkisp1_params_g_fmt_meta_out(struct file *file, void *fh, 1656 struct v4l2_format *f) 1657 { 1658 struct video_device *video = video_devdata(file); 1659 struct rkisp1_params *params = video_get_drvdata(video); 1660 struct v4l2_meta_format *meta = &f->fmt.meta; 1661 1662 if (f->type != video->queue->type) 1663 return -EINVAL; 1664 1665 memset(meta, 0, sizeof(*meta)); 1666 meta->dataformat = params->vdev_fmt.fmt.meta.dataformat; 1667 meta->buffersize = params->vdev_fmt.fmt.meta.buffersize; 1668 1669 return 0; 1670 } 1671 1672 static int rkisp1_params_querycap(struct file *file, 1673 void *priv, struct v4l2_capability *cap) 1674 { 1675 struct video_device *vdev = video_devdata(file); 1676 1677 strscpy(cap->driver, RKISP1_DRIVER_NAME, sizeof(cap->driver)); 1678 strscpy(cap->card, vdev->name, sizeof(cap->card)); 1679 strscpy(cap->bus_info, RKISP1_BUS_INFO, sizeof(cap->bus_info)); 1680 1681 return 0; 1682 } 1683 1684 /* ISP params video device IOCTLs */ 1685 static const struct v4l2_ioctl_ops rkisp1_params_ioctl = { 1686 .vidioc_reqbufs = vb2_ioctl_reqbufs, 1687 .vidioc_querybuf = vb2_ioctl_querybuf, 1688 .vidioc_create_bufs = vb2_ioctl_create_bufs, 1689 .vidioc_qbuf = vb2_ioctl_qbuf, 1690 .vidioc_dqbuf = vb2_ioctl_dqbuf, 1691 .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 1692 .vidioc_expbuf = vb2_ioctl_expbuf, 1693 .vidioc_streamon = vb2_ioctl_streamon, 1694 .vidioc_streamoff = vb2_ioctl_streamoff, 1695 .vidioc_enum_fmt_meta_out = rkisp1_params_enum_fmt_meta_out, 1696 .vidioc_g_fmt_meta_out = rkisp1_params_g_fmt_meta_out, 1697 .vidioc_s_fmt_meta_out = rkisp1_params_g_fmt_meta_out, 1698 .vidioc_try_fmt_meta_out = rkisp1_params_g_fmt_meta_out, 1699 .vidioc_querycap = rkisp1_params_querycap, 1700 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 1701 .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 1702 }; 1703 1704 static int rkisp1_params_vb2_queue_setup(struct vb2_queue *vq, 1705 unsigned int *num_buffers, 1706 unsigned int *num_planes, 1707 unsigned int sizes[], 1708 struct device *alloc_devs[]) 1709 { 1710 *num_buffers = clamp_t(u32, *num_buffers, 1711 RKISP1_ISP_PARAMS_REQ_BUFS_MIN, 1712 RKISP1_ISP_PARAMS_REQ_BUFS_MAX); 1713 1714 *num_planes = 1; 1715 1716 sizes[0] = sizeof(struct rkisp1_params_cfg); 1717 1718 return 0; 1719 } 1720 1721 static void rkisp1_params_vb2_buf_queue(struct vb2_buffer *vb) 1722 { 1723 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1724 struct rkisp1_buffer *params_buf = 1725 container_of(vbuf, struct rkisp1_buffer, vb); 1726 struct vb2_queue *vq = vb->vb2_queue; 1727 struct rkisp1_params *params = vq->drv_priv; 1728 1729 spin_lock_irq(¶ms->config_lock); 1730 list_add_tail(¶ms_buf->queue, ¶ms->params); 1731 spin_unlock_irq(¶ms->config_lock); 1732 } 1733 1734 static int rkisp1_params_vb2_buf_prepare(struct vb2_buffer *vb) 1735 { 1736 if (vb2_plane_size(vb, 0) < sizeof(struct rkisp1_params_cfg)) 1737 return -EINVAL; 1738 1739 vb2_set_plane_payload(vb, 0, sizeof(struct rkisp1_params_cfg)); 1740 1741 return 0; 1742 } 1743 1744 static void rkisp1_params_vb2_stop_streaming(struct vb2_queue *vq) 1745 { 1746 struct rkisp1_params *params = vq->drv_priv; 1747 struct rkisp1_buffer *buf; 1748 LIST_HEAD(tmp_list); 1749 1750 /* 1751 * we first move the buffers into a local list 'tmp_list' 1752 * and then we can iterate it and call vb2_buffer_done 1753 * without holding the lock 1754 */ 1755 spin_lock_irq(¶ms->config_lock); 1756 list_splice_init(¶ms->params, &tmp_list); 1757 spin_unlock_irq(¶ms->config_lock); 1758 1759 list_for_each_entry(buf, &tmp_list, queue) 1760 vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1761 } 1762 1763 static const struct vb2_ops rkisp1_params_vb2_ops = { 1764 .queue_setup = rkisp1_params_vb2_queue_setup, 1765 .wait_prepare = vb2_ops_wait_prepare, 1766 .wait_finish = vb2_ops_wait_finish, 1767 .buf_queue = rkisp1_params_vb2_buf_queue, 1768 .buf_prepare = rkisp1_params_vb2_buf_prepare, 1769 .stop_streaming = rkisp1_params_vb2_stop_streaming, 1770 1771 }; 1772 1773 static const struct v4l2_file_operations rkisp1_params_fops = { 1774 .mmap = vb2_fop_mmap, 1775 .unlocked_ioctl = video_ioctl2, 1776 .poll = vb2_fop_poll, 1777 .open = v4l2_fh_open, 1778 .release = vb2_fop_release 1779 }; 1780 1781 static int rkisp1_params_init_vb2_queue(struct vb2_queue *q, 1782 struct rkisp1_params *params) 1783 { 1784 struct rkisp1_vdev_node *node; 1785 1786 node = container_of(q, struct rkisp1_vdev_node, buf_queue); 1787 1788 q->type = V4L2_BUF_TYPE_META_OUTPUT; 1789 q->io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1790 q->drv_priv = params; 1791 q->ops = &rkisp1_params_vb2_ops; 1792 q->mem_ops = &vb2_vmalloc_memops; 1793 q->buf_struct_size = sizeof(struct rkisp1_buffer); 1794 q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1795 q->lock = &node->vlock; 1796 1797 return vb2_queue_init(q); 1798 } 1799 1800 static void rkisp1_init_params(struct rkisp1_params *params) 1801 { 1802 params->vdev_fmt.fmt.meta.dataformat = 1803 V4L2_META_FMT_RK_ISP1_PARAMS; 1804 params->vdev_fmt.fmt.meta.buffersize = 1805 sizeof(struct rkisp1_params_cfg); 1806 1807 if (params->rkisp1->media_dev.hw_revision == RKISP1_V12) 1808 params->ops = &rkisp1_v12_params_ops; 1809 else 1810 params->ops = &rkisp1_v10_params_ops; 1811 } 1812 1813 int rkisp1_params_register(struct rkisp1_device *rkisp1) 1814 { 1815 struct rkisp1_params *params = &rkisp1->params; 1816 struct rkisp1_vdev_node *node = ¶ms->vnode; 1817 struct video_device *vdev = &node->vdev; 1818 int ret; 1819 1820 params->rkisp1 = rkisp1; 1821 mutex_init(&node->vlock); 1822 INIT_LIST_HEAD(¶ms->params); 1823 spin_lock_init(¶ms->config_lock); 1824 1825 strscpy(vdev->name, RKISP1_PARAMS_DEV_NAME, sizeof(vdev->name)); 1826 1827 video_set_drvdata(vdev, params); 1828 vdev->ioctl_ops = &rkisp1_params_ioctl; 1829 vdev->fops = &rkisp1_params_fops; 1830 vdev->release = video_device_release_empty; 1831 /* 1832 * Provide a mutex to v4l2 core. It will be used 1833 * to protect all fops and v4l2 ioctls. 1834 */ 1835 vdev->lock = &node->vlock; 1836 vdev->v4l2_dev = &rkisp1->v4l2_dev; 1837 vdev->queue = &node->buf_queue; 1838 vdev->device_caps = V4L2_CAP_STREAMING | V4L2_CAP_META_OUTPUT; 1839 vdev->vfl_dir = VFL_DIR_TX; 1840 rkisp1_params_init_vb2_queue(vdev->queue, params); 1841 rkisp1_init_params(params); 1842 video_set_drvdata(vdev, params); 1843 1844 node->pad.flags = MEDIA_PAD_FL_SOURCE; 1845 ret = media_entity_pads_init(&vdev->entity, 1, &node->pad); 1846 if (ret) 1847 goto error; 1848 1849 ret = video_register_device(vdev, VFL_TYPE_VIDEO, -1); 1850 if (ret) { 1851 dev_err(rkisp1->dev, 1852 "failed to register %s, ret=%d\n", vdev->name, ret); 1853 goto error; 1854 } 1855 1856 return 0; 1857 1858 error: 1859 media_entity_cleanup(&vdev->entity); 1860 mutex_destroy(&node->vlock); 1861 return ret; 1862 } 1863 1864 void rkisp1_params_unregister(struct rkisp1_device *rkisp1) 1865 { 1866 struct rkisp1_params *params = &rkisp1->params; 1867 struct rkisp1_vdev_node *node = ¶ms->vnode; 1868 struct video_device *vdev = &node->vdev; 1869 1870 if (!video_is_registered(vdev)) 1871 return; 1872 1873 vb2_video_unregister_device(vdev); 1874 media_entity_cleanup(&vdev->entity); 1875 mutex_destroy(&node->vlock); 1876 } 1877