#include "rpp_module.h"
#define LSC_VERSION_REG 0x0000
#define LSC_CTRL_REG 0x0004
#define LSC_CTRL_LSC_EN BIT(0)
#define LSC_R_TABLE_ADDR_REG 0x0008
#define LSC_GR_TABLE_ADDR_REG 0x000c
#define LSC_B_TABLE_ADDR_REG 0x0010
#define LSC_GB_TABLE_ADDR_REG 0x0014
#define LSC_R_TABLE_DATA_REG 0x0018
#define LSC_GR_TABLE_DATA_REG 0x001c
#define LSC_B_TABLE_DATA_REG 0x0020
#define LSC_GB_TABLE_DATA_REG 0x0024
#define LSC_XGRAD_01_REG 0x0028
#define LSC_XGRAD_23_REG 0x002c
#define LSC_XGRAD_45_REG 0x0030
#define LSC_XGRAD_67_REG 0x0034
#define LSC_XGRAD_89_REG 0x0038
#define LSC_XGRAD_1011_REG 0x003c
#define LSC_XGRAD_1213_REG 0x0040
#define LSC_XGRAD_1415_REG 0x0044
#define LSC_YGRAD_01_REG 0x0048
#define LSC_YGRAD_23_REG 0x004c
#define LSC_YGRAD_45_REG 0x0050
#define LSC_YGRAD_67_REG 0x0054
#define LSC_YGRAD_89_REG 0x0058
#define LSC_YGRAD_1011_REG 0x005c
#define LSC_YGRAD_1213_REG 0x0060
#define LSC_YGRAD_1415_REG 0x0064
#define LSC_XSIZE_01_REG 0x0068
#define LSC_XSIZE_23_REG 0x006c
#define LSC_XSIZE_45_REG 0x0070
#define LSC_XSIZE_67_REG 0x0074
#define LSC_XSIZE_89_REG 0x0078
#define LSC_XSIZE_1011_REG 0x007c
#define LSC_XSIZE_1213_REG 0x0080
#define LSC_XSIZE_1415_REG 0x0084
#define LSC_YSIZE_01_REG 0x0088
#define LSC_YSIZE_23_REG 0x008c
#define LSC_YSIZE_45_REG 0x0090
#define LSC_YSIZE_67_REG 0x0094
#define LSC_YSIZE_89_REG 0x0098
#define LSC_YSIZE_1011_REG 0x009c
#define LSC_YSIZE_1213_REG 0x00a0
#define LSC_YSIZE_1415_REG 0x00a4
#define LSC_TABLE_SEL_REG 0x00a8
#define LSC_STATUS_REG 0x00ac
#define LSC_R_TABLE_DATA_VALUE(v1, v2) (((v1) & 0xfff) | (((v2) & 0xfff) << 12))
#define LSC_GRAD_VALUE(v1, v2) (((v1) & 0xfff) | (((v2) & 0xfff) << 16))
#define LSC_SIZE_VALUE(v1, v2) (((v1) & 0x1ff) | (((v2) & 0x1ff) << 16))
static int rppx1_lsc_probe(struct rpp_module *mod)
{
if (rpp_module_read(mod, LSC_VERSION_REG) != 0x04)
return -EINVAL;
return 0;
}
static int
rppx1_lsc_fill_params(struct rpp_module *mod,
const union rppx1_params_block *block,
rppx1_reg_write write, void *priv)
{
const struct rppx1_lsc_params *cfg = &block->lsc;
const __u16 *v;
write(priv, mod->base + LSC_CTRL_REG, 0);
if (cfg->header.flags & V4L2_ISP_PARAMS_FL_BLOCK_DISABLE)
return 0;
write(priv, mod->base + LSC_R_TABLE_ADDR_REG, 0);
write(priv, mod->base + LSC_GR_TABLE_ADDR_REG, 0);
write(priv, mod->base + LSC_B_TABLE_ADDR_REG, 0);
write(priv, mod->base + LSC_GB_TABLE_ADDR_REG, 0);
for (unsigned int i = 0; i < RPPX1_LSC_SAMPLES_MAX; i++) {
const __u16 *r = cfg->r_data[i];
const __u16 *gr = cfg->gr_data[i];
const __u16 *b = cfg->b_data[i];
const __u16 *gb = cfg->gb_data[i];
unsigned int j;
for (j = 0; j < RPPX1_LSC_SAMPLES_MAX - 1; j += 2) {
write(priv, mod->base + LSC_R_TABLE_DATA_REG,
LSC_R_TABLE_DATA_VALUE(r[j], r[j + 1]));
write(priv, mod->base + LSC_GR_TABLE_DATA_REG,
LSC_R_TABLE_DATA_VALUE(gr[j], gr[j + 1]));
write(priv, mod->base + LSC_B_TABLE_DATA_REG,
LSC_R_TABLE_DATA_VALUE(b[j], b[j + 1]));
write(priv, mod->base + LSC_GB_TABLE_DATA_REG,
LSC_R_TABLE_DATA_VALUE(gb[j], gb[j + 1]));
}
write(priv, mod->base + LSC_R_TABLE_DATA_REG,
LSC_R_TABLE_DATA_VALUE(r[j], 0));
write(priv, mod->base + LSC_GR_TABLE_DATA_REG,
LSC_R_TABLE_DATA_VALUE(gr[j], 0));
write(priv, mod->base + LSC_B_TABLE_DATA_REG,
LSC_R_TABLE_DATA_VALUE(b[j], 0));
write(priv, mod->base + LSC_GB_TABLE_DATA_REG,
LSC_R_TABLE_DATA_VALUE(gb[j], 0));
}
write(priv, mod->base + LSC_TABLE_SEL_REG, 0);
v = cfg->x_grad;
write(priv, mod->base + LSC_XGRAD_01_REG, LSC_GRAD_VALUE(v[0], v[1]));
write(priv, mod->base + LSC_XGRAD_23_REG, LSC_GRAD_VALUE(v[2], v[3]));
write(priv, mod->base + LSC_XGRAD_45_REG, LSC_GRAD_VALUE(v[4], v[5]));
write(priv, mod->base + LSC_XGRAD_67_REG, LSC_GRAD_VALUE(v[6], v[7]));
write(priv, mod->base + LSC_XGRAD_89_REG, LSC_GRAD_VALUE(v[8], v[9]));
write(priv, mod->base + LSC_XGRAD_1011_REG, LSC_GRAD_VALUE(v[10], v[11]));
write(priv, mod->base + LSC_XGRAD_1213_REG, LSC_GRAD_VALUE(v[12], v[13]));
write(priv, mod->base + LSC_XGRAD_1415_REG, LSC_GRAD_VALUE(v[14], v[15]));
v = cfg->y_grad;
write(priv, mod->base + LSC_YGRAD_01_REG, LSC_GRAD_VALUE(v[0], v[1]));
write(priv, mod->base + LSC_YGRAD_23_REG, LSC_GRAD_VALUE(v[2], v[3]));
write(priv, mod->base + LSC_YGRAD_45_REG, LSC_GRAD_VALUE(v[4], v[5]));
write(priv, mod->base + LSC_YGRAD_67_REG, LSC_GRAD_VALUE(v[6], v[7]));
write(priv, mod->base + LSC_YGRAD_89_REG, LSC_GRAD_VALUE(v[8], v[9]));
write(priv, mod->base + LSC_YGRAD_1011_REG, LSC_GRAD_VALUE(v[10], v[11]));
write(priv, mod->base + LSC_YGRAD_1213_REG, LSC_GRAD_VALUE(v[12], v[13]));
write(priv, mod->base + LSC_YGRAD_1415_REG, LSC_GRAD_VALUE(v[14], v[15]));
v = cfg->x_sect_size;
write(priv, mod->base + LSC_XSIZE_01_REG, LSC_GRAD_VALUE(v[0], v[1]));
write(priv, mod->base + LSC_XSIZE_23_REG, LSC_GRAD_VALUE(v[2], v[3]));
write(priv, mod->base + LSC_XSIZE_45_REG, LSC_GRAD_VALUE(v[4], v[5]));
write(priv, mod->base + LSC_XSIZE_67_REG, LSC_GRAD_VALUE(v[6], v[7]));
write(priv, mod->base + LSC_XSIZE_89_REG, LSC_GRAD_VALUE(v[8], v[9]));
write(priv, mod->base + LSC_XSIZE_1011_REG, LSC_GRAD_VALUE(v[10], v[11]));
write(priv, mod->base + LSC_XSIZE_1213_REG, LSC_GRAD_VALUE(v[12], v[13]));
write(priv, mod->base + LSC_XSIZE_1415_REG, LSC_GRAD_VALUE(v[14], v[15]));
v = cfg->y_sect_size;
write(priv, mod->base + LSC_YSIZE_01_REG, LSC_GRAD_VALUE(v[0], v[1]));
write(priv, mod->base + LSC_YSIZE_23_REG, LSC_GRAD_VALUE(v[2], v[3]));
write(priv, mod->base + LSC_YSIZE_45_REG, LSC_GRAD_VALUE(v[4], v[5]));
write(priv, mod->base + LSC_YSIZE_67_REG, LSC_GRAD_VALUE(v[6], v[7]));
write(priv, mod->base + LSC_YSIZE_89_REG, LSC_GRAD_VALUE(v[8], v[9]));
write(priv, mod->base + LSC_YSIZE_1011_REG, LSC_GRAD_VALUE(v[10], v[11]));
write(priv, mod->base + LSC_YSIZE_1213_REG, LSC_GRAD_VALUE(v[12], v[13]));
write(priv, mod->base + LSC_YSIZE_1415_REG, LSC_GRAD_VALUE(v[14], v[15]));
write(priv, mod->base + LSC_CTRL_REG, LSC_CTRL_LSC_EN);
return 0;
}
const struct rpp_module_ops rppx1_lsc_ops = {
.probe = rppx1_lsc_probe,
.fill_params = rppx1_lsc_fill_params,
}