[PATCH v2 19/30] media: atmel: atmel-isc: add CC initialization function

[Eugen Hristev]

Implement the color correction (CC) submodule initialization, as a product
specific function, which currently configures the neutral point in color
correction.

Signed-off-by: Eugen Hristev <eugen.hris...@microchip.com>
---
Changes in v2:
- addded function prototype to avoid warning with W=1

 drivers/media/platform/atmel/atmel-isc-base.c    |  1 +
 drivers/media/platform/atmel/atmel-isc.h         |  3 +++
 drivers/media/platform/atmel/atmel-sama5d2-isc.c | 15 +++++++++++++++
 3 files changed, 19 insertions(+)

diff --git a/drivers/media/platform/atmel/atmel-isc-base.c 
b/drivers/media/platform/atmel/atmel-isc-base.c
index 66005cb3940f..182903803c05 100644
--- a/drivers/media/platform/atmel/atmel-isc-base.c
+++ b/drivers/media/platform/atmel/atmel-isc-base.c
@@ -653,6 +653,7 @@ static void isc_set_pipeline(struct isc_device *isc, u32 
pipeline)
 
        isc->config_csc(isc);
        isc->config_cbc(isc);
+       isc->config_cc(isc);
 }
 
 static int isc_update_profile(struct isc_device *isc)
diff --git a/drivers/media/platform/atmel/atmel-isc.h 
b/drivers/media/platform/atmel/atmel-isc.h
index f574bcc3ba67..a5f8d5001381 100644
--- a/drivers/media/platform/atmel/atmel-isc.h
+++ b/drivers/media/platform/atmel/atmel-isc.h
@@ -225,6 +225,8 @@ struct isc_reg_offsets {
  *                     specific CSC module
  * @config_cbc:                pointer to a function that initializes product
  *                     specific CBC module
+ * @config_cc:         pointer to a function that initializes product
+ *                     specific CC module
  *
  * @offsets:           struct holding the product specific register offsets
  */
@@ -298,6 +300,7 @@ struct isc_device {
        struct {
                void (*config_csc)(struct isc_device *isc);
                void (*config_cbc)(struct isc_device *isc);
+               void (*config_cc)(struct isc_device *isc);
        };
 
        struct isc_reg_offsets          offsets;
diff --git a/drivers/media/platform/atmel/atmel-sama5d2-isc.c 
b/drivers/media/platform/atmel/atmel-sama5d2-isc.c
index 0ff13198d732..0ce8293622f9 100644
--- a/drivers/media/platform/atmel/atmel-sama5d2-isc.c
+++ b/drivers/media/platform/atmel/atmel-sama5d2-isc.c
@@ -56,6 +56,7 @@
 
 void isc_sama5d2_config_csc(struct isc_device *isc);
 void isc_sama5d2_config_cbc(struct isc_device *isc);
+void isc_sama5d2_config_cc(struct isc_device *isc);
 
 void isc_sama5d2_config_csc(struct isc_device *isc)
 {
@@ -86,6 +87,19 @@ void isc_sama5d2_config_cbc(struct isc_device *isc)
                     isc->ctrls.contrast);
 }
 
+void isc_sama5d2_config_cc(struct isc_device *isc)
+{
+       struct regmap *regmap = isc->regmap;
+
+       /* Configure each register at the neutral fixed point 1.0 or 0.0 */
+       regmap_write(regmap, ISC_CC_RR_RG, (1 << 8));
+       regmap_write(regmap, ISC_CC_RB_OR, 0);
+       regmap_write(regmap, ISC_CC_GR_GG, (1 << 8) << 16);
+       regmap_write(regmap, ISC_CC_GB_OG, 0);
+       regmap_write(regmap, ISC_CC_BR_BG, 0);
+       regmap_write(regmap, ISC_CC_BB_OB, (1 << 8));
+}
+
 /* Gamma table with gamma 1/2.2 */
 const u32 isc_sama5d2_gamma_table[][GAMMA_ENTRIES] = {
        /* 0 --> gamma 1/1.8 */
@@ -233,6 +247,7 @@ static int atmel_isc_probe(struct platform_device *pdev)
 
        isc->config_csc = isc_sama5d2_config_csc;
        isc->config_cbc = isc_sama5d2_config_cbc;
+       isc->config_cc = isc_sama5d2_config_cc;
 
        isc->offsets.csc = ISC_SAMA5D2_CSC_OFFSET;
        isc->offsets.cbc = ISC_SAMA5D2_CBC_OFFSET;
-- 
2.25.1