[PATCH 23/23] drm/i915: BDW: Pipe level degamma correction

[Shashank Sharma]

BDW/SKL/BXT supports Degamma color correction feature, which
linearizes the non-linearity due to gamma encoded color values.
This will be applied before Color Transformation.

This patch does the following:
1. Adds the core function to program DeGamma correction values for
   BDW/SKL/BXT platform
2. Adds DeGamma correction macros/defines

Signed-off-by: Shashank Sharma <shashank.sharma at intel.com>
Signed-off-by: Kausal Malladi <kausalmalladi at gmail.com>
---
 drivers/gpu/drm/i915/intel_color_manager.c | 61 ++++++++++++++++++++++++++++++
 1 file changed, 61 insertions(+)

diff --git a/drivers/gpu/drm/i915/intel_color_manager.c 
b/drivers/gpu/drm/i915/intel_color_manager.c
index d935fd8..46f880d 100644
--- a/drivers/gpu/drm/i915/intel_color_manager.c
+++ b/drivers/gpu/drm/i915/intel_color_manager.c
@@ -532,6 +532,65 @@ static int bdw_set_gamma(struct drm_device *dev, struct 
drm_property_blob *blob,
        return 0;
 }

+static int bdw_set_degamma(struct drm_device *dev,
+       struct drm_property_blob *blob, struct drm_crtc *crtc)
+{
+       enum pipe pipe;
+       int num_samples, length;
+       int count = 0;
+       u32 index, word;
+       u32 blue, green, red;
+       u32 mode, pal_prec_index, pal_prec_data;
+       struct drm_palette *degamma_data;
+       struct drm_i915_private *dev_priv = dev->dev_private;
+       struct drm_r32g32b32 *correction_values = NULL;
+
+       if (WARN_ON(!blob))
+               return -EINVAL;
+
+       degamma_data = (struct drm_palette *)blob->data;
+       if (degamma_data->version != DEGAMMA_DATA_STRUCT_VERSION) {
+               DRM_ERROR("Invalid DeGamma Data struct version\n");
+               return -EINVAL;
+       }
+
+       pipe = to_intel_crtc(crtc)->pipe;
+       num_samples = degamma_data->num_samples;
+       if (num_samples != BDW_SPLITGAMMA_MAX_VALS) {
+               DRM_ERROR("Invalid number of samples\n");
+               return -EINVAL;
+       }
+
+       length = num_samples * sizeof(struct drm_r32g32b32);
+       mode = I915_READ(GAMMA_MODE(pipe));
+       pal_prec_index = _PREC_PAL_INDEX(pipe);
+       pal_prec_data = _PREC_PAL_DATA(pipe);
+
+       correction_values = (struct drm_r32g32b32 *)&degamma_data->lut;
+       index = I915_READ(pal_prec_index);
+       index |= BDW_INDEX_AUTO_INCREMENT | BDW_INDEX_SPLIT_MODE;
+       I915_WRITE(pal_prec_index, index);
+
+       while (count < num_samples) {
+               blue = correction_values[count].b32;
+               green = correction_values[count].g32;
+               red = correction_values[count].r32;
+
+               word = bdw_write_10bit_gamma_precision(red, green, blue);
+               I915_WRITE(pal_prec_data, word);
+               count++;
+       }
+
+       /* Enable DeGamma on Pipe */
+       mode &= ~GAMMA_MODE_MODE_MASK;
+       I915_WRITE(GAMMA_MODE(pipe), mode | GAMMA_MODE_MODE_SPLIT);
+
+       DRM_DEBUG_DRIVER("DeGamma correction enabled on Pipe %c\n",
+                       pipe_name(pipe));
+
+       return 0;
+}
+
 static int chv_set_gamma(struct drm_device *dev, struct drm_property_blob 
*blob,
                  struct drm_crtc *crtc)
 {
@@ -700,6 +759,8 @@ void intel_color_manager_crtc_commit(struct drm_device *dev,
                /* degamma correction */
                if (IS_CHERRYVIEW(dev))
                        ret = chv_set_degamma(dev, blob, crtc);
+               else if (IS_BROADWELL(dev) || IS_GEN9(dev))
+                       ret = bdw_set_degamma(dev, blob, crtc);

                if (ret)
                        DRM_ERROR("set degamma correction failed\n");
-- 
1.9.1