#include "rpp_module.h"
#define GAMMA_OUT_VERSION_REG 0x0000
#define GAMMA_OUT_ENABLE_REG 0x0004
#define GAMMA_OUT_ENABLE_GAMMA_OUT_EN BIT(0)
#define GAMMA_OUT_MODE_REG 0x0008
#define GAMMA_OUT_MODE_GAMMA_OUT_EQU_SEGM BIT(0)
#define GAMMA_OUT_Y_REG(n) (0x000c + (4 * (n)))
#define GAMMA_OUT_HV_GAMMA_CURVE_MASK GENMASK(11, 0)
#define GAMMA_OUT_MV_GAMMA_CURVE_MASK GENMASK(23, 0)
static int rppx1_ga_probe(struct rpp_module *mod)
{
switch (rpp_module_read(mod, GAMMA_OUT_VERSION_REG)) {
case 1:
break;
case 2:
break;
default:
return -EINVAL;
}
return 0;
}
static int rppx1_ga_start(struct rpp_module *mod,
const struct v4l2_mbus_framefmt *fmt)
{
rpp_module_write(mod, GAMMA_OUT_ENABLE_REG, 0);
return 0;
}
static int
rppx1_ga_fill_params(struct rpp_module *mod,
const union rppx1_params_block *block,
rppx1_reg_write write, void *priv)
{
const struct rppx1_ga_params *cfg = &block->ga;
u32 mask;
if (cfg->header.flags & V4L2_ISP_PARAMS_FL_BLOCK_DISABLE) {
write(priv, mod->base + GAMMA_OUT_ENABLE_REG, 0);
return 0;
}
switch (cfg->header.type) {
case RPPX1_PARAMS_BLOCK_TYPE_GA_HV:
mask = GAMMA_OUT_HV_GAMMA_CURVE_MASK;
break;
case RPPX1_PARAMS_BLOCK_TYPE_GA_MV:
mask = GAMMA_OUT_MV_GAMMA_CURVE_MASK;
break;
default:
return -EINVAL;
}
write(priv, mod->base + GAMMA_OUT_MODE_REG, cfg->mode);
for (unsigned int i = 0; i < RPPX1_GA_MAX_SAMPLES; i++)
write(priv, mod->base + GAMMA_OUT_Y_REG(i),
cfg->gamma_y[i] & mask);
write(priv, mod->base + GAMMA_OUT_ENABLE_REG,
GAMMA_OUT_ENABLE_GAMMA_OUT_EN);
return 0;
}
const struct rpp_module_ops rppx1_ga_ops = {
.probe = rppx1_ga_probe,
.start = rppx1_ga_start,
.fill_params = rppx1_ga_fill_params,
}