Extract the LUT and program plane degamma registers.

Signed-off-by: Uma Shankar <uma.shan...@intel.com>
---
 drivers/gpu/drm/i915/display/intel_color.c | 116 +++++++++++++++++++++
 drivers/gpu/drm/i915/i915_reg.h            |   2 +
 2 files changed, 118 insertions(+)

diff --git a/drivers/gpu/drm/i915/display/intel_color.c 
b/drivers/gpu/drm/i915/display/intel_color.c
index fd0bfdf85703..62df5122309a 100644
--- a/drivers/gpu/drm/i915/display/intel_color.c
+++ b/drivers/gpu/drm/i915/display/intel_color.c
@@ -126,6 +126,29 @@ static bool crtc_state_is_legacy_gamma(const struct 
intel_crtc_state *crtc_state
                lut_is_legacy(crtc_state->hw.gamma_lut);
 }
 
+/*
+ * Added to accommodate enhanced LUT precision.
+ * Max LUT precision is 32 bits.
+ */
+static u64 drm_color_lut_extract_ext(u64 user_input, u32 bit_precision)
+{
+       u64 val = user_input & 0xffffffff;
+       u32 max;
+
+       if (bit_precision > 32)
+               return 0;
+
+       max = 0xffffffff >> (32 - bit_precision);
+       /* Round only if we're not using full precision. */
+       if (bit_precision < 32) {
+               val += 1UL << (32 - bit_precision - 1);
+               val >>= 32 - bit_precision;
+       }
+
+       return ((user_input & 0xffffffff00000000) |
+               clamp_val(val, 0, max));
+}
+
 /*
  * When using limited range, multiply the matrix given by userspace by
  * the matrix that we would use for the limited range.
@@ -2196,6 +2219,97 @@ static const struct drm_color_lut_range 
d13_degamma_sdr[] = {
        },
 };
 
+static void d13_program_plane_degamma_lut(const struct drm_plane_state *state,
+                                         struct drm_color_lut_ext *degamma_lut,
+                                         u32 offset)
+{
+       struct drm_i915_private *dev_priv = to_i915(state->plane->dev);
+       enum pipe pipe = to_intel_plane(state->plane)->pipe;
+       enum plane_id plane = to_intel_plane(state->plane)->id;
+       u32 i, lut_size;
+
+       if (icl_is_hdr_plane(dev_priv, plane)) {
+               lut_size = 128;
+
+               intel_de_write(dev_priv, PLANE_PRE_CSC_GAMC_INDEX_ENH(pipe, 
plane, 0),
+                              PLANE_PAL_PREC_AUTO_INCREMENT);
+
+               if (degamma_lut) {
+                       for (i = 0; i < lut_size; i++) {
+                               u64 word = 
drm_color_lut_extract_ext(degamma_lut[i].green, 24);
+                               u32 lut_val = (word & 0xffffff);
+
+                               intel_de_write(dev_priv, 
PLANE_PRE_CSC_GAMC_DATA_ENH(pipe, plane, 0),
+                                              lut_val);
+                       }
+
+                       /* Program the max register to clamp values > 1.0. */
+                       while (i < 131)
+                               intel_de_write(dev_priv, 
PLANE_PRE_CSC_GAMC_DATA_ENH(pipe, plane, 0),
+                                              degamma_lut[i++].green);
+               } else {
+                       for (i = 0; i < lut_size; i++) {
+                               u32 v = (i * ((1 << 24) - 1)) / (lut_size - 1);
+
+                               intel_de_write(dev_priv, 
PLANE_PRE_CSC_GAMC_DATA_ENH(pipe, plane, 0), v);
+                       }
+
+                       do {
+                               intel_de_write(dev_priv, 
PLANE_PRE_CSC_GAMC_DATA_ENH(pipe, plane, 0),
+                                              1 << 24);
+                       } while (i++ < 130);
+               }
+
+               intel_de_write(dev_priv, PLANE_PRE_CSC_GAMC_INDEX_ENH(pipe, 
plane, 0), 0);
+       } else {
+               lut_size = 32;
+
+               /*
+                * First 3 planes are HDR, so reduce by 3 to get to the right
+                * SDR plane offset
+                */
+               plane = plane - 3;
+
+               intel_de_write(dev_priv, PLANE_PRE_CSC_GAMC_INDEX(pipe, plane, 
0),
+                              PLANE_PAL_PREC_AUTO_INCREMENT);
+
+               if (degamma_lut) {
+                       for (i = 0; i < lut_size; i++)
+                               intel_de_write(dev_priv, 
PLANE_PRE_CSC_GAMC_DATA(pipe, plane, 0),
+                                              degamma_lut[i].green);
+                       /* Program the max register to clamp values > 1.0. */
+                       while (i < 35)
+                               intel_de_write(dev_priv, 
PLANE_PRE_CSC_GAMC_DATA(pipe, plane, 0),
+                                              degamma_lut[i++].green);
+               } else {
+                       for (i = 0; i < lut_size; i++) {
+                               u32 v = (i * ((1 << 16) - 1)) / (lut_size - 1);
+
+                               intel_de_write(dev_priv, 
PLANE_PRE_CSC_GAMC_DATA(pipe, plane, 0), v);
+                       }
+
+                       do {
+                               intel_de_write(dev_priv, 
PLANE_PRE_CSC_GAMC_DATA(pipe, plane, 0),
+                                              1 << 16);
+                       } while (i++ < 34);
+               }
+
+               intel_de_write(dev_priv, PLANE_PRE_CSC_GAMC_INDEX(pipe, plane, 
0), 0);
+       }
+}
+
+static void d13_plane_load_luts(const struct drm_plane_state *plane_state)
+{
+       const struct drm_property_blob *degamma_lut_blob =
+                                       plane_state->degamma_lut;
+       struct drm_color_lut_ext *degamma_lut = NULL;
+
+       if (degamma_lut_blob) {
+               degamma_lut = degamma_lut_blob->data;
+               d13_program_plane_degamma_lut(plane_state, degamma_lut, 0);
+       }
+}
+
 int intel_plane_color_init(struct drm_plane *plane)
 {
        struct drm_i915_private *dev_priv = to_i915(plane->dev);
@@ -2217,6 +2331,8 @@ int intel_plane_color_init(struct drm_plane *plane)
                                                                           
d13_degamma_sdr,
                                                                           
sizeof(d13_degamma_sdr),
                                                                           
LUT_TYPE_DEGAMMA);
+
+               dev_priv->display.load_plane_luts = d13_plane_load_luts;
                drm_plane_attach_degamma_properties(plane);
        }
 
