#include "rpp_module.h"
#define AWB_MEAS_VERSION_REG 0x0000
#define AWB_MEAS_PROP_REG 0x0004
#define AWB_MEAS_PROP_MEAS_MODE_RGB BIT(16) /* 0: YCbCr 1: RGB */
#define AWB_MEAS_PROP_YMAX BIT(2)
#define AWB_MEAS_PROP_AWB_MODE_ON BIT(1)
#define AWB_MEAS_H_OFFS_REG 0x0008
#define AWB_MEAS_V_OFFS_REG 0x000c
#define AWB_MEAS_H_SIZE_REG 0x0010
#define AWB_MEAS_V_SIZE_REG 0x0014
#define AWB_MEAS_FRAMES_REG 0x0018
#define AWB_MEAS_REF_CB_MAX_B_REG 0x001c
#define AWB_MEAS_REF_CR_MAX_R_REG 0x0020
#define AWB_MEAS_MAX_Y_REG 0x0024
#define AWB_MEAS_MIN_Y_MAX_G_REG 0x0028
#define AWB_MEAS_MAX_CSUM_REG 0x002c
#define AWB_MEAS_MIN_C_REG 0x0030
#define AWB_MEAS_WHITE_CNT_REG 0x0034
#define AWB_MEAS_MEAN_Y_G_REG 0x0038
#define AWB_MEAS_MEAN_CB_B_REG 0x003c
#define AWB_MEAS_MEAN_CR_R_REG 0x0040
#define AWB_MEAS_CCOR_COEFF_NUM 9
#define AWB_MEAS_CCOR_COEFF_REG(n) (0x0044 + (4 * (n)))
#define AWB_MEAS_CCOR_OFFSET_R_REG 0x0068
#define AWB_MEAS_CCOR_OFFSET_G_REG 0x006c
#define AWB_MEAS_CCOR_OFFSET_B_REG 0x0070
static int rppx1_wbmeas_probe(struct rpp_module *mod)
{
switch (rpp_module_read(mod, AWB_MEAS_VERSION_REG)) {
case 1:
break;
case 2:
break;
case 3:
break;
default:
return -EINVAL;
}
return 0;
}
static int
rppx1_wbmeas_fill_params(struct rpp_module *mod,
const union rppx1_params_block *block,
rppx1_reg_write write, void *priv)
{
const struct rppx1_wbmeas_params *cfg = &block->wbmeas;
u32 awb_meas_props;
if (cfg->header.flags & V4L2_ISP_PARAMS_FL_BLOCK_DISABLE) {
write(priv, mod->base + AWB_MEAS_PROP_REG, 0);
return 0;
}
write(priv, mod->base + AWB_MEAS_H_OFFS_REG, cfg->wnd.h_offs);
write(priv, mod->base + AWB_MEAS_V_OFFS_REG, cfg->wnd.v_offs);
write(priv, mod->base + AWB_MEAS_H_SIZE_REG, cfg->wnd.h_size);
write(priv, mod->base + AWB_MEAS_V_SIZE_REG, cfg->wnd.v_size);
write(priv, mod->base + AWB_MEAS_FRAMES_REG, cfg->frames);
if (cfg->mode == RPPX1_WBMEAS_MODE_YCBCR) {
write(priv, mod->base + AWB_MEAS_REF_CB_MAX_B_REG,
cfg->ref_cb_max_b);
write(priv, mod->base + AWB_MEAS_REF_CR_MAX_R_REG,
cfg->ref_cr_max_r);
write(priv, mod->base + AWB_MEAS_MAX_Y_REG, cfg->max_y);
write(priv, mod->base + AWB_MEAS_MIN_Y_MAX_G_REG,
cfg->min_y_max_g);
write(priv, mod->base + AWB_MEAS_MAX_CSUM_REG, cfg->max_csum);
write(priv, mod->base + AWB_MEAS_MIN_C_REG, cfg->min_c);
for (unsigned int i = 0; i < 3; i++) {
for (unsigned int j = 0; j < 3; j++) {
unsigned int index = i * 3 + j;
write(priv,
mod->base + AWB_MEAS_CCOR_COEFF_REG(index),
cfg->ccor_coeff[i][j]);
}
}
write(priv, mod->base + AWB_MEAS_CCOR_OFFSET_R_REG,
cfg->ccor_offs[0]);
write(priv, mod->base + AWB_MEAS_CCOR_OFFSET_G_REG,
cfg->ccor_offs[1]);
write(priv, mod->base + AWB_MEAS_CCOR_OFFSET_B_REG,
cfg->ccor_offs[2]);
awb_meas_props = cfg->ymax_cmp ? AWB_MEAS_PROP_YMAX : 0;
} else {
write(priv, mod->base + AWB_MEAS_REF_CB_MAX_B_REG,
cfg->ref_cb_max_b);
write(priv, mod->base + AWB_MEAS_REF_CR_MAX_R_REG,
cfg->ref_cr_max_r);
write(priv, mod->base + AWB_MEAS_MIN_Y_MAX_G_REG,
cfg->min_y_max_g);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(0), 0x1000);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(1), 0x0000);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(2), 0x0000);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(3), 0x0000);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(4), 0x1000);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(5), 0x0000);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(6), 0x0000);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(7), 0x0000);
write(priv, mod->base + AWB_MEAS_CCOR_COEFF_REG(8), 0x1000);
write(priv, mod->base + AWB_MEAS_CCOR_OFFSET_R_REG, 0x00000000);
write(priv, mod->base + AWB_MEAS_CCOR_OFFSET_G_REG, 0x00000000);
write(priv, mod->base + AWB_MEAS_CCOR_OFFSET_B_REG, 0x00000000);
awb_meas_props = AWB_MEAS_PROP_MEAS_MODE_RGB;
}
write(priv, mod->base + AWB_MEAS_PROP_REG,
awb_meas_props | AWB_MEAS_PROP_AWB_MODE_ON);
return 0;
}
static int rppx1_wbmeas_fill_stats(struct rpp_module *mod,
union rppx1_stats_block *block)
{
struct rppx1_wbmeas_stats *stats = &block->wbmeas;
stats->cnt = rpp_module_read(mod, AWB_MEAS_WHITE_CNT_REG);
stats->mean_y_or_g = rpp_module_read(mod, AWB_MEAS_MEAN_Y_G_REG);
stats->mean_cb_or_b = rpp_module_read(mod, AWB_MEAS_MEAN_CB_B_REG);
stats->mean_cr_or_r = rpp_module_read(mod, AWB_MEAS_MEAN_CR_R_REG);
return 0;
}
const struct rpp_module_ops rppx1_wbmeas_ops = {
.probe = rppx1_wbmeas_probe,
.fill_params = rppx1_wbmeas_fill_params,
.fill_stats = rppx1_wbmeas_fill_stats
}