diff --git a/drivers/gpu/drm/i915/i915_reg.h b/drivers/gpu/drm/i915/i915_reg.h
index 919982c878ac..0c36a330734f 100644
--- a/drivers/gpu/drm/i915/i915_reg.h
+++ b/drivers/gpu/drm/i915/i915_reg.h
@@ -7232,6 +7232,7 @@ enum {
 #define   PLANE_COLOR_YUV_RANGE_CORRECTION_DISABLE     (1 << 28)
 #define   PLANE_COLOR_INPUT_CSC_ENABLE         (1 << 20) /* ICL+ */
 #define   PLANE_COLOR_PIPE_CSC_ENABLE          (1 << 23) /* Pre-ICL */
+#define   PLANE_PRE_CSC_GAMMA_ENABLE           (1 << 14)
 #define   PLANE_COLOR_CSC_MODE_BYPASS                  (0 << 17)
 #define   PLANE_COLOR_CSC_MODE_YUV601_TO_RGB601                (1 << 17)
 #define   PLANE_COLOR_CSC_MODE_YUV709_TO_RGB709                (2 << 17)
@@ -11381,6 +11382,7 @@ enum skl_power_gate {
 #define PLANE_PRE_CSC_GAMC_INDEX_ENH(pipe, plane, i)   \
                _MMIO_PLANE_GAMC(plane, i, 
_PLANE_PRE_CSC_GAMC_INDEX_ENH_1(pipe), \
                _PLANE_PRE_CSC_GAMC_INDEX_ENH_2(pipe))
+#define         PLANE_PAL_PREC_AUTO_INCREMENT          (1 << 10)
 
 #define _PLANE_PRE_CSC_GAMC_DATA_ENH_1_A       0x701d4
 #define _PLANE_PRE_CSC_GAMC_DATA_ENH_1_B       0x711d4
-- 
2.26.2

Reply via email to